Perception, Planning and Control for Mobile Robots

Euler angles to Rotation matrix and vice versa