add print message for debug

define DEBUG to output information
define PRINT_HCI_DATA to trace the exact content of the TX packet

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

Author: FRASTM

src/utility/HCISharedMemTransport.cpp

@@ -143,6 +143,19 @@ __disable_irq();
             _write_index += len;
             //TODO: control the _rxbuff cannot overflow
 __enable_irq();
+#if defined(DEBUG)
+                printf("RX<< EVT ");
+#if defined(PRINT_HCI_DATA)
+                printf(" Type %#x", hcievt->evtserial.type);
+                printf(" evt %#x", hcievt->evtserial.evt.evtcode);
+                printf(" Len %#d", hcievt->evtserial.evt.plen);
+                printf(" :");
+                for (uint8_t i = 0; i < hcievt->evtserial.evt.plen; i++) {
+                    printf(" %02X", hcievt->evtserial.evt.payload[i]);
+                }
+#endif /* PRINT_HCI_DATA */
+                printf("\r\n");
+#endif /* DEBUG */
             }
             break;
         case TL_ACL_DATA_PKT_TYPE: {
@@ -154,24 +167,37 @@ __disable_irq();
             _write_index += len;
             //TODO: control the _rxbuff cannot overflow
 __enable_irq();
+
+#if defined(DEBUG)
+                printf("RX<< ACL ");
+#if defined(PRINT_HCI_DATA)
+                printf(" Type %#x", acl->type);
+                printf(" evt %#x", acl->handle);
+                printf(" Len %#d", acl->length);
+                printf(" :");
+                for (uint8_t i = 0; i < acl->length; i++) {
+                    printf(" %02X", acl->acl_data[i]);
+                }
+#endif /* PRINT_HCI_DATA */
+                printf("\r\n");
+#endif /* DEBUG */
         }
             break;
         default:
             // should not happen - let's block to check
 #if defined(DEBUG)
-            printf("BLE TL evt_received, wrong type:%d", hcievt->evtserial.type);
+            printf("BLE TL evt_received, wrong type:%d\r\n", hcievt->evtserial.type);
 #endif /* DEBUG */
             break;
     }
 
     if (_write_index > BLE_MODULE_SHARED_MEM_BUFFER_SIZE) {
 #if defined(DEBUG)
-        printf("Error: data read overflow");
+        printf("Error: data read overflow\r\n");
 #endif /* DEBUG */
         data_available = true;
     }
 
