Perception, Planning and Control for Mobile Robots

Convert from Rotation matrix to axis-angle representation