ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
Old question, but here is an answer.
You should use built-in libraries such as numpy in Python and not normalize yourself.
Here is how to do it in Python
quat = [q.x, q.y, q.z, q.w]
quat_norm = quat / np.linalg.norm(quat)
This should solve the issue