add context section to protect index when receiving data

manage connection Rx packet

Signed-off-by: Francois Ramu <[email protected]>

Author: FRASTM

src/utility/HCISharedMemTransport.cpp

@@ -53,12 +53,14 @@ PLACE_IN_SECTION("MB_MEM2") ALIGN(4) static uint8_t
   uint16_t _read_index;
   uint16_t _write_index;
 
-
 /** Bluetooth Device Address */
 static uint8_t bd_addr_udn[6];
+
+/** different device steps */
 static bool phase_bd_addr = false;
 static bool phase_tx_power = false;
 static bool phase_reset = false;
+static bool phase_cnx = false;
 
 HCISharedMemTransportClass::HCISharedMemTransportClass(BLEChip_t ble_chip) :
   _ble_chip(ble_chip)
@@ -82,16 +84,16 @@ static void evt_received(TL_EvtPacket_t *hcievt)
         case TL_BLEEVT_PKT_TYPE:
 
         /* check the Rx event of complete the previous bd_addr opcode 0xfc0c */
-        if ((hcievt->evtserial.evt.evtcode == 0x0e) &&
+        if ((hcievt->evtserial.evt.evtcode == TL_BLEEVT_CC_OPCODE) &&
            (hcievt->evtserial.evt.payload[0] == 0x01) &&
            (hcievt->evtserial.evt.payload[1] == 0x0C) &&
            (hcievt->evtserial.evt.payload[2] == 0xFC)) {
            phase_bd_addr = true;
             /* rx data is no more useful */
             break;
         } 
-        /* check the Rx event of complete the previous tx power opcode 0xfc0f */
-        if ((hcievt->evtserial.evt.evtcode == 0x0e) &&
+        /* check the Rx event of complete the previous tx power opcode 0xFC0F */
+        if ((hcievt->evtserial.evt.evtcode == TL_BLEEVT_CC_OPCODE) &&
             (hcievt->evtserial.evt.payload[0] == 0x01) &&
             (hcievt->evtserial.evt.payload[1] == 0x0F) &&
             (hcievt->evtserial.evt.payload[2] == 0xFC)) {
@@ -101,22 +103,31 @@ static void evt_received(TL_EvtPacket_t *hcievt)
         }
 
         /* check if the reset phase is in progress (opcode is 0x0C03) */
-        if ((hcievt->evtserial.evt.evtcode == 0x0e) &&
+        if ((hcievt->evtserial.evt.evtcode == TL_BLEEVT_CC_OPCODE) &&
            (hcievt->evtserial.evt.payload[0] == 0x01) &&
            (hcievt->evtserial.evt.payload[1] == 0x03) &&
            (hcievt->evtserial.evt.payload[2] == 0x0C)) {
-            /* this is the HCI Reset command being sent */
             phase_reset = true;
         }
 
+        /* check if the connection phase is up (event code is 0x3E) */
+        if ((hcievt->evtserial.evt.evtcode == 0x3E)) {
+            phase_cnx = true;
+        }
+        /* check if the connection phase is down (event code is 0x05) */
+        if ((hcievt->evtserial.evt.evtcode == 0x05)) {
+            phase_cnx = false;
+        }
+
+__disable_irq();
             /* store received data in the _rxbuff buffer */
             len = hcievt->evtserial.evt.plen + TL_EVT_HDR_SIZE;
             /* at the position of the _write_index */
             memcpy((uint8_t *)&_rxbuff[_write_index], (uint8_t *)&hcievt->evtserial, len);
             /* move index */
             _write_index += len;
             //TODO: control the _rxbuff cannot overflow
-
+__enable_irq();
             break;
         case TL_ACL_DATA_PKT_TYPE: {
             TL_AclDataSerial_t *acl = &(((TL_AclDataPacket_t *)hcievt)->AclDataSerial);
@@ -353,19 +364,19 @@ int HCISharedMemTransportClass::available()
 int HCISharedMemTransportClass::peek()
 {
   int peek_val = -1;
-
+__disable_irq();
   if(_read_index != _write_index)
   {
     peek_val = _rxbuff[_read_index];
   }
-
+__enable_irq();
   return peek_val;
 }
 
 int HCISharedMemTransportClass::read()
 {
   int read_val = -1;
-
+__disable_irq();
   if(_read_index != _write_index)
   {
     read_val = _rxbuff[_read_index];
@@ -377,7 +388,7 @@ int HCISharedMemTransportClass::read()
       _write_index = 0;
     }
   }
-
+__enable_irq();
   return read_val;
 }