Candy0707 3 weeks ago committed by GitHub
commit 11c7199642
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
  1. 8
      selfdrive/controls/controlsd.py

@ -138,6 +138,8 @@ class Controls:
def publish(self, CC, lac_log): def publish(self, CC, lac_log):
CS = self.sm['carState'] CS = self.sm['carState']
model_v2 = self.sm['modelV2']
# Orientation and angle rates can be useful for carcontroller # Orientation and angle rates can be useful for carcontroller
# Only calibrated (car) frame is relevant for the carcontroller # Only calibrated (car) frame is relevant for the carcontroller
@ -158,8 +160,10 @@ class Controls:
hudControl.leadDistanceBars = self.sm['selfdriveState'].personality.raw + 1 hudControl.leadDistanceBars = self.sm['selfdriveState'].personality.raw + 1
hudControl.visualAlert = self.sm['selfdriveState'].alertHudVisual hudControl.visualAlert = self.sm['selfdriveState'].alertHudVisual
hudControl.rightLaneVisible = True laneVisible = len(model_v2.laneLines) > 2 and len(model_v2.laneLineProbs) > 2
hudControl.leftLaneVisible = True hudControl.leftLaneVisible = bool(laneVisible and len(model_v2.laneLines[1].x) > 0 and model_v2.laneLineProbs[1] > 0.5)
hudControl.rightLaneVisible = bool(laneVisible and len(model_v2.laneLines[2].x) > 0 and model_v2.laneLineProbs[2] > 0.5)
if self.sm.valid['driverAssistance']: if self.sm.valid['driverAssistance']:
hudControl.leftLaneDepart = self.sm['driverAssistance'].leftLaneDeparture hudControl.leftLaneDepart = self.sm['driverAssistance'].leftLaneDeparture
hudControl.rightLaneDepart = self.sm['driverAssistance'].rightLaneDeparture hudControl.rightLaneDepart = self.sm['driverAssistance'].rightLaneDeparture

Loading…
Cancel
Save