Fix driveBackward regression
Add simple ramping to driveForward