alm.cpp

来自「提取各种NEMA0183格式数据的类编程。」· C++ 代码 · 共 191 行

/*
** Author: Samuel R. Blackburn
** Internet: [e-mail]
**
** Copyright, 1996-2005, Samuel R. Blackburn
**
** "You can get credit for something or get it done, but not both."
** Dr. Richard Garwin
**
** BSD License follows.
**
** Redistribution and use in source and binary forms, with or without
** modification, are permitted provided that the following conditions
** are met:
**
** Redistributions of source code must retain the above copyright notice,
** this list of conditions and the following disclaimer. Redistributions
** in binary form must reproduce the above copyright notice, this list
** of conditions and the following disclaimer in the documentation and/or
** other materials provided with the distribution. Neither the name of
** the WFC nor the names of its contributors may be used to endorse or
** promote products derived from this software without specific prior
** written permission.
**
** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
** A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
** OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
** SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
** LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
** DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
** (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
** OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
**
** $Workfile: alm.cpp $
** $Revision: 6 $
** $Modtime: 10/10/98 2:41p $
*/

#include "nmea0183.h"
#pragma hdrstop

#if defined( _DEBUG ) && defined( _INC_CRTDBG )
#undef THIS_FILE
static char THIS_FILE[] = __FILE__;
#define new DEBUG_NEW
#endif // _DEBUG

ALM::ALM()
{
   Mnemonic = TEXT( "ALM" );
   Empty();
}

ALM::~ALM()
{
   Mnemonic.Empty();
   Empty();
}

void ALM::Empty( void )
{
   NumberOfMessages         = 0;
   MessageNumber            = 0;
   PRNNumber                = 0;
   WeekNumber               = 0;
   SVHealth                 = 0;
   Eccentricity             = 0;
   AlmanacReferenceTime     = 0;
   InclinationAngle         = 0;
   RateOfRightAscension     = 0;
   RootOfSemiMajorAxis      = 0;
   ArgumentOfPerigee        = 0;
   LongitudeOfAscensionNode = 0;
   MeanAnomaly              = 0;
   F0ClockParameter         = 0;
   F1ClockParameter         = 0;
}

BOOL ALM::Parse( const SENTENCE& sentence )
{
   CString field_data;

   /*
   ** ALM - GPS Almanac Data
   **
   **        1   2   3  4   5  6    7  8    9    10     11     12     13     14  15   16
   **        |   |   |  |   |  |    |  |    |    |      |      |      |      |   |    |
   ** $--ALM,x.x,x.x,xx,x.x,hh,hhhh,hh,hhhh,hhhh,hhhhhh,hhhhhh,hhhhhh,hhhhhh,hhh,hhh,*hh<CR><LF>
   **
   **  1) Total number of messages
   **  2) Message Number
   **  3) Satellite PRN number (01 to 32)
   **  4) GPS Week Number
   **  5) SV health, bits 17-24 of each almanac page
   **  6) Eccentricity
   **  7) Almanac Reference Time
   **  8) Inclination Angle
   **  9) Rate of Right Ascension
   ** 10) Root of semi-major axis
   ** 11) Argument of perigee
   ** 12) Longitude of ascension node
   ** 13) Mean anomaly
   ** 14) F0 Clock Parameter
   ** 15) F1 Clock Parameter
   ** 16) Checksum
   */

   /*
   ** First we check the checksum...
   */

   const NMEA0183_BOOLEAN checksum_is_bad = sentence.IsChecksumBad();

   if ( checksum_is_bad == True )
   {
      InvalidChecksum();
      return( FALSE );
   } 

   NumberOfMessages         = (WORD) sentence.Integer( 1 );
   MessageNumber            = (WORD) sentence.Integer( 2 );
   PRNNumber                = (WORD) sentence.Integer( 3 );
   WeekNumber               = (WORD) sentence.Integer( 4 );
   SVHealth                 = (WORD) ::HexValue( sentence.Field( 5 ) );
   Eccentricity             = (WORD) ::HexValue( sentence.Field( 6 ) );
   AlmanacReferenceTime     = (WORD) ::HexValue( sentence.Field( 7 ) );
   InclinationAngle         = (WORD) ::HexValue( sentence.Field( 8 ) );
   RateOfRightAscension     = (WORD) ::HexValue( sentence.Field( 9 ) );
   RootOfSemiMajorAxis      = ::HexValue( sentence.Field( 10 ) );
   ArgumentOfPerigee        = ::HexValue( sentence.Field( 11 ) );
   LongitudeOfAscensionNode = ::HexValue( sentence.Field( 12 ) );
   MeanAnomaly              = ::HexValue( sentence.Field( 13 ) );
   F0ClockParameter         = (WORD) ::HexValue( sentence.Field( 14 ) );
   F1ClockParameter         = (WORD) ::HexValue( sentence.Field( 15 ) );

   return( TRUE );
}

BOOL ALM::Write( SENTENCE& sentence )
{
   /*
   ** Let the parent do its thing
   */
   
   RESPONSE::Write( sentence );

   sentence += Hex( NumberOfMessages ); // Thanks to Chuck Shannon, [e-mail]
   sentence += Hex( MessageNumber );    // Thanks to Chuck Shannon, [e-mail]
   sentence += Hex( PRNNumber );        // Thanks to Chuck Shannon, [e-mail]
   sentence += Hex( WeekNumber );       // Thanks to Chuck Shannon, [e-mail]
   sentence += Hex( SVHealth );
   sentence += Hex( Eccentricity );
   sentence += Hex( AlmanacReferenceTime );
   sentence += Hex( InclinationAngle );
   sentence += Hex( RateOfRightAscension );
   sentence += Hex( RootOfSemiMajorAxis );
   sentence += Hex( ArgumentOfPerigee );
   sentence += Hex( LongitudeOfAscensionNode );
   sentence += Hex( MeanAnomaly );
   sentence += Hex( F0ClockParameter );
   sentence += Hex( F1ClockParameter );

   sentence.Finish();

   return( TRUE );
}

const ALM& ALM::operator = ( const ALM& source )
{
   NumberOfMessages         = source.NumberOfMessages;
   MessageNumber            = source.MessageNumber;
   PRNNumber                = source.PRNNumber;
   WeekNumber               = source.WeekNumber;
   SVHealth                 = source.SVHealth;
   Eccentricity             = source.Eccentricity;
   AlmanacReferenceTime     = source.AlmanacReferenceTime;
   InclinationAngle         = source.InclinationAngle;
   RateOfRightAscension     = source.RateOfRightAscension;
   RootOfSemiMajorAxis      = source.RootOfSemiMajorAxis;
   ArgumentOfPerigee        = source.ArgumentOfPerigee;
   LongitudeOfAscensionNode = source.LongitudeOfAscensionNode;
   MeanAnomaly              = source.MeanAnomaly;
   F0ClockParameter         = source.F0ClockParameter;
   F1ClockParameter         = source.F1ClockParameter;

   return( *this );
}