Bug in UrdfVisual RPY to Quaternion conversion fixed