]> git.gag.com Git - fw/altos/blob - src/avr/ao_spi_slave.c
altos: Report latest telemetry data, rather than using the oldest
[fw/altos] / src / avr / ao_spi_slave.c
1 /*
2  * Copyright © 2011 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 #include "ao.h"
19
20 uint8_t
21 ao_spi_slave_recv(uint8_t *buf, uint8_t len)
22 {
23         while (len--) {
24                 while (!(SPSR & (1 << SPIF)))
25                         if ((PINB & (1 << PINB0)))
26                                 return 0;
27                 *buf++ = SPDR;
28         }
29         return 1;
30 }
31
32 void
33 ao_spi_slave_send(uint8_t *buf, uint8_t len)
34 {
35         while (len--) {
36                 SPDR = *buf++;
37                 while (!(SPSR & (1 << SPIF)))
38                         if ((PINB & (1 << PINB0)))
39                                 return;
40         }
41         /* Clear pending SPIF bit by reading */
42         (void) SPDR;
43 }
44
45 static uint8_t ao_spi_slave_running;
46
47 ISR(PCINT0_vect)
48 {
49         cli();
50 #if SPI_SLAVE_PIN_0_3
51         if ((PINB & (1 << PORTB0)) == 0)
52 #endif
53 #if SPI_SLAVE_PIN_2_5
54         if ((PINB & (1 << PORTB2)) == 0)
55 #endif
56         {
57                 if (!ao_spi_slave_running) {
58                         ao_spi_slave_running = 1;
59                         ao_spi_slave();
60                 }
61         } else {
62                 ao_spi_slave_running = 0;
63         }
64         sei();
65 }
66
67 void
68 ao_spi_slave_init(void)
69 {
70         /* We'd like to have a pull-up on SS so that disconnecting the
71          * TM would cause any SPI transaction to abort. However, when
72          * I tried that, SPI transactions would spontaneously abort,
73          * making me assume that we needed a less aggressive pull-up
74          * than is offered inside the AVR
75          */
76 #if SPI_SLAVE_PIN_0_3
77         PCMSK0 |= (1 << PCINT0);        /* Enable PCINT0 pin change */
78         PCICR |= (1 << PCIE0);          /* Enable pin change interrupt */
79
80         DDRB = ((DDRB & 0xf0) |
81                 (1 << 3) |              /* MISO, output */
82                 (0 << 2) |              /* MOSI, input */
83                 (0 << 1) |              /* SCK, input */
84                 (0 << 0));              /* SS, input */
85
86         PORTB = ((PORTB & 0xf0) |
87                  (1 << 3) |             /* MISO, output */
88                  (0 << 2) |             /* MOSI, no pull-up */
89                  (0 << 1) |             /* SCK, no pull-up */
90                  (1 << 0));             /* SS, pull-up */
91 #endif
92 #if SPI_SLAVE_PIN_2_5
93         PCMSK0 |= (1 << PCINT2);        /* Enable PCINT2 pin change */
94         PCICR |= (1 << PCIE0);          /* Enable pin change interrupt */
95
96         DDRB = ((DDRB & 0xf0) |
97                 (0 << 5) |              /* SCK, input */
98                 (1 << 4) |              /* MISO, output */
99                 (0 << 3) |              /* MOSI, input */
100                 (0 << 2));              /* SS, input */
101
102         PORTB = ((PORTB & 0xf0) |
103                  (0 << 5) |             /* SCK, no pull-up */
104                  (1 << 4) |             /* MISO, output */
105                  (0 << 3) |             /* MOSI, no pull-up */
106                  (1 << 2));             /* SS, pull-up */
107 #endif  
108
109         SPCR = (0 << SPIE) |            /* Disable SPI interrupts */
110                 (1 << SPE) |            /* Enable SPI */
111                 (0 << DORD) |           /* MSB first */
112                 (0 << MSTR) |           /* Slave mode */
113                 (0 << CPOL) |           /* Clock low when idle */
114                 (0 << CPHA);            /* Sample at leading clock edge */
115 }