Added switch behavior. DriveEnable must be on and switch A must be off to drive autonomously.