kopia lustrzana https://github.com/cyoung/stratux
rodzic
7fd67ccbc1
commit
5f1ebfbe70
|
|
@ -268,23 +268,23 @@ func makeOwnshipReport() bool {
|
||||||
}
|
}
|
||||||
|
|
||||||
// This is **PRESSURE ALTITUDE**
|
// This is **PRESSURE ALTITUDE**
|
||||||
//FIXME: Temporarily removing "invalid altitude" when pressure altitude not available - using GPS altitude instead.
|
alt := uint16(0xFFF) // 0xFFF "invalid altitude."
|
||||||
// alt := uint16(0xFFF) // 0xFFF "invalid altitude."
|
validAltf := false
|
||||||
|
|
||||||
var alt uint16
|
|
||||||
var altf float64
|
var altf float64
|
||||||
|
|
||||||
if selfOwnshipValid {
|
if selfOwnshipValid {
|
||||||
altf = float64(curOwnship.Alt)
|
altf = float64(curOwnship.Alt)
|
||||||
|
validAltf = true
|
||||||
} else if isTempPressValid() {
|
} else if isTempPressValid() {
|
||||||
altf = float64(mySituation.Pressure_alt)
|
altf = float64(mySituation.Pressure_alt)
|
||||||
} else {
|
validAltf = true
|
||||||
altf = float64(mySituation.Alt) //FIXME: Pass GPS altitude if PA not available. **WORKAROUND FOR FF**
|
|
||||||
}
|
}
|
||||||
|
|
||||||
altf = (altf + 1000) / 25
|
if validAltf {
|
||||||
|
altf = (altf + 1000) / 25
|
||||||
alt = uint16(altf) & 0xFFF // Should fit in 12 bits.
|
alt = uint16(altf) & 0xFFF // Should fit in 12 bits.
|
||||||
|
}
|
||||||
|
|
||||||
msg[11] = byte((alt & 0xFF0) >> 4) // Altitude.
|
msg[11] = byte((alt & 0xFF0) >> 4) // Altitude.
|
||||||
msg[12] = byte((alt & 0x00F) << 4)
|
msg[12] = byte((alt & 0x00F) << 4)
|
||||||
|
|
|
||||||
Ładowanie…
Reference in New Issue