src/Systems/pitot.cxx

   1 // pitot.cxx - the pitot air system.
   2 // Written by David Megginson, started 2002.
   3 //
   4 // This file is in the Public Domain and comes with no warranty.
   5
   6 #include "pitot.hxx"
   7 #include <Main/fg_props.hxx>
   8 #include <Main/util.hxx>
   9
  10
  11 PitotSystem::PitotSystem ()
  12 {
  13 }
  14
  15 PitotSystem::~PitotSystem ()
  16 {
  17 }
  18
  19 void
  20 PitotSystem::init ()
  21 {
  22     _serviceable_node = fgGetNode("/systems/pitot[0]/serviceable", true);
  23     _pressure_node = fgGetNode("/environment/pressure-inhg", true);
  24     _density_node = fgGetNode("/environment/density-slugft3", true);
  25     _velocity_node = fgGetNode("/velocities/uBody-fps", true);
  26     _total_pressure_node =
  27         fgGetNode("/systems/pitot[0]/total-pressure-inhg", true);
  28 }
  29
  30 void
  31 PitotSystem::bind ()
  32 {
  33 }
  34
  35 void
  36 PitotSystem::unbind ()
  37 {
  38 }
  39
  40 #ifndef INHGTOPSF
  41 # define INHGTOPSF (2116.217/29.9212)
  42 #endif
  43
  44 void
  45 PitotSystem::update (double dt)
  46 {
  47     if (_serviceable_node->getBoolValue()) {
  48                                 // The pitot tube sees the forward
  49                                 // velocity in the body axis.
  50         double p = _pressure_node->getDoubleValue(); // static
  51         double r = _density_node->getDoubleValue();
  52         double v = _velocity_node->getDoubleValue();
  53         double q = 0.5 * r * v * v / INHGTOPSF; // dynamic
  54         _total_pressure_node->setDoubleValue(p + q);
  55     }
  56 }
  57
  58 // end of pitot.cxx