kopia lustrzana https://github.com/cyoung/stratux
Invalidate GDL90 UDP values when AHRS data invalid.
rodzic
70236a95da
commit
7add14badf
13
main/gps.go
13
main/gps.go
|
@ -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)
|
||||
|
|
Ładowanie…
Reference in New Issue