altoslib: fix computation of TeleGPS battery voltage
[fw/altos] / src / attiny / ao_led.c
1 /*
2  * Copyright © 2009 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18
19 #include "ao.h"
20
21 __pdata uint8_t ao_led_enable;
22
23 #define LED_PORT        PORTB
24 #define LED_DDR         DDRB
25
26 void
27 ao_led_on(uint8_t colors)
28 {
29         LED_PORT |= (colors & ao_led_enable);
30 }
31
32 void
33 ao_led_off(uint8_t colors)
34 {
35         LED_PORT &= ~(colors & ao_led_enable);
36 }
37
38 void
39 ao_led_set(uint8_t colors)
40 {
41         LED_PORT = (LED_PORT & ~(ao_led_enable)) | (colors & ao_led_enable);
42 }
43
44 void
45 ao_led_toggle(uint8_t colors)
46 {
47         LED_PORT ^= (colors & ao_led_enable);
48 }
49
50 void
51 ao_led_for(uint8_t colors, uint16_t ticks) __reentrant
52 {
53         ao_led_on(colors);
54         ao_delay(ticks);
55         ao_led_off(colors);
56 }
57
58 void
59 ao_led_init(uint8_t enable)
60 {
61         ao_led_enable = enable;
62         LED_PORT &= ~enable;
63         LED_DDR |= enable;
64 }