MADS: Fix extra gear check

This commit is contained in:
Jason Wen
2024-07-11 15:46:24 +00:00
parent 606fb2d7c9
commit c1cd33dbc1
+3 -2
View File
@@ -460,8 +460,9 @@ class CarInterfaceBase(ABC):
events.add(EventName.doorOpen)
if cs_out.seatbeltUnlatched and cs_out.gearShifter != GearShifter.park:
events.add(EventName.seatbeltNotLatched)
if cs_out.gearShifter != GearShifter.drive and cs_out.gearShifter not in extra_gears and not \
(cs_out.gearShifter == GearShifter.unknown and self.gear_warning < int(0.5/DT_CTRL)):
if cs_out.gearShifter != GearShifter.drive and (extra_gears is None or
cs_out.gearShifter not in extra_gears) and not (cs_out.gearShifter == GearShifter.unknown and
self.gear_warning < int(0.5/DT_CTRL)):
if cs_out.vEgo < 5:
events.add(EventName.silentWrongGear)
else: