altos: Add LED test command to pca9922 driver
[fw/altos] / src / drivers / ao_pca9922.c
1 /*
2  * Copyright © 2012 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; version 2 of the License.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License along
14  * with this program; if not, write to the Free Software Foundation, Inc.,
15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
16  */
17
18 /*
19  * PCA9922 LED driver. This uses SPI to send a single byte to the device to
20  * set the current state of the LEDs using the existing LED interface
21  */
22
23 #include <ao.h>
24
25 static __xdata uint8_t  ao_led_state;
26
27 static void
28 ao_led_apply(void)
29 {
30         /* Don't try the SPI bus during initialization */
31         if (!ao_cur_task)
32                 return;
33         ao_spi_get(AO_PCA9922_SPI_BUS);
34         ao_spi_set_speed(AO_PCA9922_SPI_BUS,AO_SPI_SPEED_FAST);
35         AO_PCA9922_CS = 1;
36         ao_spi_send(&ao_led_state, 1, AO_PCA9922_SPI_BUS);
37         AO_PCA9922_CS = 0;
38         ao_spi_put(AO_PCA9922_SPI_BUS);
39 }
40
41 void
42 ao_led_on(uint8_t colors)
43 {
44         ao_led_state |= colors;
45         ao_led_apply();
46 }
47
48 void
49 ao_led_off(uint8_t colors)
50 {
51         ao_led_state &= ~colors;
52         ao_led_apply();
53 }
54
55 void
56 ao_led_set(uint8_t colors)
57 {
58         ao_led_state = colors;
59         ao_led_apply();
60 }
61
62 void
63 ao_led_set_mask(uint8_t colors, uint8_t mask)
64 {
65         ao_led_state = (ao_led_state & ~mask) | (colors & mask);
66         ao_led_apply();
67 }
68
69 #define LED_TEST        1
70 #if LED_TEST
71 static void
72 ao_led_test(void)
73 {
74         ao_cmd_hexbyte();
75         if (ao_cmd_status != ao_cmd_success)
76                 return;
77         ao_led_set(ao_cmd_lex_i);
78         printf("LEDs set to %02x\n", ao_cmd_lex_i);
79 }
80
81 static const struct ao_cmds ao_led_cmds[] = {
82         { ao_led_test,  "l <value>\0Set LEDs to <value>" },
83         { 0, NULL }
84 };
85 #endif
86
87 void
88 ao_led_toggle(uint8_t colors)
89 {
90         ao_led_state ^= colors;
91         ao_led_apply();
92 }
93
94 void
95 ao_led_for(uint8_t colors, uint16_t ticks) __reentrant
96 {
97         ao_led_on(colors);
98         ao_delay(ticks);
99         ao_led_off(colors);
100 }
101
102 void
103 ao_led_init(uint8_t enable)
104 {
105         (void) enable;
106         ao_enable_output(AO_PCA9922_CS_PORT, AO_PCA9922_CS_PIN, AO_PCA9922_CS, 1);
107 #if LED_TEST
108         ao_cmd_register(&ao_led_cmds[0]);
109 #endif
110 }