altos/test: Adjust CRC error rate after FEC fix
[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; 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 /*
20  * PCA9922 LED driver. This uses SPI to send a single byte to the device to
21  * set the current state of the LEDs using the existing LED interface
22  */
23
24 #include <ao.h>
25
26 static uint8_t  ao_led_state;
27
28 static void
29 ao_led_apply(void)
30 {
31         /* Don't try the SPI bus during initialization */
32         if (!ao_cur_task)
33                 return;
34         ao_spi_get(AO_PCA9922_SPI_BUS);
35         ao_spi_set_speed(AO_PCA9922_SPI_BUS,AO_SPI_SPEED_FAST);
36         AO_PCA9922_CS = 1;
37         ao_spi_send(&ao_led_state, 1, AO_PCA9922_SPI_BUS);
38         AO_PCA9922_CS = 0;
39         ao_spi_put(AO_PCA9922_SPI_BUS);
40 }
41
42 void
43 ao_led_on(uint8_t colors)
44 {
45         ao_led_state |= colors;
46         ao_led_apply();
47 }
48
49 void
50 ao_led_off(uint8_t colors)
51 {
52         ao_led_state &= ~colors;
53         ao_led_apply();
54 }
55
56 void
57 ao_led_set(uint8_t colors)
58 {
59         ao_led_state = colors;
60         ao_led_apply();
61 }
62
63 void
64 ao_led_set_mask(uint8_t colors, uint8_t mask)
65 {
66         ao_led_state = (ao_led_state & ~mask) | (colors & mask);
67         ao_led_apply();
68 }
69
70 #define LED_TEST        1
71 #if LED_TEST
72 static void
73 ao_led_test(void)
74 {
75         AO_LED_TYPE r = ao_cmd_hexbyte();
76         if (ao_cmd_status != ao_cmd_success)
77                 return;
78         ao_led_set(r);
79         printf("LEDs set to %x\n", r);
80 }
81
82 static const struct ao_cmds ao_led_cmds[] = {
83         { ao_led_test,  "l <value>\0Set LEDs to <value>" },
84         { 0, NULL }
85 };
86 #endif
87
88 void
89 ao_led_toggle(uint8_t colors)
90 {
91         ao_led_state ^= colors;
92         ao_led_apply();
93 }
94
95 void
96 ao_led_for(uint8_t colors, uint16_t ticks) 
97 {
98         ao_led_on(colors);
99         ao_delay(ticks);
100         ao_led_off(colors);
101 }
102
103 void
104 ao_led_init(uint8_t enable)
105 {
106         (void) enable;
107         ao_enable_output(AO_PCA9922_CS_PORT, AO_PCA9922_CS_PIN, AO_PCA9922_CS, 1);
108 #if LED_TEST
109         ao_cmd_register(&ao_led_cmds[0]);
110 #endif
111 }