Cleaned up code for transition between DrivingStraight, AdjustingSpeed and Stopped.