Invalidate GDL90 UDP values when AHRS data invalid.

pull/610/head
Eric Westphal 2017-05-14 09:25:11 -04:00
rodzic 70236a95da
commit 7add14badf
1 zmienionych plików z 19 dodań i 6 usunięć

Wyświetl plik

@ -1894,13 +1894,26 @@ func makeAHRSGDL90Report() {
palt := uint16(0xFFFF)
vs := int16(0x7FFF)
if isAHRSValid() {
// AHRS code uses 36727/10 for an invalid value.
if mySituation.AHRSPitch < 360 {
pitch = roundToInt16(mySituation.AHRSPitch * 10)
}
if mySituation.AHRSRoll < 360 {
roll = roundToInt16(mySituation.AHRSRoll * 10)
}
if mySituation.AHRSGyroHeading < 360 {
hdg = roundToInt16(mySituation.AHRSGyroHeading * 10) // TODO westphae: switch to AHRSMagHeading?
}
if mySituation.AHRSSlipSkid < 360 {
slip_skid = roundToInt16(-mySituation.AHRSSlipSkid * 10)
}
if mySituation.AHRSTurnRate < 360 {
yaw_rate = roundToInt16(mySituation.AHRSTurnRate * 10)
}
if mySituation.AHRSTurnRate < 360 {
g = roundToInt16(mySituation.AHRSGLoad * 10)
}
}
if isTempPressValid() {
palt = uint16(mySituation.BaroPressureAltitude + 5000.5)
vs = roundToInt16(mySituation.BaroVerticalSpeed)