Diff: ble_msg_handler.cpp

Revision:

12:c7a8a7fe76fd

Parent:

11:b8e687d97537

Child:

14:dc3e3d327d7c

--- a/ble_msg_handler.cpp	Thu Oct 06 09:42:38 2016 +0000
+++ b/ble_msg_handler.cpp	Thu Oct 06 15:25:57 2016 +0000
@@ -54,11 +54,12 @@
         
     send_buf[0] = BLE_SOF_CMD;
     send_buf[1] = BLE_REC_DATA_CMD;
-    memcpy(&send_buf[2], rx_data, len);
-    send_buf[len + 2] = BLE_EOT_CMD;
+    send_buf[2] = len;
+    memcpy(&send_buf[3], rx_data, len);
+    send_buf[len + 3] = BLE_EOT_CMD;
     
     // TODO Send the data to SPI
-    spi_slave_tx_data(send_buf, len + 3);
+    spi_slave_tx_data(send_buf, len + 4);
 }
 
 
@@ -70,7 +71,7 @@
 void spi_rx_Data_Callback(uint8_t *rx_data, uint8_t len)
 {    
     uint8_t tmp_buf[16];     
-    if (rx_data[0] == 0xFF) {  
+    if (rx_data[1] == 0xFF) {  
         // TODO: DUMMY Read, send dummy byte back    
     } else if (rx_data[1] == BLE_SOF_CMD) {        
         switch (rx_data[2]) {