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: alm.cpp $
|
---|
13 | ** $Revision: 6 $
|
---|
14 | ** $Modtime: 10/10/98 2:41p $
|
---|
15 | */
|
---|
16 |
|
---|
17 |
|
---|
18 | ALM::ALM()
|
---|
19 | {
|
---|
20 | Mnemonic = "ALM";
|
---|
21 | Empty();
|
---|
22 | }
|
---|
23 |
|
---|
24 | ALM::~ALM()
|
---|
25 | {
|
---|
26 | //Mnemonic.Empty();
|
---|
27 | Empty();
|
---|
28 | }
|
---|
29 |
|
---|
30 | void ALM::Empty( void )
|
---|
31 | {
|
---|
32 | NumberOfMessages = 0;
|
---|
33 | MessageNumber = 0;
|
---|
34 | PRNNumber = 0;
|
---|
35 | WeekNumber = 0;
|
---|
36 | SVHealth = 0;
|
---|
37 | Eccentricity = 0;
|
---|
38 | AlmanacReferenceTime = 0;
|
---|
39 | InclinationAngle = 0;
|
---|
40 | RateOfRightAscension = 0;
|
---|
41 | RootOfSemiMajorAxis = 0;
|
---|
42 | ArgumentOfPerigee = 0;
|
---|
43 | LongitudeOfAscensionNode = 0;
|
---|
44 | MeanAnomaly = 0;
|
---|
45 | F0ClockParameter = 0;
|
---|
46 | F1ClockParameter = 0;
|
---|
47 | }
|
---|
48 |
|
---|
49 | BOOL ALM::Parse( const SENTENCE& sentence )
|
---|
50 | {
|
---|
51 | QString field_data;
|
---|
52 |
|
---|
53 | /*
|
---|
54 | ** ALM - GPS Almanac Data
|
---|
55 | **
|
---|
56 | ** 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
|
---|
57 | ** | | | | | | | | | | | | | | | |
|
---|
58 | ** $--ALM,x.x,x.x,xx,x.x,hh,hhhh,hh,hhhh,hhhh,hhhhhh,hhhhhh,hhhhhh,hhhhhh,hhh,hhh,*hh<CR><LF>
|
---|
59 | **
|
---|
60 | ** 1) Total number of messages
|
---|
61 | ** 2) Message Number
|
---|
62 | ** 3) Satellite PRN number (01 to 32)
|
---|
63 | ** 4) GPS Week Number
|
---|
64 | ** 5) SV health, bits 17-24 of each almanac page
|
---|
65 | ** 6) Eccentricity
|
---|
66 | ** 7) Almanac Reference Time
|
---|
67 | ** 8) Inclination Angle
|
---|
68 | ** 9) Rate of Right Ascension
|
---|
69 | ** 10) Root of semi-major axis
|
---|
70 | ** 11) Argument of perigee
|
---|
71 | ** 12) Longitude of ascension node
|
---|
72 | ** 13) Mean anomaly
|
---|
73 | ** 14) F0 Clock Parameter
|
---|
74 | ** 15) F1 Clock Parameter
|
---|
75 | ** 16) Checksum
|
---|
76 | */
|
---|
77 |
|
---|
78 | /*
|
---|
79 | ** First we check the checksum...
|
---|
80 | */
|
---|
81 |
|
---|
82 | if ( sentence.IsChecksumBad( 16 ) == True )
|
---|
83 | {
|
---|
84 | SetErrorMessage( "Invalid Checksum" );
|
---|
85 | return( FALSE );
|
---|
86 | }
|
---|
87 |
|
---|
88 | NumberOfMessages = (WORD) sentence.Integer( 1 );
|
---|
89 | MessageNumber = (WORD) sentence.Integer( 2 );
|
---|
90 | PRNNumber = (WORD) sentence.Integer( 3 );
|
---|
91 | WeekNumber = (WORD) sentence.Integer( 4 );
|
---|
92 | SVHealth = (WORD) ::HexValue( sentence.Field( 5 ).toLatin1() );
|
---|
93 | Eccentricity = (WORD) ::HexValue( sentence.Field( 6 ).toLatin1() );
|
---|
94 | AlmanacReferenceTime = (WORD) ::HexValue( sentence.Field( 7 ).toLatin1() );
|
---|
95 | InclinationAngle = (WORD) ::HexValue( sentence.Field( 8 ).toLatin1() );
|
---|
96 | RateOfRightAscension = (WORD) ::HexValue( sentence.Field( 9 ).toLatin1() );
|
---|
97 | RootOfSemiMajorAxis = ::HexValue( sentence.Field( 10 ).toLatin1() );
|
---|
98 | ArgumentOfPerigee = ::HexValue( sentence.Field( 11 ).toLatin1() );
|
---|
99 | LongitudeOfAscensionNode = ::HexValue( sentence.Field( 12 ).toLatin1() );
|
---|
100 | MeanAnomaly = ::HexValue( sentence.Field( 13 ).toLatin1() );
|
---|
101 | F0ClockParameter = (WORD) ::HexValue( sentence.Field( 14 ).toLatin1() );
|
---|
102 | F1ClockParameter = (WORD) ::HexValue( sentence.Field( 15 ).toLatin1() );
|
---|
103 |
|
---|
104 | return( TRUE );
|
---|
105 | }
|
---|
106 |
|
---|
107 | BOOL ALM::Write( SENTENCE& sentence )
|
---|
108 | {
|
---|
109 | /*
|
---|
110 | ** Let the parent do its thing
|
---|
111 | */
|
---|
112 |
|
---|
113 | RESPONSE::Write( sentence );
|
---|
114 |
|
---|
115 | sentence += Hex( NumberOfMessages ); // Thanks to Chuck Shannon, cshannon@imtn.tpd.dsccc.com
|
---|
116 | sentence += Hex( MessageNumber ); // Thanks to Chuck Shannon, cshannon@imtn.tpd.dsccc.com
|
---|
117 | sentence += Hex( PRNNumber ); // Thanks to Chuck Shannon, cshannon@imtn.tpd.dsccc.com
|
---|
118 | sentence += Hex( WeekNumber ); // Thanks to Chuck Shannon, cshannon@imtn.tpd.dsccc.com
|
---|
119 | sentence += Hex( SVHealth );
|
---|
120 | sentence += Hex( Eccentricity );
|
---|
121 | sentence += Hex( AlmanacReferenceTime );
|
---|
122 | sentence += Hex( InclinationAngle );
|
---|
123 | sentence += Hex( RateOfRightAscension );
|
---|
124 | sentence += Hex( RootOfSemiMajorAxis );
|
---|
125 | sentence += Hex( ArgumentOfPerigee );
|
---|
126 | sentence += Hex( LongitudeOfAscensionNode );
|
---|
127 | sentence += Hex( MeanAnomaly );
|
---|
128 | sentence += Hex( F0ClockParameter );
|
---|
129 | sentence += Hex( F1ClockParameter );
|
---|
130 |
|
---|
131 | sentence.Finish();
|
---|
132 |
|
---|
133 | return( TRUE );
|
---|
134 | }
|
---|
135 |
|
---|
136 | const ALM& ALM::operator = ( const ALM& source )
|
---|
137 | {
|
---|
138 | NumberOfMessages = source.NumberOfMessages;
|
---|
139 | MessageNumber = source.MessageNumber;
|
---|
140 | PRNNumber = source.PRNNumber;
|
---|
141 | WeekNumber = source.WeekNumber;
|
---|
142 | SVHealth = source.SVHealth;
|
---|
143 | Eccentricity = source.Eccentricity;
|
---|
144 | AlmanacReferenceTime = source.AlmanacReferenceTime;
|
---|
145 | InclinationAngle = source.InclinationAngle;
|
---|
146 | RateOfRightAscension = source.RateOfRightAscension;
|
---|
147 | RootOfSemiMajorAxis = source.RootOfSemiMajorAxis;
|
---|
148 | ArgumentOfPerigee = source.ArgumentOfPerigee;
|
---|
149 | LongitudeOfAscensionNode = source.LongitudeOfAscensionNode;
|
---|
150 | MeanAnomaly = source.MeanAnomaly;
|
---|
151 | F0ClockParameter = source.F0ClockParameter;
|
---|
152 | F1ClockParameter = source.F1ClockParameter;
|
---|
153 |
|
---|
154 | return( *this );
|
---|
155 | }
|
---|