wip
This commit is contained in:
@@ -171,10 +171,12 @@ class FrogPilotPlanner:
|
|||||||
else:
|
else:
|
||||||
self.vtsc_target = v_cruise
|
self.vtsc_target = v_cruise
|
||||||
|
|
||||||
if self.CSLC:
|
# if self.CSLC:
|
||||||
v_ego_diff = 0
|
# v_ego_diff = 0
|
||||||
else:
|
# else:
|
||||||
|
|
||||||
v_ego_diff = max(carState.vEgoRaw - carState.vEgoCluster, 0)
|
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
|
return min(v_cruise, self.mtsc_target, self.slc_target, self.vtsc_target) - v_ego_diff
|
||||||
|
|
||||||
def publish_lateral(self, sm, pm, DH):
|
def publish_lateral(self, sm, pm, DH):
|
||||||
|
|||||||
Reference in New Issue
Block a user