Fixed so that ASI will indicate correctly (or at least, more
[fg:hoorays-flightgear.git] / 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