Reverting first setpoint for autonomous back to current position. Was swtiched to (0, 0) for optical flow.