wip: sendto.

1 files changed, 13 insertions, 5 deletions

diff --git a/rf_test/radio.c b/rf_test/radio.c
index 4b5cfbf..a2dea45 100644
--- a/rf_test/radio.c
+++ b/rf_test/radio.c
@@ -41,6 +41,8 @@
 
 #define MAX_POWER_LEVEL      23
 
+static uint8_t payload_len = 0;
+
 static inline uint8_t read_reg(uint8_t reg)
 {
 	SPI_PORT &= ~(1 << SPI_SS);
@@ -67,6 +69,11 @@ static inline void write_reg(uint8_t reg, uint8_t val)
 	SPI_PORT |= (1 << SPI_SS);
 }
 
+static inline uint8_t rssi(void)
+{
+	return (-1 * (read_reg(0x24) >> 1));
+}
+
 static inline void set_power_level(uint8_t pwl)
 {
 	uint8_t pa_mask;
@@ -88,16 +95,17 @@ void radio_sendto(uint8_t addr, const char *data, uint8_t n)
 {
 	uint8_t i;
 
-	// force the receiver into WAIT mode
+	// force-stop rx
 	write_reg(0x3D, ((read_reg(0x3D) & 0xFB) | 0x04));
+	//while (((read_reg(0x01) & 0x1C) == 0x10) && payload_len == 0 && rssi() < -90)
+	//	write_reg(0x01, 0x04);	
 
-	// todo: implement the rest...
-
-	// STDBY + ListenAbort
 	write_reg(0x01, 0x04);
-	while ((read_reg(0x27) >> 7) != 1)
+	while (!(read_reg(0x27) & 0x80))
 		;
 
+	// todo: implement the rest...
+
 	SPI_PORT &= ~(1 << SPI_SS);
 	SPDR = 0x00 | 0x80;
 	while (!(SPSR & (1 << SPIF)))