1 | #include "nmea0183.h"
|
---|
2 | #pragma hdrstop
|
---|
3 |
|
---|
4 | /*
|
---|
5 | ** Author: Samuel R. Blackburn
|
---|
6 | ** Internet: sam_blackburn@pobox.com
|
---|
7 | **
|
---|
8 | ** You can use it any way you like as long as you don't try to sell it.
|
---|
9 | **
|
---|
10 | ** Copyright, 1996, Samuel R. Blackburn
|
---|
11 | **
|
---|
12 | ** $Workfile: xtr.cpp $
|
---|
13 | ** $Revision: 4 $
|
---|
14 | ** $Modtime: 10/10/98 2:40p $
|
---|
15 | */
|
---|
16 |
|
---|
17 |
|
---|
18 |
|
---|
19 | XTR::XTR()
|
---|
20 | {
|
---|
21 | Mnemonic = "XTR";
|
---|
22 | Empty();
|
---|
23 | }
|
---|
24 |
|
---|
25 | XTR::~XTR()
|
---|
26 | {
|
---|
27 | //Mnemonic.Empty();
|
---|
28 | Empty();
|
---|
29 | }
|
---|
30 |
|
---|
31 | void XTR::Empty( void )
|
---|
32 | {
|
---|
33 | Magnitude = 0.0;
|
---|
34 | DirectionToSteer = LR_Unknown;
|
---|
35 | }
|
---|
36 |
|
---|
37 | BOOL XTR::Parse( const SENTENCE& sentence )
|
---|
38 | {
|
---|
39 | /*
|
---|
40 | ** XTR - Cross Track Error - Dead Reckoning
|
---|
41 | **
|
---|
42 | ** 1 2 3 4
|
---|
43 | ** | | | |
|
---|
44 | ** $--XTR,x.x,a,N*hh<CR><LF>
|
---|
45 | **
|
---|
46 | ** Field Number:
|
---|
47 | ** 1) Magnitude of cross track error
|
---|
48 | ** 2) Direction to steer, L or R
|
---|
49 | ** 3) Units, N = Nautical Miles
|
---|
50 | ** 4) Checksum
|
---|
51 | */
|
---|
52 |
|
---|
53 | /*
|
---|
54 | ** First we check the checksum...
|
---|
55 | */
|
---|
56 |
|
---|
57 | if ( sentence.IsChecksumBad( 4 ) == True )
|
---|
58 | {
|
---|
59 | SetErrorMessage( "Invalid Checksum" );
|
---|
60 | return( FALSE );
|
---|
61 | }
|
---|
62 |
|
---|
63 | Magnitude = sentence.Double( 1 );
|
---|
64 | DirectionToSteer = sentence.LeftOrRight( 2 );
|
---|
65 |
|
---|
66 | return( TRUE );
|
---|
67 | }
|
---|
68 |
|
---|
69 | BOOL XTR::Write( SENTENCE& sentence )
|
---|
70 | {
|
---|
71 | /*
|
---|
72 | ** Let the parent do its thing
|
---|
73 | */
|
---|
74 |
|
---|
75 | RESPONSE::Write( sentence );
|
---|
76 |
|
---|
77 | sentence += Magnitude;
|
---|
78 | sentence += DirectionToSteer;
|
---|
79 | sentence += "N";
|
---|
80 |
|
---|
81 | sentence.Finish();
|
---|
82 |
|
---|
83 | return( TRUE );
|
---|
84 | }
|
---|
85 |
|
---|
86 | const XTR& XTR::operator = ( const XTR& source )
|
---|
87 | {
|
---|
88 | Magnitude = source.Magnitude;
|
---|
89 | DirectionToSteer = source.DirectionToSteer;
|
---|
90 |
|
---|
91 | return( *this );
|
---|
92 | }
|
---|