ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
From reading your follow-up comments, it sounds like your quaternion operations are not working right. But what you are trying to do is already defined here: tf.quaternion_from_euler.
In fact, you are reinventing the wheel when you are using ROS libraries and then defining classes for Vector
and Quaternion
. These are fundamental elements and already exist in ROS. Your Vector is just geometry_msgsVector3 and Quaternion is geometry_msgsQuaternion and there are even stamped versions of these too.
If anything, you should extend those classes (def MyVector(Vector3): ...
) but if you are adding a name field, sounds like you are trying to identify them so just use a dict
of Vector
s
But first, you should edit your question to include the info you provided after people asked. Without those, we don't have much to work with, and it is an incomplete question.