Enhance DriveDistance command

Add the following enhancements to the DriveDistance command:
* Provide method so one can enable an optional feature so the command can end if the gear plate is pressed.
* Provide method so one can enable an optional feature so the command can end normally if a time expires.
* Update the normal is finished check so that the distance is verified more than once before terminating the command (in case we go past and need to come back a bit)