Skip to content

Commit 58c75ea

Browse files
committed
Reflect changes to SMTB twist
1 parent 8893f19 commit 58c75ea

File tree

1 file changed

+6
-6
lines changed

1 file changed

+6
-6
lines changed

roboticstoolbox/robot/DHRobot.py

Lines changed: 6 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -735,24 +735,24 @@ def twists(self, q=None):
735735
# MDH case
736736
for j, link in enumerate(self):
737737
if link.sigma == 0:
738-
tw[j] = Twist3.R(T[j].a, T[j].t)
738+
tw[j] = Twist3.Revolute(T[j].a, T[j].t)
739739
else:
740-
tw[j] = Twist3.P(T[j].a)
740+
tw[j] = Twist3.Prismatic(T[j].a)
741741
else:
742742
# DH case
743743
for j, link in enumerate(self):
744744
if j == 0:
745745
# first link case
746746
if link.sigma == 0:
747-
tw[j] = Twist3.R([0, 0, 1], [0, 0, 0]) # revolute
747+
tw[j] = Twist3.Revolute([0, 0, 1], [0, 0, 0]) # revolute
748748
else:
749-
tw[j] = Twist3.P([0, 0, 1]) # prismatic
749+
tw[j] = Twist3.Prismatic([0, 0, 1]) # prismatic
750750
else:
751751
# subsequent links
752752
if link.sigma == 0:
753-
tw[j] = Twist3.R(T[j-1].a, T[j-1].t) # revolute
753+
tw[j] = Twist3.Revolute(T[j-1].a, T[j-1].t) # revolute
754754
else:
755-
tw[j] = Twist3.P(T[j-1].a) # prismatic
755+
tw[j] = Twist3.Prismatic(T[j-1].a) # prismatic
756756

757757
return tw, T[-1]
758758

0 commit comments

Comments
 (0)