Diff: NRF2401P.cpp

Revision:

10:8a217441c38e

Parent:

9:c21b80aaf250

Child:

11:07f76589f00a

--- a/NRF2401P.cpp	Sat Jul 11 09:38:59 2015 +0000
+++ b/NRF2401P.cpp	Sat Jul 11 11:18:37 2015 +0000
@@ -321,6 +321,30 @@
 }
 
 /**
+* Reads n bytes from a register
+**/
+void NRF2401P::readReg( char address, char *data, char width )
+{    
+    char reg;
+    csn = 0;
+    int i;
+    // set up for writing
+    address &= 0x1F;
+    reg = address| R_REGISTER;
+    status = spi->write( reg );
+    for ( i = width - 1; i >= 0; i-- ) {
+        data[i] = spi->write( 0x00 );
+    }
+    csn = 1;
+    if (debug) {
+        sprintf(logMsg, "  register read %d bytes from %02x (%02x) = ", width, address, status );
+        for ( i=0; i<width; i++)
+            sprintf(logMsg, "%s %02x", logMsg, data[i]);
+        log(logMsg);
+    }
+}
+
+/**
 * Clears the status flags RX_DR, TX_DS, MAX_RT
 */
 void NRF2401P::clearStatus()
@@ -674,6 +698,7 @@
 void NRF2401P::printDetails()
 {
     char data;
+    char addr[addressWidth];
     char status = checkStatus();
     printf("STATUS\t\t = 0x%02x RX_DR=%x TX_DS=%x MAX_RT=%x RX_P_NO=%x TX_FULL=%x\r\n", status,
            (status & (1<<MASK_RX_DR))?1:0,
@@ -682,6 +707,14 @@
            (status >> RX_P_NO) & 7,
            (status & (1<<TX_FULL))?1:0 );
 
+    readReg(RX_ADDR_P0, addr, addressWidth); printf("RX_ADDR_P0\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(RX_ADDR_P1, addr, addressWidth); printf("RX_ADDR_P1\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(RX_ADDR_P2, addr, addressWidth); printf("RX_ADDR_P2\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(RX_ADDR_P3, addr, addressWidth); printf("RX_ADDR_P3\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(RX_ADDR_P4, addr, addressWidth); printf("RX_ADDR_P4\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(RX_ADDR_P5, addr, addressWidth); printf("RX_ADDR_P5\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+    readReg(TX_ADDR, addr, addressWidth); printf("TX_ADDR\t\t = 0x%02x%02x%02x%02x%02x\r\n", addr[4],addr[3],addr[2],addr[1],addr[0]);
+
     printf("RX_PW_P0-5\t = ");
     readReg(RX_PW_P0, &data); printf("0x%02x ", data);
     readReg(RX_PW_P1, &data); printf("0x%02x ", data);