Finished gazebo conversion up to wrist_roll