Convert a C{geometry_msgs/TransformStamped} into position/quaternion np arrays @param msg: ROS message to be converted @return: - p: position as a np.array - q: quaternion as a numpy array (order = [x,y,z,w])
(msg)
| 50 | |
| 51 | |
| 52 | def transform_stamped_to_pq(msg): |
| 53 | """Convert a C{geometry_msgs/TransformStamped} into position/quaternion np arrays |
| 54 | |
| 55 | @param msg: ROS message to be converted |
| 56 | @return: |
| 57 | - p: position as a np.array |
| 58 | - q: quaternion as a numpy array (order = [x,y,z,w]) |
| 59 | """ |
| 60 | return transform_to_pq(msg.transform) |
| 61 | |
| 62 | |
| 63 | def msg_to_se3(msg): |
no test coverage detected