- ao_add_task(&mp_task, ao_micropeak, "micropeak");
- ao_cmd_register(mp_cmd);
+ if (ao_on_battery) {
+ /* On battery power, run the flight code */
+ ao_add_task(&mp_task, ao_micropeak, "micropeak");
+ } else {
+ /* otherwise, turn on USB and run the command processor */
+ ao_usb_init();
+ ao_cmd_init();
+ ao_cmd_register(mp_cmd);
+ }