mirror
/
stratux
kopia lustrzana https://github.com/cyoung/stratux
1
0
Forkuj 0
Kod Zgłoszenia Projekty Wydania Wiki Aktywność

Provide invalid GDL90Report values if AHRS invalid

pull/465/head
Eric Westphal 2016-07-19 06:40:57 -04:00
rodzic 832054bd35
commit bf30fa147c
1 zmienionych plików z 17 dodań i 8 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

25
main/ry835ai.go
Wyświetl plik

@ -1419,15 +1419,24 @@ func makeAHRSGDL90Report() {
msg[2] = 0x01
msg[3] = 0x01
pitch := int16(mySituation.Pitch*10)
roll := int16(mySituation.Roll*10)
hdg := int16(mySituation.Gyro_heading*10)
slip_skid := int16(mySituation.SlipSkid*10)
yaw_rate := int16(mySituation.RateOfTurn*10)
g := int16(mySituation.GLoad*10)
// Values if invalid
pitch := int16(0x7FFF)
roll := int16(0x7FFF)
hdg := int16(0x7FFF)
slip_skid := int16(0x7FFF)
yaw_rate := int16(0x7FFF)
g := int16(0x7FFF)
airspeed := int16(0x7FFF) // Can add this once we can read airspeed
palt := uint16(0xFFFF) // Value if invalid
vs := int16(0x7FFF) // Value if invalid
palt := uint16(0xFFFF)
vs := int16(0x7FFF)
if isAHRSValid() {
pitch = int16(mySituation.Pitch * 10)
roll = int16(mySituation.Roll * 10)
hdg = int16(mySituation.Gyro_heading * 10)
slip_skid = int16(mySituation.SlipSkid * 10)
yaw_rate = int16(mySituation.RateOfTurn * 10)
g = int16(mySituation.GLoad * 10)
}
if isTempPressValid() {
palt = uint16(mySituation.Pressure_alt + 5000)
vs = int16(mySituation.RateOfClimb)