Final changes to robot movement