Added on-demand preemption of navigation and charging state machines

Preemption done using the deadman switch of the gamepad. State machines resume when it is released. Other sources for pause/resume will be added later, as discussed in issue #42