fly/flightgear
1
0
Fork 0
Code Activity

Heading-Indicator DG normalisation fix

Browse source 
From Benedikt Hallinger
This commit is contained in:
James Turner 2024-01-29 13:52:44 +00:00
parent d35a28647a
commit b32c33fc72
1 changed files with 5 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

6
src/Instrumentation/heading_indicator_dg.cxx
View file

@ -281,7 +281,11 @@ HeadingIndicatorDG::update (double dt)
error = SGMiscd::normalizePeriodic(-180.0, 180.0, error); error = SGMiscd::normalizePeriodic(-180.0, 180.0, error);
_error_node->setDoubleValue(error); _error_node->setDoubleValue(error);
_last_indicated_heading_dg = SGMiscd::normalizePeriodic(-180.0, 180.0, (heading - _last_indicated_heading_dg)); // Bring heading to the same range as errors for calculation. Otherwise the low-pass filter will
// get confused.
heading = SGMiscd::normalizePeriodic(-180.0, 180.0, heading);
_last_indicated_heading_dg = SGMiscd::normalizePeriodic(-180.0, 180.0, _last_indicated_heading_dg);
heading = fgGetLowPass(_last_indicated_heading_dg, heading, dt * 100 * factor); heading = fgGetLowPass(_last_indicated_heading_dg, heading, dt * 100 * factor);
_last_indicated_heading_dg = heading; _last_indicated_heading_dg = heading;