Mazda: alert when LKAS is disabled (commaai#23273)

* Mazda: alert when LKAS is disabled Signed-off-by: Jafar Al-Gharaibeh <to.jafar@gmail.com> * Update selfdrive/controls/lib/events.py * Update selfdrive/car/mazda/interface.py * bump cereal Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
dkiiv · Dec 20, 2021 · f25121b · f25121b
1 parent cd7db7f
commit f25121b
Show file tree

Hide file tree

Showing 4 changed files with 14 additions and 3 deletions.
diff --git a/cereal b/cereal
diff --git a/selfdrive/car/mazda/carstate.py b/selfdrive/car/mazda/carstate.py
@@ -16,6 +16,7 @@ def __init__(self, CP):
     self.acc_active_last = False
     self.low_speed_alert = False
     self.lkas_allowed_speed = False
+    self.lkas_disabled = False
 
   def update(self, cp, cp_cam):
 
@@ -91,9 +92,12 @@ def update(self, cp, cp_cam):
 
     self.acc_active_last = ret.cruiseState.enabled
 
+    self.crz_btns_counter = cp.vl["CRZ_BTNS"]["CTR"]
+
+    # camera signals
+    self.lkas_disabled = cp_cam.vl["CAM_LANEINFO"]["LANE_LINES"] == 0
     self.cam_lkas = cp_cam.vl["CAM_LKAS"]
     self.cam_laneinfo = cp_cam.vl["CAM_LANEINFO"]
-    self.crz_btns_counter = cp.vl["CRZ_BTNS"]["CTR"]
     ret.steerError = cp_cam.vl["CAM_LKAS"]["ERR_BIT_1"] == 1
 
     return ret

diff --git a/selfdrive/car/mazda/interface.py b/selfdrive/car/mazda/interface.py
@@ -86,7 +86,9 @@ def update(self, c, can_strings):
     # events
     events = self.create_common_events(ret)
 
-    if self.CS.low_speed_alert:
+    if self.CS.lkas_disabled:
+      events.add(EventName.lkasDisabled)
+    elif self.CS.low_speed_alert:
       events.add(EventName.belowSteerSpeed)
 
     ret.events = events.to_msg()

diff --git a/selfdrive/controls/lib/events.py b/selfdrive/controls/lib/events.py
@@ -832,4 +832,9 @@ def joystick_alert(CP: car.CarParams, sm: messaging.SubMaster, metric: bool, sof
     ET.NO_ENTRY: NoEntryAlert("Cruise Fault: Restart the Car"),
   },
 
+  EventName.lkasDisabled: {
+    ET.PERMANENT: NormalPermanentAlert("LKAS Disabled: Enable LKAS to engage"),
+    ET.NO_ENTRY: NoEntryAlert("LKAS Disabled"),
+  },
+
 }