From 88785baa1101caf5c43f8c39f9688215e254ab5d Mon Sep 17 00:00:00 2001 From: Your Name Date: Thu, 8 Feb 2024 14:36:45 -0600 Subject: [PATCH] wip --- selfdrive/frogpilot/functions/frogpilot_planner.py | 10 ++++++---- 1 file changed, 6 insertions(+), 4 deletions(-) diff --git a/selfdrive/frogpilot/functions/frogpilot_planner.py b/selfdrive/frogpilot/functions/frogpilot_planner.py index 4d0fea7..b469d93 100644 --- a/selfdrive/frogpilot/functions/frogpilot_planner.py +++ b/selfdrive/frogpilot/functions/frogpilot_planner.py @@ -171,10 +171,12 @@ class FrogPilotPlanner: else: self.vtsc_target = v_cruise - if self.CSLC: - v_ego_diff = 0 - else: - v_ego_diff = max(carState.vEgoRaw - carState.vEgoCluster, 0) + # if self.CSLC: + # v_ego_diff = 0 + # else: + + v_ego_diff = max(carState.vEgoRaw - carState.vEgoCluster, 0) + return min(v_cruise, self.mtsc_target, self.slc_target, self.vtsc_target) - v_ego_diff def publish_lateral(self, sm, pm, DH):