mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-06 22:22:11 +08:00
Clip v_cruise to V_CRUISE_MAX
old-commit-hash: ef330078130f71f93b3e81e9839c3386fe55946f
This commit is contained in:
@@ -13,6 +13,7 @@ from selfdrive.controls.lib.speed_smoother import speed_smoother
|
||||
from selfdrive.controls.lib.longcontrol import LongCtrlState, MIN_CAN_SPEED
|
||||
from selfdrive.controls.lib.fcw import FCWChecker
|
||||
from selfdrive.controls.lib.long_mpc import LongitudinalMpc
|
||||
from selfdrive.controls.lib.drive_helpers import V_CRUISE_MAX
|
||||
|
||||
MAX_SPEED = 255.0
|
||||
|
||||
@@ -122,6 +123,8 @@ class Planner():
|
||||
long_control_state = sm['controlsState'].longControlState
|
||||
v_cruise_kph = sm['controlsState'].vCruise
|
||||
force_slow_decel = sm['controlsState'].forceDecel
|
||||
|
||||
v_cruise_kph = min(v_cruise_kph, V_CRUISE_MAX)
|
||||
v_cruise_setpoint = v_cruise_kph * CV.KPH_TO_MS
|
||||
|
||||
lead_1 = sm['radarState'].leadOne
|
||||
|
||||
Reference in New Issue
Block a user