Tested and debugged the movement in autonomous