Skip to content

Commit 5f32cd1

Browse files
committed
always log leads, we hide them in ui
1 parent bd782c9 commit 5f32cd1

File tree

1 file changed

+6
-10
lines changed

1 file changed

+6
-10
lines changed

selfdrive/controls/radard.py

+6-10
Original file line numberDiff line numberDiff line change
@@ -102,7 +102,7 @@ def __init__(self, radar_ts, delay=0):
102102

103103
self.ready = False
104104

105-
def update(self, sm, rr, enable_lead):
105+
def update(self, sm, rr):
106106
self.current_time = 1e-9*max(sm.logMonoTime.values())
107107

108108
if sm.updated['carState']:
@@ -169,11 +169,10 @@ def update(self, sm, rr, enable_lead):
169169
radarState.radarErrors = list(rr.errors)
170170
radarState.carStateMonoTime = sm.logMonoTime['carState']
171171

172-
if enable_lead:
173-
leads_v3 = sm['modelV2'].leadsV3
174-
if len(leads_v3) > 1:
175-
radarState.leadOne = get_lead(self.v_ego, self.ready, clusters, leads_v3[0], low_speed_override=True)
176-
radarState.leadTwo = get_lead(self.v_ego, self.ready, clusters, leads_v3[1], low_speed_override=False)
172+
leads_v3 = sm['modelV2'].leadsV3
173+
if len(leads_v3) > 1:
174+
radarState.leadOne = get_lead(self.v_ego, self.ready, clusters, leads_v3[0], low_speed_override=True)
175+
radarState.leadTwo = get_lead(self.v_ego, self.ready, clusters, leads_v3[1], low_speed_override=False)
177176
return dat
178177

179178

@@ -203,9 +202,6 @@ def radard_thread(sm=None, pm=None, can_sock=None):
203202
rk = Ratekeeper(1.0 / CP.radarTimeStep, print_delay_threshold=None)
204203
RD = RadarD(CP.radarTimeStep, RI.delay)
205204

206-
# TODO: always log leads once we can hide them conditionally
207-
enable_lead = CP.openpilotLongitudinalControl or not CP.radarOffCan
208-
209205
while 1:
210206
can_strings = messaging.drain_sock_raw(can_sock, wait_for_one=True)
211207
rr = RI.update(can_strings)
@@ -215,7 +211,7 @@ def radard_thread(sm=None, pm=None, can_sock=None):
215211

216212
sm.update(0)
217213

218-
dat = RD.update(sm, rr, enable_lead)
214+
dat = RD.update(sm, rr)
219215
dat.radarState.cumLagMs = -rk.remaining*1000.
220216

221217
pm.send('radarState', dat)

0 commit comments

Comments
 (0)