diff options
Diffstat (limited to 'nrfm.c')
| -rw-r--r-- | nrfm.c | 10 |
1 files changed, 6 insertions, 4 deletions
@@ -187,7 +187,7 @@ void radio_init(const uint8_t rxaddr[ADDRLEN]) void radio_sendto(const uint8_t addr[ADDRLEN], const void *msg, uint8_t n) { - uint8_t i, j, j0; + uint8_t i, j, jn, jmax; enable_tx(); reset_irqs(); @@ -196,19 +196,21 @@ void radio_sendto(const uint8_t addr[ADDRLEN], const void *msg, uint8_t n) setaddr(0x10, addr); setaddr(0x0A, addr); + jn = n - 1; + for (i = 0; i < n; i += MAXPDLEN) { SPI_PORT &= ~(1 << SPI_SS); SPDR = 0b10100000; while (!(SPSR & (1 << SPIF))) ; - - j0 = ((i + 1) * MAXPDLEN) - 1; - for (j = n - 1 < j0 ? n - 1 : j0; j >= i * MAXPDLEN; j--) { + jmax = ((i + 1) * MAXPDLEN) - 1; + for (j = jn < jmax ? jn : jmax; j >= i * MAXPDLEN; j--) { SPDR = ((uint8_t *)msg)[j]; while (!(SPSR & (1 << SPIF))) ; } SPI_PORT |= (1 << SPI_SS); + NRF_CE_PORT |= (1 << NRF_CE); _delay_us(12); NRF_CE_PORT &= ~(1 << NRF_CE); |