|
|
@ -202,7 +202,7 @@ class Controls: |
|
|
|
self.events.add(EventName.commIssue) |
|
|
|
self.events.add(EventName.commIssue) |
|
|
|
if not self.sm['pathPlan'].mpcSolutionValid: |
|
|
|
if not self.sm['pathPlan'].mpcSolutionValid: |
|
|
|
self.events.add(EventName.plannerError) |
|
|
|
self.events.add(EventName.plannerError) |
|
|
|
if not self.sm['liveLocationKalman'].inputsOK and os.getenv("NOSENSOR") is None: |
|
|
|
if not self.sm['liveLocationKalman'].sensorsOK and os.getenv("NOSENSOR") is None: |
|
|
|
if self.sm.frame > 5 / DT_CTRL: # Give locationd some time to receive all the inputs |
|
|
|
if self.sm.frame > 5 / DT_CTRL: # Give locationd some time to receive all the inputs |
|
|
|
self.events.add(EventName.sensorDataInvalid) |
|
|
|
self.events.add(EventName.sensorDataInvalid) |
|
|
|
if not self.sm['liveLocationKalman'].gpsOK and (self.distance_traveled > 1000) and os.getenv("NOSENSOR") is None: |
|
|
|
if not self.sm['liveLocationKalman'].gpsOK and (self.distance_traveled > 1000) and os.getenv("NOSENSOR") is None: |
|
|
|