There may also be some user interface issues here. We may find that users would prefer to stop with the waypoint still in the camera view, rather than with it invisibly under the bottom dead center of the robot. For this reason, we may want to consider position uncertainty in the stopping position. If the position is possibly in error, we want to stop before we pass the terminal point so that the user can do another command to home in on the desired location.