Put together the pieces for reorient_robot