diff options
author | Keith Packard <keithp@keithp.com> | 2009-06-04 10:41:34 -0700 |
---|---|---|
committer | Keith Packard <keithp@keithp.com> | 2009-06-04 10:41:34 -0700 |
commit | 210dbaa23cdacf3a6f2d6e23493e96ee2ac9bca7 (patch) | |
tree | 42dbabd0caa7186c898da746014341d3ff31a201 /src/ao_report.c | |
parent | 8cce307bb3156584ba17ae5a787f645dfee5fb94 (diff) |
Use autotools, move altos to src subdir
Signed-off-by: Keith Packard <keithp@keithp.com>
Diffstat (limited to 'src/ao_report.c')
-rw-r--r-- | src/ao_report.c | 122 |
1 files changed, 122 insertions, 0 deletions
diff --git a/src/ao_report.c b/src/ao_report.c new file mode 100644 index 00000000..e52b2928 --- /dev/null +++ b/src/ao_report.c @@ -0,0 +1,122 @@ +/* + * Copyright © 2009 Keith Packard <keithp@keithp.com> + * + * 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; 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 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + * + * You should have received a copy of the GNU General Public License along + * with this program; if not, write to the Free Software Foundation, Inc., + * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. + */ + +#include "ao.h" + +static const char * __xdata flight_reports[] = { + "...", /* startup, 'S' */ + "..", /* idle 'I' */ + ".--.", /* launchpad 'P' */ + "-...", /* boost 'B' */ + "-.-.", /* coast 'C' */ + ".-", /* apogee 'A' */ + "-..", /* drogue 'D' */ + "--", /* main 'M' */ + ".-..", /* landed 'L' */ + ".-.-.-", /* invalid */ +}; + +#if 1 +#define signal(time) ao_beep_for(AO_BEEP_MID, time) +#else +#define signal(time) ao_led_for(AO_LED_RED, time) +#endif +#define pause(time) ao_delay(time) + +static __xdata enum ao_flight_state ao_report_state; + +static void +ao_report_beep(void) __reentrant +{ + char *r = flight_reports[ao_flight_state]; + char c; + + if (!r) + return; + while (c = *r++) { + if (c == '.') + signal(AO_MS_TO_TICKS(200)); + else + signal(AO_MS_TO_TICKS(600)); + pause(AO_MS_TO_TICKS(200)); + } + pause(AO_MS_TO_TICKS(400)); +} + +static void +ao_report_digit(uint8_t digit) __reentrant +{ + if (!digit) { + signal(AO_MS_TO_TICKS(500)); + pause(AO_MS_TO_TICKS(200)); + } else { + while (digit--) { + signal(AO_MS_TO_TICKS(200)); + pause(AO_MS_TO_TICKS(200)); + } + } + pause(AO_MS_TO_TICKS(300)); +} + +static void +ao_report_altitude(void) +{ + __xdata int16_t agl = ao_pres_to_altitude(ao_min_pres) - ao_pres_to_altitude(ao_ground_pres); + __xdata uint8_t digits[10]; + __xdata uint8_t ndigits, i; + + if (agl < 0) + agl = 0; + ndigits = 0; + do { + digits[ndigits++] = agl % 10; + agl /= 10; + } while (agl); + + for (;;) { + ao_report_beep(); + i = ndigits; + do + ao_report_digit(digits[--i]); + while (i != 0); + pause(AO_SEC_TO_TICKS(5)); + } +} + +void +ao_report(void) +{ + ao_report_state = ao_flight_state; + for(;;) { + if (ao_flight_state == ao_flight_landed) + ao_report_altitude(); + ao_report_beep(); + __critical { + while (ao_report_state == ao_flight_state) + ao_sleep(DATA_TO_XDATA(&ao_flight_state)); + ao_report_state = ao_flight_state; + } + } +} + +static __xdata struct ao_task ao_report_task; + +void +ao_report_init(void) +{ + ao_add_task(&ao_report_task, ao_report, "report"); +} |