Moved some of the low level scene graph construction code over to simgear.

[flightgear.git] / src / Network / native_gui.cxx

diff --git a/src/Network/native_gui.cxx b/src/Network/native_gui.cxx
index 5dbcf9520c0e8617f6b4d50b72e52e084a373601..e2b2391cbb5fde0d1bb27a9eab66541464537ea3 100644 (file)
--- a/src/Network/native_gui.cxx
+++ b/src/Network/native_gui.cxx
@@ -30,6 +30,7 @@
 #include <simgear/io/iochannel.hxx>
 #include <simgear/timing/sg_time.hxx>
 
+#include <Cockpit/radiostack.hxx>
 #include <FDM/flight.hxx>
 #include <Time/tmp.hxx>
 #include <Main/fg_props.hxx>
@@ -45,6 +46,9 @@
 #endif
 
 
+// #define FG_USE_NETWORK_BYTE_ORDER
+#if defined( FG_USE_NETWORK_BYTE_ORDER )
+
 // The function htond is defined this way due to the way some
 // processors and OSes treat floating point values.  Some will raise
 // an exception whenever a "bad" floating point value is loaded into a
@@ -69,6 +73,21 @@ static void htond (double &x)
         return;
     }
 }
+static void htonf (float &x)   
+{
+    if ( sgIsLittleEndian() ) {
+        int    *Float_Overlay;
+        int     Holding_Buffer;
+    
+        Float_Overlay = (int *) &x;
+        Holding_Buffer = Float_Overlay [0];
+    
+        Float_Overlay [0] = htonl (Holding_Buffer);
+    } else {
+        return;
+    }
+}
+#endif
 
 
 FGNativeGUI::FGNativeGUI() {
@@ -129,51 +148,109 @@ void FGProps2NetGUI( FGNetGUI *net ) {
     net->cur_time = globals->get_time_params()->get_cur_time();
     net->warp = globals->get_warp();
 
+    // Approach
+    net->tuned_freq = current_radiostack->get_navcom1()->get_nav_freq();
+    net->nav_radial = current_radiostack->get_navcom1()->get_nav_radial();
+    net->in_range = current_radiostack->get_navcom1()->get_nav_inrange();
+
+    if ( current_radiostack->get_navcom1()->get_nav_loc() ) {
+        // is an ILS
+        net->dist_nm
+            = current_radiostack->get_navcom1()->get_nav_gs_dist_signed()
+              * SG_METER_TO_NM;
+    } else {
+        // is a VOR
+        net->dist_nm = current_radiostack->get_navcom1()->get_nav_loc_dist()
+            * SG_METER_TO_NM;
+    }
+
+    net->course_deviation_deg
+        = current_radiostack->get_navcom1()->get_nav_heading()
+        - current_radiostack->get_navcom1()->get_nav_radial();
+    while ( net->course_deviation_deg >  180.0 ) {
+        net->course_deviation_deg -= 360.0;
+    }
+    while ( net->course_deviation_deg < -180.0 ) {
+        net->course_deviation_deg += 360.0;
+    }
+    if ( fabs(net->course_deviation_deg) > 90.0 )
+        net->course_deviation_deg
+            = ( net->course_deviation_deg<0.0
+                ? -net->course_deviation_deg - 180.0
+                : -net->course_deviation_deg + 180.0 );
+
+    if ( current_radiostack->get_navcom1()->get_nav_loc() ) {
+        // is an ILS
+        net->gs_deviation_deg
+            = current_radiostack->get_navcom1()->get_nav_gs_needle_deflection()
+            / 5.0;
+    } else {
+        // is an ILS
+        net->gs_deviation_deg = -9999.0;
+    }
+
+#if defined( FG_USE_NETWORK_BYTE_ORDER )
     // Convert the net buffer to network format
     net->version = htonl(net->version);
 
     htond(net->longitude);
     htond(net->latitude);
-    htond(net->altitude);
-    htond(net->phi);
-    htond(net->theta);
-    htond(net->psi);
-    htond(net->vcas);
-    htond(net->climb_rate);
+    htonf(net->altitude);
+    htonf(net->phi);
+    htonf(net->theta);
+    htonf(net->psi);
+    htonf(net->vcas);
+    htonf(net->climb_rate);
 
     for ( i = 0; i < net->num_tanks; ++i ) {
-        htond(net->fuel_quantity[i]);
+        htonf(net->fuel_quantity[i]);
     }
     net->num_tanks = htonl(net->num_tanks);
 
     net->cur_time = htonl( net->cur_time );
     net->warp = htonl( net->warp );
+
+    htonf(net->tuned_freq);
+    htonf(net->nav_radial);
+    net->in_range = htonl(net->in_range);
+    htonf(net->dist_nm);
+    htonf(net->course_deviation_deg);
+    htonf(net->gs_deviation_deg);
+#endif
 }
 
 
 void FGNetGUI2Props( FGNetGUI *net ) {
     int i;
 
+#if defined( FG_USE_NETWORK_BYTE_ORDER )
     // Convert to the net buffer from network format
     net->version = ntohl(net->version);
 
     htond(net->longitude);
     htond(net->latitude);
-    htond(net->altitude);
-    htond(net->phi);
-    htond(net->theta);
-    htond(net->psi);
-    htond(net->vcas);
-    htond(net->climb_rate);
+    htonf(net->altitude);
+    htonf(net->phi);
+    htonf(net->theta);
+    htonf(net->psi);
+    htonf(net->vcas);
+    htonf(net->climb_rate);
 
     net->num_tanks = htonl(net->num_tanks);
     for ( i = 0; i < net->num_tanks; ++i ) {
-       htond(net->fuel_quantity[i]);
+       htonf(net->fuel_quantity[i]);
     }
 
     net->cur_time = ntohl(net->cur_time);
     net->warp = ntohl(net->warp);
 
+    htonf(net->tuned_freq);
+    net->in_range = htonl(net->in_range);
+    htonf(net->dist_nm);
+    htonf(net->course_deviation_deg);
+    htonf(net->gs_deviation_deg);
+#endif
+
     if ( net->version == FG_NET_GUI_VERSION ) {
         // cout << "pos = " << net->longitude << " " << net->latitude << endl;
         // cout << "sea level rad = " << cur_fdm_state->get_Sea_level_radius()
@@ -200,6 +277,16 @@ void FGNetGUI2Props( FGNetGUI *net ) {
        }
 
         globals->set_warp( net->warp );
+
+        // Approach
+        fgSetDouble( "/radios/nav[0]/frequencies/selected-mhz",
+                     net->tuned_freq );
+        fgSetBool( "/radios/nav[0]/in-range", net->in_range );
+        fgSetDouble( "/radios/dme/distance-nm", net->dist_nm );
+        fgSetDouble( "/radios/nav[0]/heading-needle-deflection",
+                     net->course_deviation_deg );
+        fgSetDouble( "/radios/nav[0]/gs-needle-deflection",
+                     net->gs_deviation_deg );
     } else {
        SG_LOG( SG_IO, SG_ALERT,
                 "Error: version mismatch in FGNetNativeGUI2Props()" );