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/airspeed-kt", 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 #ifndef KTTOFPS
  45 # define KTTOFPS 1.68781
  46 #endif
  47
  48
  49 void
  50 PitotSystem::update (double dt)
  51 {
  52     if (_serviceable_node->getBoolValue()) {
  53                                 // The pitot tube sees the forward
  54                                 // velocity in the body axis.
  55         double p = _pressure_node->getDoubleValue(); // static
  56         double r = _density_node->getDoubleValue();
  57         double v = _velocity_node->getDoubleValue() * KTTOFPS;
  58         double q = 0.5 * r * v * v / INHGTOPSF; // dynamic
  59         _total_pressure_node->setDoubleValue(p + q);
  60     }
  61 }
  62
  63 // end of pitot.cxx