-
     /*  In case Event belongs to the Evt Pool we need to inform  */
     if (((uint8_t *)hcievt >= EvtPool) && ((uint8_t *)hcievt < (EvtPool + POOL_SIZE))) {
         /*  Free the message from shared memory */
@@ -312,18 +338,18 @@ int HCISharedMemTransportClass::begin()
             WirelessFwInfo_t wireless_info_instance;
             WirelessFwInfo_t *p_wireless_info = &wireless_info_instance;
             SHCI_GetWirelessFwInfo(p_wireless_info);
-            /* 
-             * tr_info("WIRELESS COPROCESSOR FW VERSION ID = %d.%d.%d", p_wireless_info->VersionMajor, p_wireless_info->VersionMinor, p_wireless_info->VersionSub);
-             * tr_info("WIRELESS COPROCESSOR FW STACK TYPE = %d", p_wireless_info->StackType);
-             */
-
-
+#if defined(DEBUG)
+            printf("WB copro FW version = %d.%d.%d\r\n", p_wireless_info->VersionMajor, p_wireless_info->VersionMinor, p_wireless_info->VersionSub);
+#endif
             /* Now start BLE service on firmware side, using Vendor specific
              * command on the System Channel
              */
             stm32wb_start_ble();
 
-            /* "IPM Channel Open Completed" */
+            /* IPM Channel is now open */
+#if defined(DEBUG)
+            printf("IPM Channel Open Completed\r\n");
+#endif
 
             /* Once reset complete event is received we will need
              * to send a few more commands:
@@ -667,9 +693,7 @@ static int bt_ipm_set_power(void)
         // type 02 ACL DATA
         // type 03 SCO Voice (not supported)
         // type 04 event - uplink (not suported)
-#if defined(DEBUG)
-        printf("mbox_write type:%d, len:%d", type, len);
-#endif /* DEBUG */
+
         /*  TO DO : MANAGE ACL DATA CASE in separate buffer */
         switch (type) {
             case 1://BLE command
@@ -679,23 +703,25 @@ static int bt_ipm_set_power(void)
                 /* We're tracing here the command, after copy in shared mem but before
                  * * M0 trigger. */
 #if defined(DEBUG)
-                printf("TX>> BLE CMD");
-#if (PRINT_HCI_DATA)
+                printf("TX>> CMD ");
+#if defined(PRINT_HCI_DATA)
                 /* Trace the buffer including Type (+1 on lngth) */
-                tr_debug("  Type %#x", bleCmdBuf->cmdserial.type);
-                tr_debug("   Cmd %#x", bleCmdBuf->cmdserial.cmd.cmdcode);
-                tr_debug("   Len %#x", bleCmdBuf->cmdserial.cmd.plen);
+                printf(" Type %#x", bleCmdBuf->cmdserial.type);
+                printf(" Cmd %#x", bleCmdBuf->cmdserial.cmd.cmdcode);
+                printf(" Len %#d", bleCmdBuf->cmdserial.cmd.plen);
+                printf(" :");
                 for (uint8_t i = 0; i < bleCmdBuf->cmdserial.cmd.plen; i++) {
-                    tr_debug("  %02X", *(((uint8_t *)&bleCmdBuf->cmdserial.cmd.payload) + i));
+                    printf(" %02X", *(((uint8_t *)&bleCmdBuf->cmdserial.cmd.payload) + i));
                 }
 #endif /* PRINT_HCI_DATA */
+                printf("\r\n");
 #endif /* DEBUG */
                 TL_BLE_SendCmd(NULL, 0); // unused parameters for now
                 break;
             case 2://ACL DATA
                 if (acl_data) {
 #if defined(DEBUG)
-                    printf("ERROR: previous ACL message not ACK'd");
+                    printf("ERROR: previous ACL message not ACK'd\r\n");
 #endif /* DEBUG */
                     /*  return number of bytes sent, 0 in this error case */
                     return 0;
@@ -704,13 +730,13 @@ static int bt_ipm_set_power(void)
                 aclDataSerial->type = type; // for now this param is overwritten in TL_BLE_SendCmd
                 memcpy(HciAclDataBuffer + + sizeof(TL_PacketHeader_t) + sizeof(type), pData, len);
 #if defined(DEBUG)
-                printf("TX>> BLE ACL");
-#if PRINT_HCI_DATA
+                printf("TX>> ACL ");
+#if defined(PRINT_HCI_DATA)
                 for (uint8_t i = 0; i < len + 1 + 8; i++) {
-                    tr_debug("  %02x", *(((uint8_t *) aclDataBuffer) + i));
+                    printf("%02x ", *(((uint8_t *) HciAclDataBuffer) + i));
                 }
-                printf("\r\n");
 #endif /* PRINT_HCI_DATA */
+                printf("\r\n");
 #endif /* DEBUG */
                 TL_BLE_SendAclData(NULL, 0); // unused parameters for now
                 acl_data = true;
@@ -730,7 +756,7 @@ static void init_debug(void)
 
 #if defined(CONFIG_DEBUG)
 #if defined(DEBUG)
-    printf("init_debug ENABLED");
+    printf("init_debug ENABLED\r\n");
 #endif /* DEBUG */
     /**
      * Keep debugger enabled while in any low power mode
@@ -745,7 +771,7 @@ static void init_debug(void)
 
 #else
 #if defined(DEBUG)
-    printf("init_debug DISABLED");
+    printf("init_debug DISABLED\n\r");
 #endif /* DEBUG */
     GPIO_InitTypeDef gpio_config = {0};