Skip to content

Commit de045fc

Browse files
committed
use controlsState.active for now
1 parent cb1cb51 commit de045fc

File tree

4 files changed

+6
-6
lines changed

4 files changed

+6
-6
lines changed

selfdrive/controls/lib/desire_helper.py

+2-2
Original file line numberDiff line numberDiff line change
@@ -40,12 +40,12 @@ def __init__(self):
4040
self.prev_one_blinker = False
4141
self.desire = log.LateralPlan.Desire.none
4242

43-
def update(self, carstate, lat_active, lane_change_prob):
43+
def update(self, carstate, active, lane_change_prob):
4444
v_ego = carstate.vEgo
4545
one_blinker = carstate.leftBlinker != carstate.rightBlinker
4646
below_lane_change_speed = v_ego < LANE_CHANGE_SPEED_MIN
4747

48-
if not lat_active or self.lane_change_timer > LANE_CHANGE_TIME_MAX:
48+
if not active or self.lane_change_timer > LANE_CHANGE_TIME_MAX:
4949
self.lane_change_state = LaneChangeState.off
5050
self.lane_change_direction = LaneChangeDirection.none
5151
else:

selfdrive/controls/lib/lateral_planner.py

+2-2
Original file line numberDiff line numberDiff line change
@@ -49,7 +49,7 @@ def update(self, sm):
4949

5050
# Lane change logic
5151
lane_change_prob = self.LP.l_lane_change_prob + self.LP.r_lane_change_prob
52-
self.DH.update(sm['carState'], sm['carControl'].actuators.latActive, lane_change_prob)
52+
self.DH.update(sm['carState'], sm['controlsState'].active, lane_change_prob)
5353

5454
# Turn off lanes during lane change
5555
if self.DH.desire == log.LateralPlan.Desire.laneChangeRight or self.DH.desire == log.LateralPlan.Desire.laneChangeLeft:
@@ -100,7 +100,7 @@ def update(self, sm):
100100
def publish(self, sm, pm):
101101
plan_solution_valid = self.solution_invalid_cnt < 2
102102
plan_send = messaging.new_message('lateralPlan')
103-
plan_send.valid = sm.all_alive_and_valid(service_list=['carState', 'controlsState', 'carControl', 'modelV2'])
103+
plan_send.valid = sm.all_alive_and_valid(service_list=['carState', 'controlsState', 'modelV2'])
104104

105105
lateralPlan = plan_send.lateralPlan
106106
lateralPlan.laneWidth = float(self.LP.lane_width)

selfdrive/controls/plannerd.py

+1-1
Original file line numberDiff line numberDiff line change
@@ -26,7 +26,7 @@ def plannerd_thread(sm=None, pm=None):
2626
lateral_planner = LateralPlanner(CP, use_lanelines=use_lanelines, wide_camera=wide_camera)
2727

2828
if sm is None:
29-
sm = messaging.SubMaster(['carState', 'controlsState', 'carControl', 'radarState', 'modelV2'],
29+
sm = messaging.SubMaster(['carState', 'controlsState', 'radarState', 'modelV2'],
3030
poll=['radarState', 'modelV2'], ignore_avg_freq=['radarState'])
3131

3232
if pm is None:

selfdrive/test/process_replay/process_replay.py

+1-1
Original file line numberDiff line numberDiff line change
@@ -265,7 +265,7 @@ def ublox_rcv_callback(msg):
265265
proc_name="plannerd",
266266
pub_sub={
267267
"modelV2": ["lateralPlan", "longitudinalPlan"],
268-
"carState": [], "controlsState": [], "carControl": [], "radarState": [],
268+
"carState": [], "controlsState": [], "radarState": [],
269269
},
270270
ignore=["logMonoTime", "valid", "longitudinalPlan.processingDelay", "longitudinalPlan.solverExecutionTime", "lateralPlan.solverExecutionTime"],
271271
init_callback=get_car_params,

0 commit comments

Comments
 (0)