Ensure level signal doesn't block cal channel.

pull/641/head
Eric Westphal 2017-07-12 22:20:23 -04:00
rodzic 20877df847
commit 1877e66056
2 zmienionych plików z 6 dodań i 3 usunięć

@ -1 +1 @@
Subproject commit 3c8befa0067ddc9ce39b9b2c041fd6450583420a
Subproject commit b5bde4f8a9599a43e2f359854de82aed46809df5

Wyświetl plik

@ -181,7 +181,10 @@ func sensorAttitudeSender() {
if f := &globalSettings.SensorQuaternion; f[0]*f[0] + f[1]*f[1] + f[2]*f[2] + f[3]*f[3] > 0 {
s.SetSensorQuaternion(f)
} else {
cal <- "level"
select { // Don't block if cal isn't receiving: only need one calibration in the queue at a time.
case cal <- "level":
default:
}
}
failNum = 0
@ -314,7 +317,7 @@ func sensorAttitudeSender() {
// Send to AHRS debugging server.
if ahrswebListener != nil {
if err = ahrswebListener.Send(s.GetState(), m); err != nil {
log.Printf("Error writing to ahrsweb: %s\n", err)
log.Printf("AHRS Error: couldn't write to ahrsweb: %s\n", err)
ahrswebListener = nil
}
}