mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-07-19 06:02:06 +08:00
more
This commit is contained in:
@@ -829,11 +829,12 @@ class Controls:
|
||||
self.prev_overtaking_accel_engaged = self.overtaking_accel_engaged
|
||||
ttc = self.sm['radarState'].leadOne.dRel / CS.vEgo if CS.vEgo > 0 else 255
|
||||
overtaking_accel_engaged = self.overtaking_accel and overtaking_accel_allowed and \
|
||||
(CS.vEgo > ((60 * CV.KPH_TO_MS) if self.is_metric else (40 * CV.MPH_TO_MS))) and long_plan.hasLead and \
|
||||
long_plan.aTarget > -0.2 and not (CS.leftBlinker and CS.rightBlinker) and (0.75 < ttc < 3.0)
|
||||
if ttc <= 0.75 and self.prev_overtaking_accel_engaged and overtaking_accel_engaged:
|
||||
(CS.vEgo > ((60 * CV.KPH_TO_MS) if self.is_metric else (40 * CV.MPH_TO_MS))) and \
|
||||
not (CS.leftBlinker and CS.rightBlinker)
|
||||
if ttc < 0.75 and self.prev_overtaking_accel_engaged and overtaking_accel_engaged:
|
||||
overtaking_accel_engaged = False
|
||||
if overtaking_accel_engaged and not self.prev_overtaking_accel_engaged:
|
||||
if overtaking_accel_engaged and not self.prev_overtaking_accel_engaged and \
|
||||
long_plan.hasLead and long_plan.aTarget > -0.1 and (0.75 < ttc < 3.0):
|
||||
self.overtaking_accel_engaged = True
|
||||
elif not overtaking_accel_engaged:
|
||||
self.overtaking_accel_engaged = False
|
||||
|
||||
@@ -82,7 +82,7 @@ def get_T_FOLLOW(personality=custom.LongitudinalPersonalitySP.standard):
|
||||
elif personality==custom.LongitudinalPersonalitySP.aggressive:
|
||||
return 1.0
|
||||
elif personality==custom.LongitudinalPersonalitySP.overtake:
|
||||
return 0.3
|
||||
return 0.25
|
||||
else:
|
||||
raise NotImplementedError("Longitudinal personality not supported")
|
||||
|
||||
|
||||
Reference in New Issue
Block a user