Changes by Roy Ovesen to begin migrating the avionics out of the Cockpit

[flightgear.git] / src / Instrumentation / altimeter.cxx

diff --git a/src/Instrumentation/altimeter.cxx b/src/Instrumentation/altimeter.cxx
index b5450551eece9f33a825a62c46e60c8955c8eef7..5b7e3decc3cc52345386b4cff5325b55b851f3c0 100644 (file)
--- a/src/Instrumentation/altimeter.cxx
+++ b/src/Instrumentation/altimeter.cxx
@@ -7,39 +7,73 @@
 
 #include "altimeter.hxx"
 #include <Main/fg_props.hxx>
+#include <Main/util.hxx>
+
+
+// A higher number means more responsive
+#define RESPONSIVENESS 10.0
 
 
 // Altitude based on pressure difference from sea level.
 // pressure difference inHG, altitude ft
 static double altitude_data[][2] = {
-    -8.41, -8858.27,
-    0.00, 0.00,
-    3.05, 2952.76,
-    5.86, 5905.51,
-    8.41, 8858.27,
-    10.74, 11811.02,
-    12.87, 14763.78,
-    14.78, 17716.54,
-    16.55, 20669.29,
-    18.13, 23622.05,
-    19.62, 26574.80,
-    20.82, 29527.56,
-    21.96, 32480.31,
-    23.01, 35433.07,
-    23.91, 38385.83,
-    24.71, 41338.58,
-    25.40, 44291.34,
-    26.00, 47244.09,
-    26.51, 50196.85,
-    26.96, 53149.61,
-    27.35, 56102.36,
-    27.68, 59055.12,
-    27.98, 62007.87,
-    29.62, 100000.00            // just to fill it in
-    -1, -1,
+ { -8.41, -8858.27 },
+ { 0.00, 0.00 },
+ { 3.05, 2952.76 },
+ { 5.86, 5905.51 },
+ { 8.41, 8858.27 },
+ { 10.74, 11811.02 },
+ { 12.87, 14763.78 },
+ { 14.78, 17716.54 },
+ { 16.55, 20669.29 },
+ { 18.13, 23622.05 },
+ { 19.62, 26574.80 },
+ { 20.82, 29527.56 },
+ { 21.96, 32480.31 },
+ { 23.01, 35433.07 },
+ { 23.91, 38385.83 },
+ { 24.71, 41338.58 },
+ { 25.40, 44291.34 },
+ { 26.00, 47244.09 },
+ { 26.51, 50196.85 },
+ { 26.96, 53149.61 },
+ { 27.35, 56102.36 },
+ { 27.68, 59055.12 },
+ { 27.98, 62007.87 },
+ { 29.62, 100000.00 },            // just to fill it in
+ { -1, -1 }
 };
 
 
+Altimeter::Altimeter ( SGPropertyNode *node )
+    : _altitude_table(new SGInterpTable),
+      name("altimeter"),
+      num(0),
+      static_port("/systems/static")
+{
+    int i;
+    for (i = 0; altitude_data[i][0] != -1; i++)
+        _altitude_table->addEntry(altitude_data[i][0], altitude_data[i][1]);
+
+    for ( i = 0; i < node->nChildren(); ++i ) {
+        SGPropertyNode *child = node->getChild(i);
+        string cname = child->getName();
+        string cval = child->getStringValue();
+        if ( cname == "name" ) {
+            name = cval;
+        } else if ( cname == "number" ) {
+            num = child->getIntValue();
+        } else if ( cname == "static-port" ) {
+            static_port = cval;
+        } else {
+            SG_LOG( SG_INSTR, SG_WARN, "Error in altimeter config logic" );
+            if ( name.length() ) {
+                SG_LOG( SG_INSTR, SG_WARN, "Section = " << name );
+            }
+        }
+    }
+}
+
 Altimeter::Altimeter ()
     : _altitude_table(new SGInterpTable)
 {
@@ -56,24 +90,16 @@ Altimeter::~Altimeter ()
 void
 Altimeter::init ()
 {
-    _serviceable_node =
-        fgGetNode("/instrumentation/altimeter/serviceable", true);
-    _setting_node =
-        fgGetNode("/instrumentation/altimeter/setting-inhg", true);
-    _pressure_node =
-        fgGetNode("/systems/static/pressure-inhg", true);
-    _altitude_node =
-        fgGetNode("/instrumentation/altimeter/indicated-altitude-ft", true);
-}
+    string branch;
+    branch = "/instrumentation/" + name;
+    static_port += "/pressure-inhg";
 
-void
-Altimeter::bind ()
-{
-}
+    SGPropertyNode *node = fgGetNode(branch.c_str(), num, true );
 
-void
-Altimeter::unbind ()
-{
+    _serviceable_node = node->getChild("serviceable", 0, true);
+    _setting_node = node->getChild("setting-inhg", 0, true);
+    _pressure_node = fgGetNode(static_port.c_str(), true);
+    _altitude_node = node->getChild("indicated-altitude-ft", 0, true);
 }
 
 void
@@ -82,8 +108,14 @@ Altimeter::update (double dt)
     if (_serviceable_node->getBoolValue()) {
         double pressure = _pressure_node->getDoubleValue();
         double setting = _setting_node->getDoubleValue();
-        _altitude_node
-            ->setDoubleValue(_altitude_table->interpolate(setting-pressure));
+
+                                // Move towards the current setting
+        double last_altitude = _altitude_node->getDoubleValue();
+        double current_altitude =
+            _altitude_table->interpolate(setting - pressure);
+        _altitude_node->setDoubleValue(fgGetLowPass(last_altitude,
+                                                    current_altitude,
+                                                    dt * RESPONSIVENESS));
     }
 }