Added clipping to drive forward command and cleaned up auton selector