Made swapping air/ground controllers more robust
Added a state machine for toggling ground or flight modes