[59] | 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: gsv.cpp $
|
---|
| 13 | ** $Revision: 5 $
|
---|
| 14 | ** $Modtime: 10/10/98 2:48p $
|
---|
| 15 | */
|
---|
| 16 |
|
---|
| 17 |
|
---|
| 18 | GSV::GSV()
|
---|
| 19 | {
|
---|
| 20 | Mnemonic = "GSV";
|
---|
| 21 | Empty();
|
---|
| 22 | }
|
---|
| 23 |
|
---|
| 24 | GSV::~GSV()
|
---|
| 25 | {
|
---|
| 26 | //Mnemonic.Empty();
|
---|
| 27 | Empty();
|
---|
| 28 | }
|
---|
| 29 |
|
---|
| 30 | void GSV::Empty( void )
|
---|
| 31 | {
|
---|
| 32 |
|
---|
| 33 | NumberOfSatellites = 0;
|
---|
| 34 |
|
---|
| 35 | int index = 0;
|
---|
| 36 |
|
---|
| 37 | while( index < 36 )
|
---|
| 38 | {
|
---|
| 39 | SatellitesInView[ index ].Empty();
|
---|
| 40 | index++;
|
---|
| 41 | }
|
---|
| 42 | }
|
---|
| 43 |
|
---|
| 44 | BOOL GSV::Parse( const SENTENCE& sentence )
|
---|
| 45 | {
|
---|
| 46 | /*
|
---|
| 47 | ** GSV - TRANSIT Position - Latitude/Longitude
|
---|
| 48 | ** Location and time of TRANSIT fix at waypoint
|
---|
| 49 | **
|
---|
| 50 | ** 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
|
---|
| 51 | ** | | | | | | | | | | | | | | | | | | | |
|
---|
| 52 | ** $--GSV,x,x,xx,xx,xx,xxx,xx,xx,xx,xxx,xx,xx,xx,xxx,xx,xx,xx,xxx,xx,*hh<CR><LF>
|
---|
| 53 | **
|
---|
| 54 | ** 1) Total number of messages, 1-9
|
---|
| 55 | ** 2) Message Number, 1-9
|
---|
| 56 | ** 3) Total number of satellites in view
|
---|
| 57 | ** 4) Satellite Number #1
|
---|
| 58 | ** 5) Elevation #1
|
---|
| 59 | ** 6) Azimuth, Degrees True #1
|
---|
| 60 | ** 7) SNR #1, NULL when not tracking
|
---|
| 61 | ** 8) Satellite Number #2
|
---|
| 62 | ** 9) Elevation #2
|
---|
| 63 | ** 10) Azimuth, Degrees True #2
|
---|
| 64 | ** 11) SNR #2, NULL when not tracking
|
---|
| 65 | ** 12) Satellite Number #3
|
---|
| 66 | ** 13) Elevation #3
|
---|
| 67 | ** 14) Azimuth, Degrees True #3
|
---|
| 68 | ** 15) SNR #3, NULL when not tracking
|
---|
| 69 | ** 16) Satellite Number #4
|
---|
| 70 | ** 17) Elevation #4
|
---|
| 71 | ** 18) Azimuth, Degrees True #4
|
---|
| 72 | ** 19) SNR #4, NULL when not tracking
|
---|
| 73 | ** 20) Checksum
|
---|
| 74 | */
|
---|
| 75 |
|
---|
| 76 | /*
|
---|
| 77 | ** First we check the checksum...
|
---|
| 78 | */
|
---|
| 79 |
|
---|
| 80 | if ( sentence.IsChecksumBad( 20 ) == True )
|
---|
| 81 | {
|
---|
| 82 | SetErrorMessage( "Invalid Checksum" );
|
---|
| 83 | return( FALSE );
|
---|
| 84 | }
|
---|
| 85 |
|
---|
| 86 | Totalmessages = sentence.Integer( 1 );
|
---|
| 87 | //int message_number = sentence.Integer( 2 );
|
---|
| 88 | message_number = sentence.Integer( 2 );
|
---|
| 89 |
|
---|
| 90 | NumberOfSatellites = sentence.Integer( 3 );
|
---|
| 91 |
|
---|
| 92 | int index = 0;
|
---|
| 93 |
|
---|
| 94 | int tmp = NumberOfSatellites - ( message_number - 1 ) * 4;
|
---|
| 95 | int min = ( (4 < tmp) ? 4 : tmp);
|
---|
| 96 | // while( index < (4 <? (NumberOfSatellites - ( message_number - 1 ) * 4) ) )
|
---|
| 97 | while( index < min )
|
---|
| 98 | {
|
---|
| 99 | SatellitesInView[ ( ( message_number - 1 ) * 4 ) + index ].Parse( ( index * 4 ) + 4, sentence );
|
---|
| 100 | index++;
|
---|
| 101 | }
|
---|
| 102 |
|
---|
| 103 | return( TRUE );
|
---|
| 104 | }
|
---|
| 105 |
|
---|
| 106 | BOOL GSV::Write( SENTENCE& sentence )
|
---|
| 107 | {
|
---|
| 108 | /*
|
---|
| 109 | ** Let the parent do its thing
|
---|
| 110 | */
|
---|
| 111 |
|
---|
| 112 | RESPONSE::Write( sentence );
|
---|
| 113 |
|
---|
| 114 | /*
|
---|
| 115 | ** OK, this is a hack, I'll figure out how to do multiple messages later
|
---|
| 116 | */
|
---|
| 117 |
|
---|
| 118 | sentence.Finish();
|
---|
| 119 |
|
---|
| 120 | return( TRUE );
|
---|
| 121 | }
|
---|
| 122 |
|
---|
| 123 |
|
---|
| 124 | const GSV& GSV::operator = ( const GSV& source )
|
---|
| 125 | {
|
---|
| 126 | NumberOfSatellites = source.NumberOfSatellites;
|
---|
| 127 |
|
---|
| 128 | int index = 0;
|
---|
| 129 |
|
---|
| 130 | while( index < 36 )
|
---|
| 131 | {
|
---|
| 132 | SatellitesInView[ index ] = source.SatellitesInView[ index ];
|
---|
| 133 | index++;
|
---|
| 134 | }
|
---|
| 135 | Totalmessages = source.Totalmessages;
|
---|
| 136 | message_number = source.message_number;
|
---|
| 137 | return( *this );
|
---|
| 138 | }
|
---|
| 139 |
|
---|
| 140 |
|
---|