diff options
| -rw-r--r-- | main.c | 19 |
1 files changed, 17 insertions, 2 deletions
@@ -52,6 +52,20 @@ static inline void write_reg(uint8_t reg, uint8_t val) } } +static inline void write_reg_check(uint8_t reg, uint8_t val, uint8_t ref) +{ + while (read_reg(reg) != ref) { + SPI_PORT &= ~(1 << SPI_SS); + SPDR = (reg & 0x1F) | 0x20; + while (!(SPSR & (1 << SPIF))) + ; + SPDR = val; + while (!(SPSR & (1 << SPIF))) + ; + SPI_PORT |= (1 << SPI_SS); + } +} + static inline void print_config(void) { char s[22]; @@ -86,8 +100,9 @@ void radio_init(void) write_reg(0x03, 0b00000001); /* set address width to 3 bytes */ write_reg(0x04, 0b00101111); /* 750uS retransmission delay, 15 tries */ write_reg(0x05, 0b01110011); /* use 2.515GHz channel */ - write_reg(0x06, 0b00000110); /* set data rate to 1Mbps */ - write_reg(0x07, 0b01110000); /* clear rx, tx, max_rt interrupts */ + write_reg(0x06, 0b00001110); /* set data rate to 1Mbps */ + + write_reg_check(0x07, 0b01110000, 0b00001110); /* clear rx, tx, max_rt interrupts */ } int main(void) |