Added drive forward function to the autonomous.