]> git.mxchange.org Git - flightgear.git/blobdiff - src/Network/nmea.cxx
projects / flightgear.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
Fix a potential timing glitch.
[flightgear.git] / src / Network / nmea.cxx
diff --git a/src/Network/nmea.cxx b/src/Network/nmea.cxx
index 6467c28545a1455ccb8aed2908aa7cbcdd9afe92..577e694cc0f7a2ea86f66f8cb939d5e302c257f9 100644 (file)
--- a/src/Network/nmea.cxx
+++ b/src/Network/nmea.cxx
@@ -24,12 +24,15 @@
 #include <simgear/debug/logstream.hxx>
 #include <simgear/math/sg_geodesy.hxx>
 #include <simgear/io/iochannel.hxx>
+#include <simgear/timing/sg_time.hxx>
 
 #include <FDM/flight.hxx>
 #include <Main/globals.hxx>
 
 #include "nmea.hxx"
 
+SG_USING_NAMESPACE(std);
+
 
 FGNMEA::FGNMEA() {
 }
@@ -75,7 +78,7 @@ bool FGNMEA::gen_message() {
             t->getGmt()->tm_hour, t->getGmt()->tm_min, t->getGmt()->tm_sec );
 
     char lat[20];
-    double latd = cur_fdm_state->get_Latitude() * RAD_TO_DEG;
+    double latd = cur_fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES;
     if ( latd < 0.0 ) {
        latd *= -1.0;
        dir = 'S';
@@ -87,7 +90,7 @@ bool FGNMEA::gen_message() {
     sprintf( lat, "%02d%06.3f,%c", abs(deg), min, dir);
 
     char lon[20];
-    double lond = cur_fdm_state->get_Longitude() * RAD_TO_DEG;
+    double lond = cur_fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES;
     if ( lond < 0.0 ) {
        lond *= -1.0;
        dir = 'W';
@@ -102,11 +105,11 @@ bool FGNMEA::gen_message() {
     sprintf( speed, "%05.1f", cur_fdm_state->get_V_equiv_kts() );
 
     char heading[10];
-    sprintf( heading, "%05.1f", cur_fdm_state->get_Psi() * RAD_TO_DEG );
+    sprintf( heading, "%05.1f", cur_fdm_state->get_Psi() * SGD_RADIANS_TO_DEGREES );
 
     char altitude_m[10];
     sprintf( altitude_m, "%02d", 
-            (int)(cur_fdm_state->get_Altitude() * FEET_TO_METER) );
+            (int)(cur_fdm_state->get_Altitude() * SG_FEET_TO_METER) );
 
     char altitude_ft[10];
     sprintf( altitude_ft, "%02d", (int)cur_fdm_state->get_Altitude() );
@@ -125,8 +128,8 @@ bool FGNMEA::gen_message() {
     sprintf( gga_sum, "%02X", calc_nmea_cksum(gga) );
 
 
-    FG_LOG( FG_IO, FG_DEBUG, rmc );
-    FG_LOG( FG_IO, FG_DEBUG, gga );
+    SG_LOG( SG_IO, SG_DEBUG, rmc );
+    SG_LOG( SG_IO, SG_DEBUG, gga );
 
     string nmea_sentence;
 
@@ -160,11 +163,11 @@ bool FGNMEA::gen_message() {
 // $GPGGA,163227,3321.173,N,11039.855,W,1,,,3333,F,,,,*0F
 
 bool FGNMEA::parse_message() {
-    FG_LOG( FG_IO, FG_INFO, "parse nmea message" );
+    SG_LOG( SG_IO, SG_INFO, "parse nmea message" );
 
     string msg = buf;
     msg = msg.substr( 0, length );
-    FG_LOG( FG_IO, FG_INFO, "entire message = " << msg );
+    SG_LOG( SG_IO, SG_INFO, "entire message = " << msg );
 
     string::size_type begin_line, end_line, begin, end;
     begin_line = begin = 0;
@@ -174,12 +177,12 @@ bool FGNMEA::parse_message() {
     while ( end_line != string::npos ) {
        string line = msg.substr(begin_line, end_line - begin_line);
        begin_line = end_line + 1;
-       FG_LOG( FG_IO, FG_INFO, "  input line = " << line );
+       SG_LOG( SG_IO, SG_INFO, "  input line = " << line );
 
        // leading character
        string start = msg.substr(begin, 1);
        ++begin;
-       FG_LOG( FG_IO, FG_INFO, "  start = " << start );
+       SG_LOG( SG_IO, SG_INFO, "  start = " << start );
 
        // sentence
        end = msg.find(",", begin);
@@ -189,7 +192,7 @@ bool FGNMEA::parse_message() {
     
        string sentence = msg.substr(begin, end - begin);
        begin = end + 1;
-       FG_LOG( FG_IO, FG_INFO, "  sentence = " << sentence );
+       SG_LOG( SG_IO, SG_INFO, "  sentence = " << sentence );
 
        double lon_deg, lon_min, lat_deg, lat_min;
        double lon, lat, speed, heading, altitude;
@@ -203,7 +206,7 @@ bool FGNMEA::parse_message() {
     
            string utc = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  utc = " << utc );
+           SG_LOG( SG_IO, SG_INFO, "  utc = " << utc );
 
            // junk
            end = msg.find(",", begin);
@@ -213,7 +216,7 @@ bool FGNMEA::parse_message() {
     
            string junk = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  junk = " << junk );
+           SG_LOG( SG_IO, SG_INFO, "  junk = " << junk );
 
            // lat val
            end = msg.find(",", begin);
@@ -241,8 +244,8 @@ bool FGNMEA::parse_message() {
                lat *= -1;
            }
 
-           cur_fdm_state->set_Latitude( lat * DEG_TO_RAD );
-           FG_LOG( FG_IO, FG_INFO, "  lat = " << lat );
+           cur_fdm_state->set_Latitude( lat * SGD_DEGREES_TO_RADIANS );
+           SG_LOG( SG_IO, SG_INFO, "  lat = " << lat );
 
            // lon val
            end = msg.find(",", begin);
@@ -270,9 +273,10 @@ bool FGNMEA::parse_message() {
                lon *= -1;
            }
 
-           cur_fdm_state->set_Longitude( lon * DEG_TO_RAD );
-           FG_LOG( FG_IO, FG_INFO, "  lon = " << lon );
+           cur_fdm_state->set_Longitude( lon * SGD_DEGREES_TO_RADIANS );
+           SG_LOG( SG_IO, SG_INFO, "  lon = " << lon );
 
+#if 0
            double sl_radius, lat_geoc;
            sgGeodToGeoc( cur_fdm_state->get_Latitude(), 
                          cur_fdm_state->get_Altitude(), 
@@ -280,6 +284,7 @@ bool FGNMEA::parse_message() {
            cur_fdm_state->set_Geocentric_Position( lat_geoc, 
                           cur_fdm_state->get_Longitude(), 
                           sl_radius + cur_fdm_state->get_Altitude() );
+#endif
 
            // speed
            end = msg.find(",", begin);
@@ -290,9 +295,9 @@ bool FGNMEA::parse_message() {
            string speed_str = msg.substr(begin, end - begin);
            begin = end + 1;
            speed = atof( speed_str.c_str() );
-           cur_fdm_state->set_V_equiv_kts( speed );
-           cur_fdm_state->set_V_ground_speed( speed );
-           FG_LOG( FG_IO, FG_INFO, "  speed = " << speed );
+           cur_fdm_state->set_V_calibrated_kts( speed );
+           // cur_fdm_state->set_V_ground_speed( speed );
+           SG_LOG( SG_IO, SG_INFO, "  speed = " << speed );
 
            // heading
            end = msg.find(",", begin);
@@ -305,8 +310,8 @@ bool FGNMEA::parse_message() {
            heading = atof( hdg_str.c_str() );
            cur_fdm_state->set_Euler_Angles( cur_fdm_state->get_Phi(), 
                                             cur_fdm_state->get_Theta(), 
-                                            heading * DEG_TO_RAD );
-           FG_LOG( FG_IO, FG_INFO, "  heading = " << heading );
+                                            heading * SGD_DEGREES_TO_RADIANS );
+           SG_LOG( SG_IO, SG_INFO, "  heading = " << heading );
        } else if ( sentence == "GPGGA" ) {
            // time
            end = msg.find(",", begin);
@@ -316,7 +321,7 @@ bool FGNMEA::parse_message() {
     
            string utc = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  utc = " << utc );
+           SG_LOG( SG_IO, SG_INFO, "  utc = " << utc );
 
            // lat val
            end = msg.find(",", begin);
@@ -344,8 +349,8 @@ bool FGNMEA::parse_message() {
                lat *= -1;
            }
 
-           // cur_fdm_state->set_Latitude( lat * DEG_TO_RAD );
-           FG_LOG( FG_IO, FG_INFO, "  lat = " << lat );
+           // cur_fdm_state->set_Latitude( lat * SGD_DEGREES_TO_RADIANS );
+           SG_LOG( SG_IO, SG_INFO, "  lat = " << lat );
 
            // lon val
            end = msg.find(",", begin);
@@ -373,8 +378,8 @@ bool FGNMEA::parse_message() {
                lon *= -1;
            }
 
-           // cur_fdm_state->set_Longitude( lon * DEG_TO_RAD );
-           FG_LOG( FG_IO, FG_INFO, "  lon = " << lon );
+           // cur_fdm_state->set_Longitude( lon * SGD_DEGREES_TO_RADIANS );
+           SG_LOG( SG_IO, SG_INFO, "  lon = " << lon );
 
            // junk
            end = msg.find(",", begin);
@@ -384,7 +389,7 @@ bool FGNMEA::parse_message() {
     
            string junk = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  junk = " << junk );
+           SG_LOG( SG_IO, SG_INFO, "  junk = " << junk );
 
            // junk
            end = msg.find(",", begin);
@@ -394,7 +399,7 @@ bool FGNMEA::parse_message() {
     
            junk = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  junk = " << junk );
+           SG_LOG( SG_IO, SG_INFO, "  junk = " << junk );
 
            // junk
            end = msg.find(",", begin);
@@ -404,7 +409,7 @@ bool FGNMEA::parse_message() {
     
            junk = msg.substr(begin, end - begin);
            begin = end + 1;
-           FG_LOG( FG_IO, FG_INFO, "  junk = " << junk );
+           SG_LOG( SG_IO, SG_INFO, "  junk = " << junk );
 
            // altitude
            end = msg.find(",", begin);
@@ -425,13 +430,13 @@ bool FGNMEA::parse_message() {
            string alt_units = msg.substr(begin, end - begin);
            begin = end + 1;
 
-           if ( alt_units != "F" ) {
-               altitude *= METER_TO_FEET;
+           if ( alt_units != (string)"F" ) {
+               altitude *= SG_METER_TO_FEET;
            }
 
            cur_fdm_state->set_Altitude( altitude );
     
-           FG_LOG( FG_IO, FG_INFO, " altitude  = " << altitude );
+           SG_LOG( SG_IO, SG_INFO, " altitude  = " << altitude );
 
        }
 
@@ -448,7 +453,7 @@ bool FGNMEA::parse_message() {
 // open hailing frequencies
 bool FGNMEA::open() {
     if ( is_enabled() ) {
-       FG_LOG( FG_IO, FG_ALERT, "This shouldn't happen, but the channel " 
+       SG_LOG( SG_IO, SG_ALERT, "This shouldn't happen, but the channel " 
                << "is already in use, ignoring" );
        return false;
     }
@@ -456,7 +461,7 @@ bool FGNMEA::open() {
     SGIOChannel *io = get_io_channel();
 
     if ( ! io->open( get_direction() ) ) {
-       FG_LOG( FG_IO, FG_ALERT, "Error opening channel communication layer." );
+       SG_LOG( SG_IO, SG_ALERT, "Error opening channel communication layer." );
        return false;
     }
 
@@ -473,20 +478,20 @@ bool FGNMEA::process() {
     if ( get_direction() == SG_IO_OUT ) {
        gen_message();
        if ( ! io->write( buf, length ) ) {
-           FG_LOG( FG_IO, FG_ALERT, "Error writing data." );
+           SG_LOG( SG_IO, SG_ALERT, "Error writing data." );
            return false;
        }
     } else if ( get_direction() == SG_IO_IN ) {
        if ( (length = io->readline( buf, FG_MAX_MSG_SIZE )) > 0 ) {
            parse_message();
        } else {
-           FG_LOG( FG_IO, FG_ALERT, "Error reading data." );
+           SG_LOG( SG_IO, SG_ALERT, "Error reading data." );
            return false;
        }
        if ( (length = io->readline( buf, FG_MAX_MSG_SIZE )) > 0 ) {
            parse_message();
        } else {
-           FG_LOG( FG_IO, FG_ALERT, "Error reading data." );
+           SG_LOG( SG_IO, SG_ALERT, "Error reading data." );
            return false;
        }
     }
Personal clone of the FlightGear source code, the free-libre OpenSource flight simulator.