src/Instrumentation/slip_skid_ball.cxx

   1 // slip_skid_ball.cxx - an electric-powered turn indicator.
   2 // Written by David Megginson, started 2003.
   3 //
   4 // This file is in the Public Domain and comes with no warranty.
   5
   6 #include "slip_skid_ball.hxx"
   7 #include <Main/fg_props.hxx>
   8 #include <Main/util.hxx>
   9
  10
  11 SlipSkidBall::SlipSkidBall ( SGPropertyNode *node)
  12     :
  13     _name(node->getStringValue("name", "slip-skid-ball")),
  14     _num(node->getIntValue("number", 0))
  15 {
  16 }
  17
  18 SlipSkidBall::~SlipSkidBall ()
  19 {
  20 }
  21
  22 void
  23 SlipSkidBall::init ()
  24 {
  25     string branch;
  26     branch = "/instrumentation/" + _name;
  27
  28     SGPropertyNode *node = fgGetNode(branch.c_str(), _num, true );
  29     _serviceable_node = node->getChild("serviceable", 0, true);
  30     _y_accel_node = fgGetNode("/accelerations/pilot/y-accel-fps_sec", true);
  31     _z_accel_node = fgGetNode("/accelerations/pilot/z-accel-fps_sec", true);
  32     _out_node = node->getChild("indicated-slip-skid", 0, true);
  33     _override_node = node->getChild("override", 0, true);
  34 }
  35
  36 void
  37 SlipSkidBall::update (double delta_time_sec)
  38 {
  39     if (_serviceable_node->getBoolValue() && !_override_node->getBoolValue()) {
  40         double d = -_z_accel_node->getDoubleValue();
  41         if (d < 1.0)
  42             d = 1.0;
  43         double pos = _y_accel_node->getDoubleValue() / d * 10.0;
  44         pos = fgGetLowPass(_out_node->getDoubleValue(), pos, delta_time_sec);
  45         _out_node->setDoubleValue(pos);
  46     }
  47 }
  48
  49 // end of slip_skid_ball.cxx