def test_convert(self):
p = tf2_ros.Stamped(PyKDL.Vector(1, 2, 3),
builtin_interfaces.msg.Time(sec=0), 'my_frame')
msg = tf2_ros.convert(p, PointStamped)
p2 = tf2_ros.convert(msg, PyKDL.Vector)
self.assertEqual(p2[0], p[0])
self.assertEqual(p2[1], p[1])
self.assertEqual(p2[2], p[2])
self.assertEqual(p2.header, p.header)
def test_convert(self):
p = tf2_ros.Stamped(PyKDL.Vector(1, 2, 3), rospy.Time(), 'my_frame')
print(p)
msg = tf2_ros.convert(p, PointStamped)
print(msg)
p2 = tf2_ros.convert(msg, PyKDL.Vector)
print(p2)
p2[0] = 100
print(p)
print(p2)
print(p2.header)
def test_convert(self):
p = tf2_ros.Stamped(PyKDL.Vector(1, 2, 3), rospy.Time(), 'my_frame')
print p
msg = tf2_ros.convert(p, PointStamped)
print msg
p2 = tf2_ros.convert(msg, PyKDL.Vector)
print p2
p2[0] = 100
print p
print p2
print p2.header
def convert():
v = PyKDL.Vector(1,2,3)
vs = tf2_ros.Stamped(v, rospy.Time(2), 'a')
vs2 = tf2_ros.convert(vs, PyKDL.Vector)
vs2[1] = 100
print vs2
print v
def convert():
v = PyKDL.Vector(1, 2, 3)
vs = tf2_ros.Stamped(v, rospy.Time(2), 'a')
vs2 = tf2_ros.convert(vs, PyKDL.Vector)
vs2[1] = 100
print vs2
print v
def test_convert(self):
v = PyKDL.Vector(1, 2, 3)
vs = tf2_ros.Stamped(v, rospy.Time(2), 'a')
vs2 = tf2_ros.convert(vs, PyKDL.Vector)
self.assertEqual(vs.x(), 1)
self.assertEqual(vs.y(), 2)
self.assertEqual(vs.z(), 3)
self.assertEqual(vs2.x(), 1)
self.assertEqual(vs2.y(), 2)
self.assertEqual(vs2.z(), 3)
def test_convert(self):
v = PyKDL.Vector(1,2,3)
vs = tf2_ros.Stamped(v, rospy.Time(2), 'a')
vs2 = tf2_ros.convert(vs, PyKDL.Vector)
self.assertEqual(vs.x(), 1)
self.assertEqual(vs.y(), 2)
self.assertEqual(vs.z(), 3)
self.assertEqual(vs2.x(), 1)
self.assertEqual(vs2.y(), 2)
self.assertEqual(vs2.z(), 3)
def test_convert(self):
v = PyKDL.Vector(1,2,3)
vs = tf2_ros.Stamped(v, builtin_interfaces.msg.Time(sec=2), 'a')
vs2 = tf2_ros.convert(vs, PyKDL.Vector)
self.assertEqual(vs.x(), 1)
self.assertEqual(vs.y(), 2)
self.assertEqual(vs.z(), 3)
self.assertEqual(vs2.x(), 1)
self.assertEqual(vs2.y(), 2)
self.assertEqual(vs2.z(), 3)