toward solution for issue petercorke#226, need to deal properly with static joints

petercorke · petercorke · commit 25b57bad3f15 · 2021-05-09T14:26:56.000+10:00
diff --git a/roboticstoolbox/robot/ERobot.py b/roboticstoolbox/robot/ERobot.py
@@ -2102,7 +2102,10 @@ def rne(robot, q, qd, qdd, symbolic=False, gravity=None):
                 Xtree[j] = SE3(np.eye(4, dtype="O"), check=False)
             else:
                 Xtree[j] = SE3(link.Ts, check=False)
-            s[j] = link.v.s
+            if link.v is not None:
+                s[j] = link.v.s
+            else:
+                s[j] = None
 
         if gravity is None:
             a_grav = -SpatialAcceleration(robot.gravity)
