mawei/sunnypilot
1
0
Fork 0
mirror of https://github.com/sunnypilot/sunnypilot.git synced 2026-02-19 10:03:55 +08:00
Code Issues Packages Projects Releases Wiki Activity

longitudinal maneuver report: require two frames above target (#33602)

Browse Source 
require two frames
This commit is contained in:
Shane Smiskol
2024-09-19 14:14:22 -07:00
committed by GitHub
parent 81a0e3716e
commit 91e342fc58
1 changed files with 6 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
tools/longitudinal_maneuvers/generate_report.py
View File

@@ -59,13 +59,18 @@ def report(platform, route, _description, CP, maneuvers):
aTarget = longitudinalPlan[0].aTarget
target_cross_time = None
f.write(f'<h3 style="font-weight: normal">Initial aTarget: {aTarget} m/s^2')
# Localizer is noisy, require two consecutive 20Hz frames above threshold
prev_crossed = False
for t, lp in zip(t_livePose, livePose, strict=True):
if (0 < aTarget < lp.accelerationDevice.x) or (0 > aTarget > lp.accelerationDevice.x):
crossed = (0 < aTarget < lp.accelerationDevice.x) or (0 > aTarget > lp.accelerationDevice.x)
if crossed and prev_crossed:
f.write(f', <strong>crossed in {t:.3f}s</strong>')
target_cross_time = t
if maneuver_valid:
target_cross_times[description].append(t)
break
prev_crossed = crossed
else:
f.write(', <strong>not crossed</strong>')
f.write('</h3>')