Make use of reconfigure levels
Add quaternion controls to reconfigure
Add RPY in degrees