From 35947bcc59a6361b693700fd1cba7ead26c9f794 Mon Sep 17 00:00:00 2001 From: Sadeep Madurange Date: Wed, 2 Apr 2025 11:06:38 +0800 Subject: Fix batching logic. --- nrfm.c | 10 ++++++---- 1 file changed, 6 insertions(+), 4 deletions(-) (limited to 'nrfm.c') diff --git a/nrfm.c b/nrfm.c index eeddb18..8c89438 100644 --- a/nrfm.c +++ b/nrfm.c @@ -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, jn, jmax; + uint8_t i, j, j0, jmax; enable_tx(); reset_irqs(); @@ -196,15 +196,15 @@ void radio_sendto(const uint8_t addr[ADDRLEN], const void *msg, uint8_t n) setaddr(0x10, addr); setaddr(0x0A, addr); - jn = n - 1; + jmax = n - 1; for (i = 0; i < n; i += MAXPDLEN) { SPI_PORT &= ~(1 << SPI_SS); SPDR = 0b10100000; while (!(SPSR & (1 << SPIF))) ; - jmax = ((i + 1) * MAXPDLEN) - 1; - for (j = jn < jmax ? jn : jmax; j >= i * MAXPDLEN; j--) { + j0 = i + MAXPDLEN - 1; + for (j = j0 < jmax ? j0 : jmax; j >= i; j--) { SPDR = ((uint8_t *)msg)[j]; while (!(SPSR & (1 << SPIF))) ; @@ -214,6 +214,8 @@ void radio_sendto(const uint8_t addr[ADDRLEN], const void *msg, uint8_t n) NRF_CE_PORT |= (1 << NRF_CE); _delay_us(12); NRF_CE_PORT &= ~(1 << NRF_CE); + + // todo: check success } } -- cgit v1.2.3