new_csys_from_xpy: corrected calculation of vector inputs to math3d
This commit is contained in:
parent
77ef7b079d
commit
67cb0def09
@ -227,7 +227,7 @@ class Robot(URRobot):
|
|||||||
input("Move to second point and click Enter")
|
input("Move to second point and click Enter")
|
||||||
pose = URRobot.getl(self)
|
pose = URRobot.getl(self)
|
||||||
p2 = m3d.Vector(pose[:3])
|
p2 = m3d.Vector(pose[:3])
|
||||||
return m3d.Transform.new_from_xyp(p1 - p0, p2 - p0, p0)
|
return m3d.Transform.new_from_xyp(p0 - p1, p2 - p1, p1)
|
||||||
|
|
||||||
@property
|
@property
|
||||||
def x(self):
|
def x(self):
|
||||||
|
Loading…
x
Reference in New Issue
Block a user