X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao_log.c;h=1b473c14eb1d6f3702696c399260c944517d34d1;hp=b24602e92beb13c70fb56e23c6e53ff1e1410bc5;hb=c7555eb16876aa8ff9fe7f648d325a1b8fb54d23;hpb=022f83ca6fd589005d8eb3e25e633950fef69fa7 diff --git a/ao_log.c b/ao_log.c index b24602e9..1b473c14 100644 --- a/ao_log.c +++ b/ao_log.c @@ -3,8 +3,7 @@ * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. + * the Free Software Foundation; version 2 of the License. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of @@ -18,10 +17,10 @@ #include "ao.h" -__data uint32_t ao_log_current_pos; -__data uint32_t ao_log_start_pos; -__xdata uint8_t ao_log_running; -__xdata uint8_t ao_log_mutex; +static __pdata uint32_t ao_log_current_pos; +static __pdata uint32_t ao_log_start_pos; +static __xdata uint8_t ao_log_running; +static __xdata uint8_t ao_log_mutex; static uint8_t ao_log_csum(uint8_t *b) @@ -142,7 +141,7 @@ ao_log(void) log.u.sensor.accel = ao_adc_ring[ao_log_adc_pos].accel; log.u.sensor.pres = ao_adc_ring[ao_log_adc_pos].pres; ao_log_data(&log); - if (ao_log_adc_pos == 0) { + if ((ao_log_adc_pos & 0x1f) == 0) { log.type = AO_LOG_TEMP_VOLT; log.tick = ao_adc_ring[ao_log_adc_pos].tick; log.u.temp_volt.temp = ao_adc_ring[ao_log_adc_pos].temp; @@ -179,6 +178,25 @@ ao_log_stop(void) ao_log_flush(); } +static void +dump_log(void) +{ + __xdata uint8_t more; + + for (more = ao_log_dump_first(); more; more = ao_log_dump_next()) { + printf("%c %4x %4x %4x\n", + ao_log_dump.type, + ao_log_dump.tick, + ao_log_dump.u.anon.d0, + ao_log_dump.u.anon.d1); + } +} + +__code struct ao_cmds ao_log_cmds[] = { + { 'l', dump_log, "l Dump last flight log" }, + { 0, dump_log, NULL }, +}; + static __xdata struct ao_task ao_log_task; void @@ -192,5 +210,6 @@ ao_log_init(void) ao_log_state = ao_flight_invalid; /* Create a task to log events to eeprom */ - ao_add_task(&ao_log_task, ao_log); + ao_add_task(&ao_log_task, ao_log, "log"); + ao_cmd_register(&ao_log_cmds[0]); }