|
|
@ -141,8 +141,9 @@ class Laikad: |
|
|
|
# Check time and outputs are valid |
|
|
|
# Check time and outputs are valid |
|
|
|
valid = self.kf_valid(t) |
|
|
|
valid = self.kf_valid(t) |
|
|
|
if not all(valid): |
|
|
|
if not all(valid): |
|
|
|
|
|
|
|
if not valid[0]: # Filter not initialized |
|
|
|
if not valid[1]: |
|
|
|
pass |
|
|
|
|
|
|
|
elif not valid[1]: |
|
|
|
cloudlog.error("Time gap of over 10s detected, gnss kalman reset") |
|
|
|
cloudlog.error("Time gap of over 10s detected, gnss kalman reset") |
|
|
|
elif not valid[2]: |
|
|
|
elif not valid[2]: |
|
|
|
cloudlog.error("Gnss kalman filter state is nan") |
|
|
|
cloudlog.error("Gnss kalman filter state is nan") |
|
|
|