Fixed indexing error in aci_queue's peek function

NordicSemiconductor · Aug 22, 2014 · 58b5012 · 58b5012
1 parent 65e656c
commit 58b5012
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/libraries/BLE/aci_queue.cpp b/libraries/BLE/aci_queue.cpp
@@ -170,7 +170,7 @@ bool aci_queue_peek(aci_queue_t *aci_q, hal_aci_data_t *p_data)
     return false;
   }
 
-  memcpy((uint8_t *)p_data, (uint8_t *)&(aci_q->aci_data[aci_q->head]), sizeof(hal_aci_data_t));
+  memcpy((uint8_t *)p_data, (uint8_t *)&(aci_q->aci_data[aci_q->head % ACI_QUEUE_SIZE]), sizeof(hal_aci_data_t));
 
   return true;
 }
@@ -185,7 +185,7 @@ bool aci_queue_peek_from_isr(aci_queue_t *aci_q, hal_aci_data_t *p_data)
     return false;
   }
 
-  memcpy((uint8_t *)p_data, (uint8_t *)&(aci_q->aci_data[aci_q->head]), sizeof(hal_aci_data_t));
+  memcpy((uint8_t *)p_data, (uint8_t *)&(aci_q->aci_data[aci_q->head % ACI_QUEUE_SIZE]), sizeof(hal_aci_data_t));
 
   return true;
 }