X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fturn_indicator.cxx;h=06fd868e2ba8f313b10b35efe54f581fd64c74b6;hb=51a1c86f00d5e19547cf3eb368b6a28dfdb966f4;hp=d2bd957c32ecdb612efea112e96437bccabb7f49;hpb=25387150c4df8b447366cd67b93443526827a3b1;p=flightgear.git diff --git a/src/Instrumentation/turn_indicator.cxx b/src/Instrumentation/turn_indicator.cxx index d2bd957c3..06fd868e2 100644 --- a/src/Instrumentation/turn_indicator.cxx +++ b/src/Instrumentation/turn_indicator.cxx @@ -3,12 +3,30 @@ // // This file is in the Public Domain and comes with no warranty. +#ifdef HAVE_CONFIG_H +# include "config.h" +#endif + +#include +#include +#include +#include + #include "turn_indicator.hxx" #include
#include
+using std::string; + +// Use a bigger number to be more responsive, or a smaller number +// to be more sluggish. +#define RESPONSIVENESS 0.5 + -TurnIndicator::TurnIndicator () +TurnIndicator::TurnIndicator ( SGPropertyNode *node) : + _last_rate(0), + _name(node->getStringValue("name", "turn-indicator")), + _num(node->getIntValue("number", 0)) { } @@ -19,35 +37,58 @@ TurnIndicator::~TurnIndicator () void TurnIndicator::init () { + string branch; + branch = "/instrumentation/" + _name; + + SGPropertyNode *node = fgGetNode(branch.c_str(), _num, true ); _roll_rate_node = fgGetNode("/orientation/roll-rate-degps", true); _yaw_rate_node = fgGetNode("/orientation/yaw-rate-degps", true); _electric_current_node = fgGetNode("/systems/electrical/outputs/turn-coordinator", true); - _rate_out_node = - fgGetNode("/instrumentation/turn-indicator/indicated-turn-rate", true); + _rate_out_node = node->getChild("indicated-turn-rate", 0, true); + + reinit(); +} + +void +TurnIndicator::reinit () +{ + _last_rate = 0; + _gyro.reinit(); } void TurnIndicator::bind () { - fgTie("/instrumentation/turn-indicator/serviceable", - &_gyro, &Gyro::is_serviceable); - fgTie("/instrumentation/turn-indicator/spin", + std::ostringstream temp; + string branch; + temp << _num; + branch = "/instrumentation/" + _name + "[" + temp.str() + "]"; + + fgTie((branch + "/serviceable").c_str(), + &_gyro, &Gyro::is_serviceable, &Gyro::set_serviceable); + fgTie((branch + "/spin").c_str(), &_gyro, &Gyro::get_spin_norm, &Gyro::set_spin_norm); } void TurnIndicator::unbind () { - fgUntie("/instrumentation/turn-indicator/serviceable"); - fgUntie("/instrumentation/turn-indicator/spin"); + std::ostringstream temp; + string branch; + temp << _num; + branch = "/instrumentation/" + _name + "[" + temp.str() + "]"; + + fgUntie((branch + "/serviceable").c_str()); + fgUntie((branch + "/serviceable").c_str()); } void TurnIndicator::update (double dt) { // Get the spin from the gyro - _gyro.set_power_norm(_electric_current_node->getDoubleValue()/60.0); + double power = _electric_current_node->getDoubleValue() / 12.0; + _gyro.set_power_norm(power); _gyro.update(dt); double spin = _gyro.get_spin_norm(); @@ -64,9 +105,7 @@ TurnIndicator::update (double dt) // Lag left, based on gyro spin rate = -2.5 + (factor * (rate + 2.5)); - - // Add a lag, based on gyro spin - rate = fgGetLowPass(_last_rate, rate, dt/factor); + rate = fgGetLowPass(_last_rate, rate, dt*RESPONSIVENESS); _last_rate = rate; // Publish the indicated rate