AP_Scripting: catch NaN in view_path

2022-10-26 21:33:37 +11:00 · 2022-10-26 21:33:37 +11:00 · 3dfbca62a6
commit 3dfbca62a6
parent c0559935ed
1 changed files with 2 additions and 0 deletions
--- a/libraries/AP_Scripting/examples/Aerobatics/Trajectory/view_paths.py
+++ b/libraries/AP_Scripting/examples/Aerobatics/Trajectory/view_paths.py
@ -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)