This commit is contained in:
Jason Wen
2025-09-20 11:46:22 -04:00
parent 3f300b52ce
commit 2f76a9be3d
@@ -45,8 +45,8 @@ class SpeedLimitAssist:
a_ego: float
v_offset: float
last_valid_speed_limit_final: float
output_v_target: float
output_a_target: float
output_v_target: float = V_CRUISE_UNSET
output_a_target: float = 0.
def __init__(self, CP):
self.params = Params()
@@ -112,6 +112,10 @@ class SpeedLimitAssist:
# Fallback
return V_CRUISE_UNSET
# TODO-SP: SLA's own output_a_target for planner
def get_a_target_from_control(self) -> float:
return self.a_ego
def update_params(self) -> None:
if self.frame % int(PARAMS_UPDATE_PERIOD / DT_MDL) == 0:
self.is_metric = self.params.get_bool("IsMetric")
@@ -239,5 +243,6 @@ class SpeedLimitAssist:
self.long_enabled_prev = self.long_enabled
self.output_v_target = self.get_v_target_from_control()
self.output_a_target = self.get_a_target_from_control()
self.frame += 1