2026-11-14 23:14:16 +01:00
/* Hexapod dongle - stage 2 "app" (bring-up / radio firmware).
*
* Links at 0x08001000 (after safeboot). Uses polling only (no interrupts), so
* no Cortex-M0 vector relocation is needed - safeboot jumps straight to it.
*
* This v0 brings up the hardware and helps map the last unknown pins:
* - USART1 PA9/PA10 115200 8N1 (USB serial via CH330N)
* - SPI1 PA5/6/7, nRF24 CSN PA3 CE PA4 IRQ PA2
* - free pins PA0 PA1 PB1 PF0 PF1 (LED + AT2401C control, still to identify)
* Serial commands: v=info r=nRF regs 0-4=toggle a free pin b=reflash (safeboot)
*/
#include "common.h"
#define CSN_HI() BSRR(GPIOA) = (1u << 3)
#define CSN_LO() BSRR(GPIOA) = (1u << (3 + 16))
2026-11-14 23:39:50 +01:00
#define CE_HI() BSRR(GPIOA) = (1u << 4)
2026-11-14 23:14:16 +01:00
#define CE_LO() BSRR(GPIOA) = (1u << (4 + 16))
static void spi_init ( void )
{
RCC_AHBENR |= ( 1u << 17 ); /* GPIOA */
RCC_APB2ENR |= ( 1u << 12 ); /* SPI1 */
MODER ( GPIOA ) = ( MODER ( GPIOA ) & ~ (( 3u << 10 ) | ( 3u << 12 ) | ( 3u << 14 )))
| ( 2u << 10 ) | ( 2u << 12 ) | ( 2u << 14 ); /* PA5/6/7 AF0 */
MODER ( GPIOA ) = ( MODER ( GPIOA ) & ~ (( 3u << 6 ) | ( 3u << 8 )))
| ( 1u << 6 ) | ( 1u << 8 ); /* PA3/PA4 out */
MODER ( GPIOA ) &= ~ ( 3u << 4 ); /* PA2 in */
PUPDR ( GPIOA ) = ( PUPDR ( GPIOA ) & ~ ( 3u << 4 )) | ( 1u << 4 ); /* PA2 pull-up */
CSN_HI (); CE_LO ();
REG ( 0x40013000 ) = ( 1u << 2 ) | ( 1u << 9 ) | ( 1u << 8 ) | ( 2u << 3 ); /* CR1 */
REG ( 0x40013004 ) = ( 7u << 8 ) | ( 1u << 12 ); /* CR2 8-bit */
REG ( 0x40013000 ) |= ( 1u << 6 ); /* SPE */
}
static uint8_t spi_xfer ( uint8_t b )
{
REG8 ( 0x4001300C ) = b ;
while ( ! ( REG ( 0x40013008 ) & ( 1u << 0 ))) {}
return REG8 ( 0x4001300C );
}
static uint8_t nrf_read ( uint8_t reg )
{
CSN_LO (); spi_xfer ( reg & 0x1F ); uint8_t v = spi_xfer ( 0xFF ); CSN_HI ();
return v ;
}
static void nrf_write ( uint8_t reg , uint8_t val )
{
CSN_LO (); spi_xfer ( 0x20 | ( reg & 0x1F )); spi_xfer ( val ); CSN_HI ();
}
2026-11-14 23:39:50 +01:00
static void nrf_write_buf ( uint8_t reg , const uint8_t * d , int n )
{
CSN_LO (); spi_xfer ( 0x20 | ( reg & 0x1F )); while ( n -- ) spi_xfer ( * d ++ ); CSN_HI ();
}
static void nrf_cmd ( uint8_t c ) { CSN_LO (); spi_xfer ( c ); CSN_HI (); }
2026-11-17 22:48:41 +01:00
/* Receive on the hexapod protocol (ch 96, 250 kbps, addr HXPD1). Protocol v4
* uses dynamic payload lengths (the remote's CmdPacket is 26 bytes, with ack
* payloads), so this does too and accepts any length. Auto-ack is on, so the
* remote's link % also shows whether our acks get back out (TX path). Lets us
* find the AT2401C enable pins: packets only arrive when the LNA path is on. */
2026-11-14 23:39:50 +01:00
static uint8_t rxmode ;
static uint16_t rx_count ;
2026-11-17 22:48:41 +01:00
static uint8_t rx_len ;
2026-11-14 23:39:50 +01:00
static void rx_setup ( void )
{
static const uint8_t addr [ 5 ] = { 0x48 , 0x58 , 0x50 , 0x44 , 0x31 }; /* "HXPD1" */
CE_LO ();
nrf_write ( 0x00 , 0x0F ); /* CONFIG: PWR_UP, PRIM_RX, EN_CRC, CRCO=16 */
nrf_write ( 0x01 , 0x01 ); /* EN_AA pipe0 */
nrf_write ( 0x02 , 0x01 ); /* EN_RXADDR pipe0 */
nrf_write ( 0x03 , 0x03 ); /* SETUP_AW = 5 bytes */
nrf_write ( 0x05 , 96 ); /* RF_CH */
nrf_write ( 0x06 , 0x26 ); /* RF_SETUP: 250 kbps, max power */
nrf_write_buf ( 0x0A , addr , 5 ); /* RX_ADDR_P0 */
2026-11-17 22:48:41 +01:00
nrf_write ( 0x1D , 0x04 ); /* FEATURE: EN_DPL */
nrf_write ( 0x1C , 0x01 ); /* DYNPD: pipe0 */
2026-11-14 23:39:50 +01:00
nrf_write ( 0x07 , 0x70 ); /* clear status flags */
nrf_cmd ( 0xE2 ); /* FLUSH_RX */
rx_count = 0 ;
2026-11-17 22:48:41 +01:00
rx_len = 0 ;
2026-11-14 23:39:50 +01:00
CE_HI ();
}
static void rx_poll ( void )
{
2026-11-17 22:48:41 +01:00
while ( nrf_read ( 0x07 ) & 0x40 ) { /* RX_DR */
CSN_LO (); spi_xfer ( 0x60 ); uint8_t n = spi_xfer ( 0xFF ); CSN_HI (); /* R_RX_PL_WID */
if ( n > 32 ) { nrf_cmd ( 0xE2 ); nrf_write ( 0x07 , 0x40 ); break ; } /* corrupt: flush */
CSN_LO (); spi_xfer ( 0x61 ); for ( int i = 0 ; i < n ; i ++ ) spi_xfer ( 0xFF ); CSN_HI ();
2026-11-14 23:39:50 +01:00
nrf_write ( 0x07 , 0x40 ); /* clear RX_DR */
2026-11-17 22:48:41 +01:00
rx_len = n ;
2026-11-14 23:39:50 +01:00
rx_count ++ ;
}
}
2026-11-14 23:14:16 +01:00
static const struct { uint32_t port ; uint8_t pin ; const char * name ; } FREE [] = {
{ GPIOA , 0 , "PA0" }, { GPIOA , 1 , "PA1" }, { GPIOB , 1 , "PB1" },
{ GPIOF , 0 , "PF0" }, { GPIOF , 1 , "PF1" },
};
#define NFREE 5
static uint8_t fst [ NFREE ];
static void free_init ( void )
{
RCC_AHBENR |= ( 1u << 17 ) | ( 1u << 18 ) | ( 1u << 22 );
for ( int i = 0 ; i < NFREE ; i ++ ) {
MODER ( FREE [ i ]. port ) = ( MODER ( FREE [ i ]. port ) & ~ ( 3u << ( FREE [ i ]. pin * 2 )))
| ( 1u << ( FREE [ i ]. pin * 2 ));
BSRR ( FREE [ i ]. port ) = ( 1u << ( FREE [ i ]. pin + 16 ));
}
}
2026-11-14 23:39:50 +01:00
/* Every usable GPIO on the TSSOP-20 except PA9/PA10 (our serial). Sweep each
* HIGH ~3 s so the user can watch the LED. Disturbs the radio; re-init after. */
static const struct { uint32_t port ; uint8_t pin ; const char * name ; } ALLPINS [] = {
{ GPIOA , 0 , "PA0" }, { GPIOA , 1 , "PA1" }, { GPIOA , 2 , "PA2 IRQ" },
{ GPIOA , 3 , "PA3 CSN" }, { GPIOA , 4 , "PA4 CE" }, { GPIOA , 5 , "PA5 SCK" },
{ GPIOA , 6 , "PA6 MISO" }, { GPIOA , 7 , "PA7 MOSI" }, { GPIOB , 1 , "PB1" },
{ GPIOF , 0 , "PF0" }, { GPIOF , 1 , "PF1" }, { GPIOA , 13 , "PA13 SWDIO" },
{ GPIOA , 14 , "PA14 SWCLK" },
};
static void sweep_all ( void )
{
uart_puts ( "sweeping ALL pins, 3 s each (radio will be disturbed): \r\n " );
for ( unsigned i = 0 ; i < sizeof ( ALLPINS ) / sizeof ( ALLPINS [ 0 ]); i ++ ) {
uint32_t p = ALLPINS [ i ]. port ; uint8_t n = ALLPINS [ i ]. pin ;
MODER ( p ) = ( MODER ( p ) & ~ ( 3u << ( n * 2 ))) | ( 1u << ( n * 2 )); /* output */
BSRR ( p ) = ( 1u << n ); /* HIGH */
uart_puts ( ">>> " ); uart_puts ( ALLPINS [ i ]. name ); uart_puts ( " HIGH \r\n " );
delay_ms ( 3000 );
BSRR ( p ) = ( 1u << ( n + 16 )); /* LOW */
delay_ms ( 500 );
}
uart_puts ( "sweep done; restoring radio \r\n " );
spi_init ();
nrf_write ( 0 , 0x0E );
}
2026-11-14 23:14:16 +01:00
static void hex2 ( uint8_t b ) { const char * h = "0123456789ABCDEF" ; uart_putc ( h [ b >> 4 ]); uart_putc ( h [ b & 0xF ]); }
static void banner ( void )
{
uart_puts ( " \r\n hexapod dongle app v0 (@0x08001000) \r\n " );
uart_puts ( "nRF CONFIG=0x" ); hex2 ( nrf_read ( 0 )); uart_puts ( " STATUS=0x" ); hex2 ( nrf_read ( 7 ));
uart_puts ( " RF_CH=0x" ); hex2 ( nrf_read ( 5 )); uart_puts ( " RF_SETUP=0x" ); hex2 ( nrf_read ( 6 ));
2026-11-17 22:48:41 +01:00
uart_puts ( " \r\n cmds: v r 0-4(PA0/PA1/PB1/PF0/PF1) x=rx test b=reflash; bridge: frame A5 'L' \r\n " );
2026-11-14 23:14:16 +01:00
}
static void regdump ( void )
{
static const uint8_t rg [] = { 0 , 1 , 2 , 3 , 4 , 5 , 6 , 7 , 8 , 9 , 0x17 };
for ( unsigned i = 0 ; i < sizeof ( rg ); i ++ ) { uart_puts ( " R" ); hex2 ( rg [ i ]); uart_putc ( '=' ); hex2 ( nrf_read ( rg [ i ])); }
uart_puts ( " \r\n " );
}
2026-11-14 23:39:50 +01:00
/* Pin finder: sit in RX on a WiFi-busy channel and report the carrier-detect
* (RPD) bit. Toggling the real RXEN pin switches the AT2401C LNA on, which lifts
* ambient 2.4 GHz above the -64 dBm detect threshold -> RPD flips to 1. */
static uint8_t finder ;
static uint8_t finder_ch = 62 ; /* 2462 MHz ~ WiFi ch 11 */
static void finder_rx ( void )
{
CE_LO ();
nrf_write ( 0x05 , finder_ch ); /* RF_CH */
nrf_write ( 0x06 , 0x0F ); /* RF_SETUP: keep it simple */
nrf_write ( 0x00 , 0x0F ); /* CONFIG: PWR_UP, PRIM_RX, CRC16 */
delay_ms ( 2 );
CE_HI (); /* enter RX */
delay_ms ( 2 );
}
2026-11-17 22:48:41 +01:00
/* ---- USART1 RX through circular DMA ------------------------------------
* The bridge moves ~100 frames/s each way at 115200 baud. Polled single-byte
* RX loses bytes while we block on a TX frame or an SPI read, and this M0 app
* runs without interrupts (no vector relocation), so DMA channel 3 (USART1_RX)
* writes every byte into a ring we drain at leisure. */
#define DMA_CCR3 REG(0x40020030)
#define DMA_CNDTR3 REG(0x40020034)
#define DMA_CPAR3 REG(0x40020038)
#define DMA_CMAR3 REG(0x4002003C)
#define USART1_CR3 REG(0x40013808)
#define RXRING 256u
static volatile uint8_t rxring [ RXRING ];
static uint16_t rxtail ;
static void uart_dma_init ( void )
{
RCC_AHBENR |= 1u ; /* DMA1 */
while ( ! ( USART1_ISR & ( 1u << 6 ))) {} /* let any TX finish */
USART1_CR1 &= ~ 1u ; /* UE off: CR3 OVRDIS needs it */
USART1_CR3 = ( 1u << 6 ) | ( 1u << 12 ); /* DMAR, OVRDIS (never stall on overrun) */
USART1_CR1 |= 1u ;
DMA_CCR3 = 0 ;
DMA_CPAR3 = 0x40013824u ; /* USART1_RDR */
DMA_CMAR3 = ( uint32_t ) rxring ;
DMA_CNDTR3 = RXRING ;
DMA_CCR3 = ( 1u << 7 ) | ( 1u << 5 ) | 1u ; /* MINC, CIRC, EN; 8-bit, periph -> mem */
}
static int rx_getc ( void )
{
uint16_t head = ( uint16_t )( RXRING - DMA_CNDTR3 ) % RXRING ;
if ( head == rxtail ) return - 1 ;
uint8_t c = rxring [ rxtail ];
rxtail = ( uint16_t )(( rxtail + 1 ) % RXRING );
return c ;
}
/* ---- Bridge: the dongle stands in for the robot's radio ------------------
* Framing both ways: A5 type len payload[len] sum, sum = type+len+payload (mod 256).
* host -> dongle 'L' listen (enter bridge) 'X' leave
* 'A' ack payload (<= 32 B): goes back on the auto-ack of the
* next packet, like the robot's Comms::loadAckPayload.
* Dropped if the host stops refreshing it for 500 ms, so
* the remote doesn't see stale telemetry as live.
* dongle -> host 'R' a received packet (the remote's CmdPacket)
* 'S' once a second: packets received (u16 LE), acks loaded (u16 LE)
* Plain text never contains A5, so the host can skip anything between frames. */
static uint8_t bridge ;
static uint8_t ack_buf [ 32 ], ack_len ;
static uint32_t ack_ms ;
static uint16_t br_rx , br_acks ;
static void frame_send ( uint8_t type , const uint8_t * d , uint8_t n )
{
uint8_t sum = ( uint8_t )( type + n );
uart_putc (( char ) 0xA5 ); uart_putc (( char ) type ); uart_putc (( char ) n );
for ( uint8_t i = 0 ; i < n ; i ++ ) { uart_putc (( char ) d [ i ]); sum = ( uint8_t )( sum + d [ i ]); }
uart_putc (( char ) sum );
}
static void ack_load ( void )
{
nrf_cmd ( 0xE1 ); /* FLUSH_TX: only the newest one */
if ( ! ack_len ) return ;
CSN_LO (); spi_xfer ( 0xA8 ); for ( uint8_t i = 0 ; i < ack_len ; i ++ ) spi_xfer ( ack_buf [ i ]); CSN_HI (); /* W_ACK_PAYLOAD pipe 0 */
br_acks ++ ;
}
static void bridge_start ( void )
{
rx_setup (); /* ch96 / 250k / HXPD1 / auto-ack / dynamic length */
CE_LO ();
nrf_write ( 0x1D , 0x06 ); /* FEATURE: EN_DPL | EN_ACK_PAY */
nrf_write ( 0x1C , 0x01 ); /* DYNPD pipe 0 */
nrf_cmd ( 0xE1 );
ack_len = 0 ; br_rx = br_acks = 0 ;
rxmode = 0 ; finder = 0 ; bridge = 1 ;
BSRR ( GPIOA ) = 1u ; /* LED on while bridging */
CE_HI ();
}
static void bridge_stop ( void )
{
bridge = 0 ; ack_len = 0 ;
CE_LO (); nrf_write ( 0 , 0x0E ); nrf_cmd ( 0xE1 );
BSRR ( GPIOA ) = 1u << 16 ;
}
static void bridge_poll ( uint32_t now )
{
if ( ack_len && now - ack_ms > 500 ) { ack_len = 0 ; nrf_cmd ( 0xE1 ); } /* host went quiet */
while ( nrf_read ( 0x07 ) & 0x40 ) { /* RX_DR */
uint8_t buf [ 32 ];
CSN_LO (); spi_xfer ( 0x60 ); uint8_t n = spi_xfer ( 0xFF ); CSN_HI (); /* R_RX_PL_WID */
if ( n > 32 ) { nrf_cmd ( 0xE2 ); nrf_write ( 0x07 , 0x40 ); break ; }
CSN_LO (); spi_xfer ( 0x61 ); for ( uint8_t i = 0 ; i < n ; i ++ ) buf [ i ] = spi_xfer ( 0xFF ); CSN_HI ();
nrf_write ( 0x07 , 0x40 );
ack_load (); /* the ack for the NEXT packet */
frame_send ( 'R' , buf , n );
br_rx ++ ;
if (( br_rx & 31 ) == 0 ) BSRR ( GPIOA ) = ( IDR ( GPIOA ) & 1u ) ? ( 1u << 16 ) : 1u ; /* LED flicker */
}
}
/* Host frame parser; returns 1 while inside a frame (so its bytes aren't
* taken as single-letter commands). */
static uint8_t fr_state , fr_type , fr_len , fr_got , fr_sum , fr_buf [ 32 ];
static int frame_rx ( int c , uint32_t now )
{
/* if-chain, not switch: a switch becomes a jump table needing libgcc */
if ( fr_state == 0 ) {
if ( c != 0xA5 ) return 0 ;
fr_state = 1 ;
} else if ( fr_state == 1 ) {
fr_type = ( uint8_t ) c ;
fr_state = 2 ;
} else if ( fr_state == 2 ) {
fr_len = ( uint8_t ) c ; fr_got = 0 ; fr_sum = ( uint8_t )( fr_type + fr_len );
fr_state = ( fr_len > 32 ) ? 0 : ( fr_len ? 3 : 4 );
} else if ( fr_state == 3 ) {
fr_buf [ fr_got ++ ] = ( uint8_t ) c ; fr_sum = ( uint8_t )( fr_sum + c );
if ( fr_got == fr_len ) fr_state = 4 ;
} else {
fr_state = 0 ;
if (( uint8_t ) c != fr_sum ) return 1 ; /* corrupt: drop */
if ( fr_type == 'L' ) bridge_start ();
else if ( fr_type == 'X' ) bridge_stop ();
else if ( fr_type == 'A' && bridge ) {
for ( uint8_t i = 0 ; i < fr_len ; i ++ ) ack_buf [ i ] = fr_buf [ i ];
ack_len = fr_len ; ack_ms = now ;
ack_load ();
}
}
return 1 ;
}
2026-11-14 23:14:16 +01:00
static void reflash ( void ) /* ask safeboot to take over, no wire needed */
{
uart_puts ( "resetting into safeboot flash mode... \r\n " );
while ( ! ( USART1_ISR & ( 1u << 6 ))) {} /* TC */
REG ( MAGIC_ADDR ) = MAGIC_FLASH ;
REG ( 0xE000ED0C ) = 0x05FA0004 ; /* SCB AIRCR SYSRESETREQ */
for (;;) {}
}
int main ( void )
{
uart_init8n1 ();
2026-11-17 22:48:41 +01:00
uart_dma_init ();
2026-11-14 23:14:16 +01:00
spi_init ();
free_init ();
nrf_write ( 0 , 0x0E );
delay_ms ( 5 );
banner ();
2026-11-17 22:48:41 +01:00
uint32_t now = 0 , t = 0 ;
systick_setup ();
2026-11-14 23:14:16 +01:00
for (;;) {
2026-11-17 22:48:41 +01:00
uint32_t ctrl = STK_CTRL ; /* one read: reading clears COUNTFLAG */
if ( ctrl == 0 ) systick_setup (); /* delay_ms() (sweep, finder) stops it */
else if ( ctrl & 0x10000 ) { now ++ ; t ++ ; } /* 1 ms ticks, polled */
if ( bridge ) bridge_poll ( now );
int c = rx_getc ();
if ( c >= 0 && frame_rx ( c , now )) c = - 1 ; /* consumed by a host frame */
if ( c < 0 ) {}
else if ( bridge && c != 'b' && c != 'B' ) {} /* bridging: only frames (and reflash) */
else if ( c == 'v' || c == 'V' ) banner ();
2026-11-14 23:14:16 +01:00
else if ( c == 'r' || c == 'R' ) regdump ();
else if ( c == 'b' || c == 'B' ) reflash ();
2026-11-14 23:39:50 +01:00
else if ( c == 'x' || c == 'X' ) { rxmode = ! rxmode ; finder = 0 ; if ( rxmode ) rx_setup (); else { CE_LO (); nrf_write ( 0 , 0x0E ); } uart_puts ( rxmode ? "RX mode on (ch96/250k/HXPD1) \r\n " : "RX off \r\n " ); }
else if ( c == 'a' || c == 'A' ) sweep_all ();
else if ( c == 'f' || c == 'F' ) { finder = ! finder ; if ( finder ) finder_rx (); else { CE_LO (); nrf_write ( 0 , 0x0E ); } uart_puts ( finder ? "finder RX on \r\n " : "finder off \r\n " ); }
else if ( c == 'n' || c == 'N' ) { finder_ch = ( finder_ch == 62 ) ? 37 : ( finder_ch == 37 ? 12 : 62 ); if ( finder ) finder_rx (); uart_puts ( "ch=" ); hex2 ( finder_ch ); uart_puts ( " \r\n " ); }
2026-11-14 23:14:16 +01:00
else if ( c >= '0' && c <= '4' ) {
int i = c - '0' ;
fst [ i ] = ! fst [ i ];
BSRR ( FREE [ i ]. port ) = fst [ i ] ? ( 1u << FREE [ i ]. pin ) : ( 1u << ( FREE [ i ]. pin + 16 ));
2026-11-14 23:39:50 +01:00
uart_puts ( "pin " ); uart_puts ( FREE [ i ]. name ); uart_puts ( fst [ i ] ? " HIGH" : " LOW" );
if ( finder ) { delay_ms ( 2 ); uart_puts ( " RPD=" ); hex2 ( nrf_read ( 9 )); }
uart_puts ( " \r\n " );
2026-11-14 23:14:16 +01:00
}
2026-11-14 23:39:50 +01:00
if ( rxmode ) rx_poll ();
2026-11-17 22:48:41 +01:00
if ( t >= 1000 ) {
2026-11-14 23:39:50 +01:00
t = 0 ;
2026-11-17 22:48:41 +01:00
if ( bridge ) {
uint8_t s [ 4 ] = { ( uint8_t ) br_rx , ( uint8_t )( br_rx >> 8 ), ( uint8_t ) br_acks , ( uint8_t )( br_acks >> 8 ) };
frame_send ( 'S' , s , 4 );
br_rx = br_acks = 0 ;
}
else if ( rxmode ) { uart_puts ( "RX pkts=" ); hex2 ( rx_count >> 8 ); hex2 ( rx_count & 0xFF );
uart_puts ( " len=" ); hex2 ( rx_len );
2026-11-14 23:39:50 +01:00
uart_puts ( " pins=" ); for ( int i = 0 ; i < NFREE ; i ++ ) uart_putc ( fst [ i ] ? '1' : '0' );
uart_puts ( " (0=PA0LED,1=PA1,2=PB1,3=PF0,4=PF1) \r\n " ); rx_count = 0 ; }
else if ( finder ) { uart_puts ( "finder ch=0x" ); hex2 ( finder_ch ); uart_puts ( " RPD=" ); hex2 ( nrf_read ( 9 ));
uart_puts ( " pins=" ); for ( int i = 0 ; i < NFREE ; i ++ ) uart_putc ( fst [ i ] ? '1' : '0' ); uart_puts ( " \r\n " ); }
else { uart_puts ( "hb STATUS=0x" ); hex2 ( nrf_read ( 7 )); uart_puts ( " \r\n " ); }
}
2026-11-14 23:14:16 +01:00
}
}