diff --git a/src/utility/STM32_WPAN/README.md b/src/utility/STM32_WPAN/README.md
index 90f96452..38841770 100644
--- a/src/utility/STM32_WPAN/README.md
+++ b/src/utility/STM32_WPAN/README.md
@@ -1,6 +1,6 @@
 
 ## Source
 
-[STMicroelectronics/STM32CubeWB Release v1.22.0](https://github.com/STMicroelectronics/STM32CubeWB/releases/tag/v1.22.0)
-- Application: [BLE_TransparentMode](https://github.com/STMicroelectronics/STM32CubeWB/tree/v1.22.0/Projects/P-NUCLEO-WB55.Nucleo/Applications/BLE/BLE_TransparentMode)
+[STMicroelectronics/STM32CubeWB Release v1.23.0](https://github.com/STMicroelectronics/STM32CubeWB/releases/tag/v1.23.0)
+- Application: [BLE_TransparentMode](https://github.com/STMicroelectronics/STM32CubeWB/tree/v1.23.0/Projects/P-NUCLEO-WB55.Nucleo/Applications/BLE/BLE_TransparentMode)
 
diff --git a/src/utility/STM32_WPAN/app_conf_default.h b/src/utility/STM32_WPAN/app_conf_default.h
index ff2dc017..2fd67c74 100644
--- a/src/utility/STM32_WPAN/app_conf_default.h
+++ b/src/utility/STM32_WPAN/app_conf_default.h
@@ -328,6 +328,13 @@
 
 #define CFG_BLE_MAX_TX_POWER            (6)
 
+/**
+* BLE stack Maximum number of created Enhanced ATT bearers to be configured
+* in addition to the number of links
+*     - Range: 0 .. 4
+*/
+#define CFG_BLE_MAX_ADD_EATT_BEARERS    (4)
+
 /**
  * BLE Rx model configuration flags to be configured with:
  * - SHCI_C2_BLE_INIT_RX_MODEL_AGC_RSSI_LEGACY
diff --git a/src/utility/STM32_WPAN/ble_bufsize.h b/src/utility/STM32_WPAN/ble_bufsize.h
index 26551c09..a46a9dd0 100644
--- a/src/utility/STM32_WPAN/ble_bufsize.h
+++ b/src/utility/STM32_WPAN/ble_bufsize.h
@@ -99,7 +99,7 @@
 #if (BEACON_ONLY != 0)
 #define BLE_FIXED_BUFFER_SIZE_BYTES  4200   /* Beacon only */
 #elif (LL_ONLY_BASIC != 0)
-#define BLE_FIXED_BUFFER_SIZE_BYTES  6040   /* LL only Basic*/
+#define BLE_FIXED_BUFFER_SIZE_BYTES  5960   /* LL only Basic*/
 #elif (LL_ONLY != 0)
 #define BLE_FIXED_BUFFER_SIZE_BYTES  6288   /* LL only Full */
 #elif (SLAVE_ONLY != 0)
diff --git a/src/utility/STM32_WPAN/shci.h b/src/utility/STM32_WPAN/shci.h
index 59c6fd46..f2479c83 100644
--- a/src/utility/STM32_WPAN/shci.h
+++ b/src/utility/STM32_WPAN/shci.h
@@ -565,53 +565,62 @@ extern "C" {
    */
   int8_t max_tx_power;
 
-   /**
-   * RX model configuration
-   * - bit 0:   1: agc_rssi model improved vs RF blockers    0: Legacy agc_rssi model
-   * - other bits: reserved ( shall be set to 0)
-   */
+  /**
+  * RX model configuration
+  * - bit 0:   1: agc_rssi model improved vs RF blockers    0: Legacy agc_rssi model
+  * - other bits: reserved ( shall be set to 0)
+  */
   uint8_t rx_model_config;
 
-  /* Maximum number of advertising sets.
-   * Range: 1 .. 8 with limitation:
-   * This parameter is linked to max_adv_data_len such as both compliant with allocated Total memory computed with BLE_EXT_ADV_BUFFER_SIZE based
-   * on Max Extended advertising configuration supported.
-   * This parameter is considered by the CPU2 when Options has SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV flag set
-   */
+  /** Maximum number of advertising sets.
+  * Range: 1 .. 8 with limitation:
+  * This parameter is linked to max_adv_data_len such as both compliant with allocated Total memory computed with BLE_EXT_ADV_BUFFER_SIZE based
+  * on Max Extended advertising configuration supported.
+  * This parameter is considered by the CPU2 when Options has SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV flag set
+  */
   uint8_t max_adv_set_nbr;
 
-  /* Maximum advertising data length (in bytes)
-   * Range: 31 .. 1650 with limitation:
-   * This parameter is linked to max_adv_set_nbr such as both compliant with allocated Total memory computed with BLE_EXT_ADV_BUFFER_SIZE based
-   * on Max Extended advertising configuration supported.
-   * This parameter is considered by the CPU2 when Options has SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV flag set
-   */
+  /** Maximum advertising data length (in bytes)
+  * Range: 31 .. 1650 with limitation:
+  * This parameter is linked to max_adv_set_nbr such as both compliant with allocated Total memory computed with BLE_EXT_ADV_BUFFER_SIZE based
+  * on Max Extended advertising configuration supported.
+  * This parameter is considered by the CPU2 when Options has SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV flag set
+  */
   uint16_t max_adv_data_len;
 
-  /* RF TX Path Compensation Value (16-bit signed integer). Units: 0.1 dB.
-   * Range: -1280 .. 1280
-   */
+  /** RF TX Path Compensation Value (16-bit signed integer). Units: 0.1 dB.
+  * Range: -1280 .. 1280
+  */
   int16_t tx_path_compens;
 
-  /* RF RX Path Compensation Value (16-bit signed integer). Units: 0.1 dB.
-   * Range: -1280 .. 1280
-   */
+  /** RF RX Path Compensation Value (16-bit signed integer). Units: 0.1 dB.
+  * Range: -1280 .. 1280
+  */
   int16_t rx_path_compens;
 
-  /* BLE core specification version (8-bit unsigned integer).
-   * values as: 11(5.2), 12(5.3), 13(5.4)
-   */
+  /** BLE core specification version (8-bit unsigned integer).
+  * values as: 11(5.2), 12(5.3), 13(5.4)
+  */
   uint8_t ble_core_version;
 
-   /**
-   * Options flags extension
-   * - bit 0:   1: appearance Writable              0: appearance Read-Only
-   * - bit 1:   1: Enhanced ATT supported           0: Enhanced ATT not supported
-   * - other bits: reserved ( shall be set to 0)
-   */
+  /**
+  * Options flags extension
+  * - bit 0:   1: appearance Writable              0: appearance Read-Only
+  * - bit 1:   1: Enhanced ATT supported           0: Enhanced ATT not supported
+  * - other bits: reserved ( shall be set to 0)
+  */
   uint8_t Options_extension;
 
-      } SHCI_C2_Ble_Init_Cmd_Param_t;
+  /**
+  * MaxAddEattBearers
+  *
+  * Maximum number of bearers that can be created for Enhanced ATT
+  * in addition to the number of links
+  *     - Range: 0 .. 4
+  */
+  uint8_t MaxAddEattBearers;
+
+  } SHCI_C2_Ble_Init_Cmd_Param_t;
 
   typedef PACKED_STRUCT{
     SHCI_Header_t Header;       /** Does not need to be initialized by the user */
diff --git a/src/utility/STM32_WPAN/stm_list.h b/src/utility/STM32_WPAN/stm_list.h
index b7c3254c..83bbe546 100644
--- a/src/utility/STM32_WPAN/stm_list.h
+++ b/src/utility/STM32_WPAN/stm_list.h
@@ -20,6 +20,10 @@
 #ifndef _STM_LIST_H_
 #define _STM_LIST_H_
 
+#ifdef __cplusplus
+extern "C" {
+#endif
+
 /* Includes ------------------------------------------------------------------*/
 #include "stm32_wpan_common.h"
 
@@ -52,4 +56,8 @@ void LST_get_next_node (tListNode * ref_node, tListNode ** node);
 
 void LST_get_prev_node (tListNode * ref_node, tListNode ** node);
 
+#ifdef __cplusplus
+}
+#endif
+
 #endif /* _STM_LIST_H_ */
diff --git a/src/utility/STM32_WPAN/tl_mbox.c b/src/utility/STM32_WPAN/tl_mbox.c
index 9a2a2973..cfd62c7b 100644
--- a/src/utility/STM32_WPAN/tl_mbox.c
+++ b/src/utility/STM32_WPAN/tl_mbox.c
@@ -32,6 +32,8 @@ typedef enum
   TL_MB_MM_RELEASE_BUFFER,
   TL_MB_BLE_CMD,
   TL_MB_BLE_CMD_RSP,
+  TL_MB_ACL_DATA,
+  TL_MB_ACL_DATA_RSP,
   TL_MB_BLE_ASYNCH_EVT,
   TL_MB_SYS_CMD,
   TL_MB_SYS_CMD_RSP,
@@ -179,6 +181,8 @@ int32_t TL_BLE_SendAclData( uint8_t* buffer, uint16_t size )
 
   ((TL_AclDataPacket_t *)(TL_RefTable.p_ble_table->phci_acl_data_buffer))->AclDataSerial.type = TL_ACL_DATA_PKT_TYPE;
 
+  OutputDbgTrace(TL_MB_ACL_DATA, TL_RefTable.p_ble_table->phci_acl_data_buffer);
+
   HW_IPCC_BLE_SendAclData();
 
   return 0;
@@ -186,6 +190,8 @@ int32_t TL_BLE_SendAclData( uint8_t* buffer, uint16_t size )
 
 void HW_IPCC_BLE_AclDataAckNot(void)
 {
+  OutputDbgTrace(TL_MB_ACL_DATA_RSP, (uint8_t*)NULL);
+
   BLE_IoBusAclDataTxAck( );
 
   return;
@@ -670,184 +676,205 @@ __WEAK void TL_TRACES_EvtReceived( TL_EvtPacket_t * hcievt )
 }
 
 /******************************************************************************
- * DEBUG INFORMATION
- ******************************************************************************/
+* DEBUG INFORMATION
+******************************************************************************/
 static void OutputDbgTrace(TL_MB_PacketType_t packet_type, uint8_t* buffer)
 {
   TL_EvtPacket_t *p_evt_packet;
   TL_CmdPacket_t *p_cmd_packet;
+  TL_AclDataPacket_t *p_acldata_packet;
   TL_EvtSerial_t *p_cmd_rsp_packet;
 
   switch(packet_type)
   {
-    case TL_MB_MM_RELEASE_BUFFER:
-      p_evt_packet = (TL_EvtPacket_t*)buffer;
-      switch(p_evt_packet->evtserial.evt.evtcode)
-      {
-        case TL_BLEEVT_CS_OPCODE:
-          TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_MM_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
-          TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
-          break;
-
-        case TL_BLEEVT_CC_OPCODE:
-          TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_MM_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
-          TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
-          break;
-
-        case TL_BLEEVT_VS_OPCODE:
-          TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_MM_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
-          TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
-          break;
-
-        default:
-          TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
-          break;
-      }
+  case TL_MB_MM_RELEASE_BUFFER:
+    p_evt_packet = (TL_EvtPacket_t*)buffer;
+    switch(p_evt_packet->evtserial.evt.evtcode)
+    {
+    case TL_BLEEVT_CS_OPCODE:
+      TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_MM_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
+      TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
+      break;
 
-      TL_MM_DBG_MSG("\r\n");
+    case TL_BLEEVT_CC_OPCODE:
+      TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_MM_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
+      TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
       break;
 
-    case TL_MB_BLE_CMD:
-      p_cmd_packet = (TL_CmdPacket_t*)buffer;
-      TL_HCI_CMD_DBG_MSG("ble cmd: 0x%04X", p_cmd_packet->cmdserial.cmd.cmdcode);
-      if(p_cmd_packet->cmdserial.cmd.plen != 0)
-      {
-        TL_HCI_CMD_DBG_MSG(" payload:");
-        TL_HCI_CMD_DBG_BUF(p_cmd_packet->cmdserial.cmd.payload, p_cmd_packet->cmdserial.cmd.plen, "");
-      }
-      TL_HCI_CMD_DBG_MSG("\r\n");
+    case TL_BLEEVT_VS_OPCODE:
+      TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_MM_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
+      TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
+      break;
+
+    default:
+      TL_MM_DBG_MSG("mm evt released: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_MM_DBG_MSG(" buffer addr: 0x%08X", p_evt_packet);
+      break;
+    }
+
+    TL_MM_DBG_MSG("\r\n");
+    break;
 
-      TL_HCI_CMD_DBG_RAW(&p_cmd_packet->cmdserial, p_cmd_packet->cmdserial.cmd.plen+TL_CMD_HDR_SIZE);
+  case TL_MB_BLE_CMD:
+    p_cmd_packet = (TL_CmdPacket_t*)buffer;
+    TL_HCI_CMD_DBG_MSG("ble cmd: 0x%04X", p_cmd_packet->cmdserial.cmd.cmdcode);
+    if(p_cmd_packet->cmdserial.cmd.plen != 0)
+    {
+      TL_HCI_CMD_DBG_MSG(" payload:");
+      TL_HCI_CMD_DBG_BUF(p_cmd_packet->cmdserial.cmd.payload, p_cmd_packet->cmdserial.cmd.plen, "");
+    }
+    TL_HCI_CMD_DBG_MSG("\r\n");
+
+    TL_HCI_CMD_DBG_RAW(&p_cmd_packet->cmdserial, p_cmd_packet->cmdserial.cmd.plen+TL_CMD_HDR_SIZE);
+    break;
+
+  case TL_MB_ACL_DATA:
+    (void)p_acldata_packet;
+    p_acldata_packet = (TL_AclDataPacket_t*)buffer;
+    TL_HCI_CMD_DBG_MSG("acl_data: 0x%02X", p_acldata_packet->AclDataSerial.type);
+    TL_HCI_CMD_DBG_MSG("acl_data: 0x%04X", p_acldata_packet->AclDataSerial.handle);
+    TL_HCI_CMD_DBG_MSG("acl_data: 0x%04X", p_acldata_packet->AclDataSerial.length);
+    /*if(p_acldata_packet->AclDataSerial.length != 0)
+    {
+    TL_HCI_CMD_DBG_MSG(" payload:");
+    TL_HCI_CMD_DBG_BUF(p_acldata_packet->AclDataSerial.acl_data, p_acldata_packet->AclDataSerial.length, "");
+  }*/
+    TL_HCI_CMD_DBG_MSG("\r\n");
+    /*TL_HCI_CMD_DBG_RAW(&p_acldata_packet->AclDataSerial, p_acldata_packet->AclDataSerial.length+TL_CMD_HDR_SIZE);*/
+    break;
+
+  case TL_MB_ACL_DATA_RSP:
+    TL_HCI_CMD_DBG_MSG(" ACL Data Tx Ack received");
+    TL_HCI_CMD_DBG_MSG("\r\n");
+    break;
+
+  case TL_MB_BLE_CMD_RSP:
+    p_evt_packet = (TL_EvtPacket_t*)buffer;
+    switch(p_evt_packet->evtserial.evt.evtcode)
+    {
+    case TL_BLEEVT_CS_OPCODE:
+      TL_HCI_CMD_DBG_MSG("ble rsp: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_HCI_CMD_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
+      TL_HCI_CMD_DBG_MSG(" numhci: 0x%02X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->numcmd);
+      TL_HCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->status);
       break;
 
-    case TL_MB_BLE_CMD_RSP:
-      p_evt_packet = (TL_EvtPacket_t*)buffer;
-      switch(p_evt_packet->evtserial.evt.evtcode)
+    case TL_BLEEVT_CC_OPCODE:
+      TL_HCI_CMD_DBG_MSG("ble rsp: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_HCI_CMD_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
+      TL_HCI_CMD_DBG_MSG(" numhci: 0x%02X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->numcmd);
+      TL_HCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload[0]);
+      if((p_evt_packet->evtserial.evt.plen-4) != 0)
       {
-        case TL_BLEEVT_CS_OPCODE:
-          TL_HCI_CMD_DBG_MSG("ble rsp: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_HCI_CMD_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
-          TL_HCI_CMD_DBG_MSG(" numhci: 0x%02X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->numcmd);
-          TL_HCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CsEvt_t*)(p_evt_packet->evtserial.evt.payload))->status);
-          break;
-
-        case TL_BLEEVT_CC_OPCODE:
-          TL_HCI_CMD_DBG_MSG("ble rsp: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-          TL_HCI_CMD_DBG_MSG(" cmd opcode: 0x%04X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->cmdcode);
-          TL_HCI_CMD_DBG_MSG(" numhci: 0x%02X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->numcmd);
-          TL_HCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload[0]);
-          if((p_evt_packet->evtserial.evt.plen-4) != 0)
-          {
-            TL_HCI_CMD_DBG_MSG(" payload:");
-            TL_HCI_CMD_DBG_BUF(&((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload[1], p_evt_packet->evtserial.evt.plen-4, "");
-          }
-          break;
-
-        default:
-          TL_HCI_CMD_DBG_MSG("unknown ble rsp received: %02X", p_evt_packet->evtserial.evt.evtcode);
-          break;
+        TL_HCI_CMD_DBG_MSG(" payload:");
+        TL_HCI_CMD_DBG_BUF(&((TL_CcEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload[1], p_evt_packet->evtserial.evt.plen-4, "");
       }
+      break;
 
-      TL_HCI_CMD_DBG_MSG("\r\n");
-
-      TL_HCI_CMD_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
+    default:
+      TL_HCI_CMD_DBG_MSG("unknown ble rsp received: %02X", p_evt_packet->evtserial.evt.evtcode);
       break;
+    }
 
-    case TL_MB_BLE_ASYNCH_EVT:
-      p_evt_packet = (TL_EvtPacket_t*)buffer;
-      if(p_evt_packet->evtserial.evt.evtcode != TL_BLEEVT_VS_OPCODE)
+    TL_HCI_CMD_DBG_MSG("\r\n");
+
+    TL_HCI_CMD_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
+    break;
+
+  case TL_MB_BLE_ASYNCH_EVT:
+    p_evt_packet = (TL_EvtPacket_t*)buffer;
+    if(p_evt_packet->evtserial.evt.evtcode != TL_BLEEVT_VS_OPCODE)
+    {
+      TL_HCI_EVT_DBG_MSG("ble evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      if((p_evt_packet->evtserial.evt.plen) != 0)
       {
-        TL_HCI_EVT_DBG_MSG("ble evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-        if((p_evt_packet->evtserial.evt.plen) != 0)
-        {
-          TL_HCI_EVT_DBG_MSG(" payload:");
-          TL_HCI_EVT_DBG_BUF(p_evt_packet->evtserial.evt.payload, p_evt_packet->evtserial.evt.plen, "");
-        }
+        TL_HCI_EVT_DBG_MSG(" payload:");
+        TL_HCI_EVT_DBG_BUF(p_evt_packet->evtserial.evt.payload, p_evt_packet->evtserial.evt.plen, "");
       }
-      else
+    }
+    else
+    {
+      TL_HCI_EVT_DBG_MSG("ble evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_HCI_EVT_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
+      if((p_evt_packet->evtserial.evt.plen-2) != 0)
       {
-        TL_HCI_EVT_DBG_MSG("ble evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-        TL_HCI_EVT_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
-        if((p_evt_packet->evtserial.evt.plen-2) != 0)
-        {
-          TL_HCI_EVT_DBG_MSG(" payload:");
-          TL_HCI_EVT_DBG_BUF(((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload, p_evt_packet->evtserial.evt.plen-2, "");
-        }
+        TL_HCI_EVT_DBG_MSG(" payload:");
+        TL_HCI_EVT_DBG_BUF(((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload, p_evt_packet->evtserial.evt.plen-2, "");
       }
+    }
 
-      TL_HCI_EVT_DBG_MSG("\r\n");
+    TL_HCI_EVT_DBG_MSG("\r\n");
 
-      TL_HCI_EVT_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
-      break;
+    TL_HCI_EVT_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
+    break;
+
+  case TL_MB_SYS_CMD:
+    p_cmd_packet = (TL_CmdPacket_t*)buffer;
+
+    TL_SHCI_CMD_DBG_MSG("sys cmd: 0x%04X", p_cmd_packet->cmdserial.cmd.cmdcode);
 
-    case TL_MB_SYS_CMD:
-      p_cmd_packet = (TL_CmdPacket_t*)buffer;
+    if(p_cmd_packet->cmdserial.cmd.plen != 0)
+    {
+      TL_SHCI_CMD_DBG_MSG(" payload:");
+      TL_SHCI_CMD_DBG_BUF(p_cmd_packet->cmdserial.cmd.payload, p_cmd_packet->cmdserial.cmd.plen, "");
+    }
+    TL_SHCI_CMD_DBG_MSG("\r\n");
 
-      TL_SHCI_CMD_DBG_MSG("sys cmd: 0x%04X", p_cmd_packet->cmdserial.cmd.cmdcode);
+    TL_SHCI_CMD_DBG_RAW(&p_cmd_packet->cmdserial, p_cmd_packet->cmdserial.cmd.plen+TL_CMD_HDR_SIZE);
+    break;
 
-      if(p_cmd_packet->cmdserial.cmd.plen != 0)
+  case TL_MB_SYS_CMD_RSP:
+    p_cmd_rsp_packet = (TL_EvtSerial_t*)buffer;
+    switch(p_cmd_rsp_packet->evt.evtcode)
+    {
+    case TL_BLEEVT_CC_OPCODE:
+      TL_SHCI_CMD_DBG_MSG("sys rsp: 0x%02X", p_cmd_rsp_packet->evt.evtcode);
+      TL_SHCI_CMD_DBG_MSG(" cmd opcode: 0x%02X", ((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->cmdcode);
+      TL_SHCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->payload[0]);
+      if((p_cmd_rsp_packet->evt.plen-4) != 0)
       {
         TL_SHCI_CMD_DBG_MSG(" payload:");
-        TL_SHCI_CMD_DBG_BUF(p_cmd_packet->cmdserial.cmd.payload, p_cmd_packet->cmdserial.cmd.plen, "");
+        TL_SHCI_CMD_DBG_BUF(&((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->payload[1], p_cmd_rsp_packet->evt.plen-4, "");
       }
-      TL_SHCI_CMD_DBG_MSG("\r\n");
-
-      TL_SHCI_CMD_DBG_RAW(&p_cmd_packet->cmdserial, p_cmd_packet->cmdserial.cmd.plen+TL_CMD_HDR_SIZE);
       break;
 
-    case TL_MB_SYS_CMD_RSP:
-      p_cmd_rsp_packet = (TL_EvtSerial_t*)buffer;
-      switch(p_cmd_rsp_packet->evt.evtcode)
-      {
-        case TL_BLEEVT_CC_OPCODE:
-          TL_SHCI_CMD_DBG_MSG("sys rsp: 0x%02X", p_cmd_rsp_packet->evt.evtcode);
-          TL_SHCI_CMD_DBG_MSG(" cmd opcode: 0x%02X", ((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->cmdcode);
-          TL_SHCI_CMD_DBG_MSG(" status: 0x%02X", ((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->payload[0]);
-          if((p_cmd_rsp_packet->evt.plen-4) != 0)
-          {
-            TL_SHCI_CMD_DBG_MSG(" payload:");
-            TL_SHCI_CMD_DBG_BUF(&((TL_CcEvt_t*)(p_cmd_rsp_packet->evt.payload))->payload[1], p_cmd_rsp_packet->evt.plen-4, "");
-          }
-          break;
-
-        default:
-          TL_SHCI_CMD_DBG_MSG("unknown sys rsp received: %02X", p_cmd_rsp_packet->evt.evtcode);
-          break;
-      }
+    default:
+      TL_SHCI_CMD_DBG_MSG("unknown sys rsp received: %02X", p_cmd_rsp_packet->evt.evtcode);
+      break;
+    }
 
-      TL_SHCI_CMD_DBG_MSG("\r\n");
+    TL_SHCI_CMD_DBG_MSG("\r\n");
 
-      TL_SHCI_CMD_DBG_RAW(&p_cmd_rsp_packet->evt, p_cmd_rsp_packet->evt.plen+TL_EVT_HDR_SIZE);
-      break;
+    TL_SHCI_CMD_DBG_RAW(&p_cmd_rsp_packet->evt, p_cmd_rsp_packet->evt.plen+TL_EVT_HDR_SIZE);
+    break;
 
-    case  TL_MB_SYS_ASYNCH_EVT:
-      p_evt_packet = (TL_EvtPacket_t*)buffer;
-      if(p_evt_packet->evtserial.evt.evtcode != TL_BLEEVT_VS_OPCODE)
-      {
-        TL_SHCI_EVT_DBG_MSG("unknown sys evt received: %02X", p_evt_packet->evtserial.evt.evtcode);
-      }
-      else
+  case  TL_MB_SYS_ASYNCH_EVT:
+    p_evt_packet = (TL_EvtPacket_t*)buffer;
+    if(p_evt_packet->evtserial.evt.evtcode != TL_BLEEVT_VS_OPCODE)
+    {
+      TL_SHCI_EVT_DBG_MSG("unknown sys evt received: %02X", p_evt_packet->evtserial.evt.evtcode);
+    }
+    else
+    {
+      TL_SHCI_EVT_DBG_MSG("sys evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
+      TL_SHCI_EVT_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
+      if((p_evt_packet->evtserial.evt.plen-2) != 0)
       {
-        TL_SHCI_EVT_DBG_MSG("sys evt: 0x%02X", p_evt_packet->evtserial.evt.evtcode);
-        TL_SHCI_EVT_DBG_MSG(" subevtcode: 0x%04X", ((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->subevtcode);
-        if((p_evt_packet->evtserial.evt.plen-2) != 0)
-        {
-          TL_SHCI_EVT_DBG_MSG(" payload:");
-          TL_SHCI_EVT_DBG_BUF(((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload, p_evt_packet->evtserial.evt.plen-2, "");
-        }
+        TL_SHCI_EVT_DBG_MSG(" payload:");
+        TL_SHCI_EVT_DBG_BUF(((TL_AsynchEvt_t*)(p_evt_packet->evtserial.evt.payload))->payload, p_evt_packet->evtserial.evt.plen-2, "");
       }
+    }
 
-      TL_SHCI_EVT_DBG_MSG("\r\n");
+    TL_SHCI_EVT_DBG_MSG("\r\n");
 
-      TL_SHCI_EVT_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
-      break;
+    TL_SHCI_EVT_DBG_RAW(&p_evt_packet->evtserial, p_evt_packet->evtserial.evt.plen+TL_EVT_HDR_SIZE);
+    break;
 
-    default:
-      break;
+  default:
+    break;
   }
 
   return;