fix petercorke#252

jhavl · jhavl · commit bab65bc09d59 · 2021-09-13T13:42:26.000+10:00
diff --git a/roboticstoolbox/robot/DHRobot.py b/roboticstoolbox/robot/DHRobot.py
@@ -1415,8 +1415,8 @@ def removesmall(x):
 
             if self._base is not None:
                 Rb = t2r(self.base.A).T
-                w = Rb @ wd
-                wd = Rb @ wdd
+                w = Rb @ w
+                wd = Rb @ wd
                 vd = Rb @ gravity
 
             # ----------------  initialize some variables ----------------- #
