Move robot to finish