mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-09-12 03:03:51 +08:00
FrogAi
ea6c0db16f
Maintain openpilot lateral control when the brake or gas pedals are used. Deactivation occurs only through the 'Cruise Control' button. Lots of credit goes to "pfeiferj"! Couldn't of done it without him! https: //github.com/pfeiferj/openpilot Co-Authored-By: Jacob Pfeifer <jacob@pfeifer.dev>
74 lines
2.0 KiB
Python
74 lines
2.0 KiB
Python
from cereal import car
|
|
from openpilot.selfdrive.car.chrysler.values import ChryslerFlags, RAM_CARS
|
|
|
|
GearShifter = car.CarState.GearShifter
|
|
VisualAlert = car.CarControl.HUDControl.VisualAlert
|
|
|
|
def create_lkas_hud(packer, CP, lkas_active, hud_alert, hud_count, car_model, auto_high_beam, lat_active):
|
|
# LKAS_HUD - Controls what lane-keeping icon is displayed
|
|
|
|
# == Color ==
|
|
# 0 hidden?
|
|
# 1 white
|
|
# 2 green
|
|
# 3 ldw
|
|
|
|
# == Lines ==
|
|
# 03 white Lines
|
|
# 04 grey lines
|
|
# 09 left lane close
|
|
# 0A right lane close
|
|
# 0B left Lane very close
|
|
# 0C right Lane very close
|
|
# 0D left cross cross
|
|
# 0E right lane cross
|
|
|
|
# == Alerts ==
|
|
# 7 Normal
|
|
# 6 lane departure place hands on wheel
|
|
|
|
color = 2 if lkas_active else 1 if lat_active else 0
|
|
lines = 3 if lkas_active else 0
|
|
alerts = 7 if lkas_active else 0
|
|
|
|
if hud_count < (1 * 4): # first 3 seconds, 4Hz
|
|
alerts = 1
|
|
|
|
if hud_alert in (VisualAlert.ldw, VisualAlert.steerRequired):
|
|
color = 4
|
|
lines = 0
|
|
alerts = 6
|
|
|
|
values = {
|
|
"LKAS_ICON_COLOR": color,
|
|
"CAR_MODEL": car_model,
|
|
"LKAS_LANE_LINES": lines,
|
|
"LKAS_ALERTS": alerts,
|
|
}
|
|
|
|
if CP.carFingerprint in RAM_CARS:
|
|
values['AUTO_HIGH_BEAM_ON'] = auto_high_beam
|
|
values['LKAS_DISABLED'] = 0 if lat_active else 1
|
|
|
|
return packer.make_can_msg("DAS_6", 0, values)
|
|
|
|
|
|
def create_lkas_command(packer, CP, apply_steer, lkas_control_bit):
|
|
# LKAS_COMMAND Lane-keeping signal to turn the wheel
|
|
enabled_val = 2 if CP.carFingerprint in RAM_CARS else 1
|
|
values = {
|
|
"STEERING_TORQUE": apply_steer,
|
|
"LKAS_CONTROL_BIT": enabled_val if lkas_control_bit else 0,
|
|
}
|
|
return packer.make_can_msg("LKAS_COMMAND", 0, values)
|
|
|
|
|
|
def create_cruise_buttons(packer, CP, frame, bus, cancel=False, resume=False):
|
|
values = {
|
|
"ACC_Cancel": cancel,
|
|
"ACC_Resume": resume,
|
|
"COUNTER": frame % 0x10,
|
|
}
|
|
button_message = "CRUISE_BUTTONS_ALT" if CP.flags & ChryslerFlags.RAM_HD_ALT_BUTTONS else "CRUISE_BUTTONS"
|
|
return packer.make_can_msg(button_message, bus, values)
|