diff --git a/sunnypilot/selfdrive/controls/lib/speed_limit/speed_limit_assist.py b/sunnypilot/selfdrive/controls/lib/speed_limit/speed_limit_assist.py index c3e431bdc1..a543ff5dab 100644 --- a/sunnypilot/selfdrive/controls/lib/speed_limit/speed_limit_assist.py +++ b/sunnypilot/selfdrive/controls/lib/speed_limit/speed_limit_assist.py @@ -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