X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_flight.c;h=f50491d921b06cda84c709b9684a380774e68174;hb=036400a2db303f3db3be7cc0426f88359c6bd2b1;hp=92c955fbfb4dfc53c4101cad6514cc96cf2b6b37;hpb=144db05f6b286a0450d486f69ce192632a2c0656;p=fw%2Faltos diff --git a/src/ao_flight.c b/src/ao_flight.c index 92c955fb..f50491d9 100644 --- a/src/ao_flight.c +++ b/src/ao_flight.c @@ -454,27 +454,8 @@ ao_flight(void) } } -#define AO_ACCEL_COUNT_TO_MSS(count) ((count) / 27) -#define AO_VEL_COUNT_TO_MS(count) ((int16_t) ((count) / 2700)) - -static void -ao_flight_status(void) __reentrant -{ - printf("STATE: %7s accel: %d speed: %d altitude: %d main: %d\n", - ao_state_names[ao_flight_state], - AO_ACCEL_COUNT_TO_MSS( - ao_flight_accel), - AO_VEL_COUNT_TO_MS(ao_flight_vel), - ao_pres_to_altitude(ao_flight_pres), - ao_pres_to_altitude(ao_main_pres)); -} - static __xdata struct ao_task flight_task; -__code struct ao_cmds ao_flight_cmds[] = { - { 'f', ao_flight_status, "f Display current flight state" }, - { 0, ao_flight_status, NULL } -}; - void ao_flight_init(void) { @@ -486,5 +467,4 @@ ao_flight_init(void) ao_interval_end = AO_INTERVAL_TICKS; ao_add_task(&flight_task, ao_flight, "flight"); - ao_cmd_register(&ao_flight_cmds[0]); }