diff options
| author | Keith Packard <keithp@keithp.com> | 2014-04-04 23:34:48 -0700 | 
|---|---|---|
| committer | Keith Packard <keithp@keithp.com> | 2014-04-05 00:22:29 -0700 | 
| commit | 24167015705ae831692b95735968b04a876f935e (patch) | |
| tree | 9526ca4eb2ec5773baa748449c3def36b15d2307 /src/kernel/ao_report_micro.c | |
| parent | bb9fdef607728cc326a82aa632e59724f272e53b (diff) | |
altos: Rename 'core' to 'kernel'
core remains a bad name to use -- dirvish skips files (and
directories, it seems) with that name.
Signed-off-by: Keith Packard <keithp@keithp.com>
Diffstat (limited to 'src/kernel/ao_report_micro.c')
| -rw-r--r-- | src/kernel/ao_report_micro.c | 57 | 
1 files changed, 57 insertions, 0 deletions
diff --git a/src/kernel/ao_report_micro.c b/src/kernel/ao_report_micro.c new file mode 100644 index 00000000..0e8e287f --- /dev/null +++ b/src/kernel/ao_report_micro.c @@ -0,0 +1,57 @@ +/* + * Copyright © 2012 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> + +#define mid(time)	ao_led_for(AO_LED_REPORT, time) +#define pause(time)	ao_delay(time) + +static void +ao_report_digit(uint8_t digit) __reentrant +{ +	if (!digit) { +		mid(AO_MS_TO_TICKS(1000)); +		pause(AO_MS_TO_TICKS(300)); +	} else { +		while (digit--) { +			mid(AO_MS_TO_TICKS(300)); +			pause(AO_MS_TO_TICKS(300)); +		} +	} +	pause(AO_MS_TO_TICKS(1000)); +} + +void +ao_report_altitude(void) +{ +	__pdata alt_t	agl = ao_max_height; +	static __xdata uint8_t	digits[11]; +	__pdata uint8_t ndigits, i; + +	if (agl < 0) +		agl = 0; +	ndigits = 0; +	do { +		digits[ndigits++] = agl % 10; +		agl /= 10; +	} while (agl); + +	i = ndigits; +	do +		ao_report_digit(digits[--i]); +	while (i != 0); +}  | 
