|
|
@ -129,7 +129,7 @@ class Planner(): |
|
|
|
following = lead_1.status and lead_1.dRel < 45.0 and lead_1.vLeadK > v_ego and lead_1.aLeadK > 0.0 |
|
|
|
following = lead_1.status and lead_1.dRel < 45.0 and lead_1.vLeadK > v_ego and lead_1.aLeadK > 0.0 |
|
|
|
|
|
|
|
|
|
|
|
# Calculate speed for normal cruise control |
|
|
|
# Calculate speed for normal cruise control |
|
|
|
if enabled and not self.first_loop: |
|
|
|
if enabled and not self.first_loop and not sm['carState'].gasPressed: |
|
|
|
accel_limits = [float(x) for x in calc_cruise_accel_limits(v_ego, following)] |
|
|
|
accel_limits = [float(x) for x in calc_cruise_accel_limits(v_ego, following)] |
|
|
|
jerk_limits = [min(-0.1, accel_limits[0]), max(0.1, accel_limits[1])] # TODO: make a separate lookup for jerk tuning |
|
|
|
jerk_limits = [min(-0.1, accel_limits[0]), max(0.1, accel_limits[1])] # TODO: make a separate lookup for jerk tuning |
|
|
|
accel_limits_turns = limit_accel_in_turns(v_ego, sm['carState'].steeringAngle, accel_limits, self.CP) |
|
|
|
accel_limits_turns = limit_accel_in_turns(v_ego, sm['carState'].steeringAngle, accel_limits, self.CP) |
|
|
|