Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Scripting: catch NaN in view_path

This commit is contained in:
Andrew Tridgell 2022-10-26 21:33:37 +11:00
parent c0559935ed
commit 3dfbca62a6
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Scripting/examples/Aerobatics/Trajectory/view_paths.py
View File

@ -39,6 +39,8 @@ def view_path(viewer, path, color):
dist = math.sqrt(dx**2+dy**2+dz**2)+0.001
if dist <= 0:
continue
if math.isnan(p1.q[0]) or math.isnan(p1.q[1]) or math.isnan(p1.q[2]) or math.isnan(p1.q[3]):
continue
pname = 'p%u' % i
viewer.append_box('root', pname, (dist, 0.1, 0.002), frame=(p1.pos,qtuple(p1.q)))
viewer.set_material('root', pname, color_rgba=color)