FrogPilot features - Disable below steer speed event after it's been shown

This commit is contained in:
FrogAi
2024-04-08 15:21:18 -07:00
parent bdd91f2bb0
commit f85b4898ac
2 changed files with 9 additions and 1 deletions
+6 -1
View File
@@ -330,8 +330,13 @@ class CarInterface(CarInterfaceBase):
events.add(EventName.belowEngageSpeed)
if ret.cruiseState.standstill and not self.CP.autoResumeSng:
events.add(EventName.resumeRequired)
if ret.vEgo < self.CP.minSteerSpeed:
if ret.vEgo < self.CP.minSteerSpeed and not self.disable_belowSteerSpeed:
events.add(EventName.belowSteerSpeed)
self.belowSteerSpeed_shown = True
# Disable the "belowSteerSpeed" event after it's been shown once to not annoy the driver
if self.belowSteerSpeed_shown and ret.vEgo >= self.CP.minSteerSpeed:
self.disable_belowSteerSpeed = True
if (self.CP.flags & GMFlags.CC_LONG.value) and ret.vEgo < self.CP.minEnableSpeed and ret.cruiseState.enabled:
events.add(EventName.speedTooLow)
+3
View File
@@ -115,6 +115,9 @@ class CarInterfaceBase(ABC):
self.params = Params()
self.params_memory = Params("/dev/shm/params")
self.belowSteerSpeed_shown = False
self.disable_belowSteerSpeed = False
def apply(self, c: car.CarControl, now_nanos: int, frogpilot_toggles) -> tuple[car.CarControl.Actuators, list[tuple[int, int, bytes, int]]]:
return self.CC.update(c, self.CS, now_nanos, frogpilot_toggles)