complete BLE init with device and power settings

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

Author: FRASTM

Diff for: src/utility/HCISharedMemTransport.cpp

@@ -52,6 +52,9 @@ PLACE_IN_SECTION("MB_MEM2") ALIGN(4) static uint8_t
   uint16_t _write_index;
   uint16_t _write_index_initial;
 
+/** Bluetooth Device Address */
+static uint8_t bd_addr_udn[6];
+
 HCISharedMemTransportClass::HCISharedMemTransportClass(BLEChip_t ble_chip) :
   _ble_chip(ble_chip)
 {
@@ -266,12 +269,20 @@ int HCISharedMemTransportClass::begin()
              */
 
 
-        /* Now start BLE service on firmware side, using Vendor specific
-         * command on the System Channel
-         */
-        stm32wb_start_ble();
+            /* Now start BLE service on firmware side, using Vendor specific
+             * command on the System Channel
+             */
+            stm32wb_start_ble();
 
             /* "IPM Channel Open Completed" */
+
+            /* Once reset complete evet is received we need
+             * to send a few more commands:
+             * set bd addr */
+            bt_ipm_set_addr();
+            /* and Tx power */ 
+            bt_ipm_set_power();
+
             return 1;
        } else {
             /* "Error opening IPM channel" */
@@ -488,11 +499,96 @@ size_t HCISharedMemTransportClass::write(const uint8_t* data, size_t length)
 
     }
 
+#if 1
+/* This function fills in a BD address table */
+bool get_bd_address(uint8_t *bd_addr)
+{
+    uint8_t *otp_addr;
+    uint32_t udn;
+    uint32_t company_id;
+    uint32_t device_id;
+    bool bd_found;
+
+    udn = LL_FLASH_GetUDN();
+
+    if (udn != 0xFFFFFFFF) {
+        /* "Found Unique Device Number: %#06x", udn) */
+
+        company_id = LL_FLASH_GetSTCompanyID();
+        device_id = LL_FLASH_GetDeviceID();
+
+        bd_addr[0] = (uint8_t)(udn & 0x000000FF);
+        bd_addr[1] = (uint8_t)((udn & 0x0000FF00) >> 8);
+        bd_addr[2] = (uint8_t)((udn & 0x00FF0000) >> 16);
+        bd_addr[3] = (uint8_t)device_id;
+        bd_addr[4] = (uint8_t)(company_id & 0x000000FF);
+        bd_addr[5] = (uint8_t)((company_id & 0x0000FF00) >> 8);
+
+        bd_found = true;
+    } else {
+        bd_addr =NULL;
+        bd_found = false;
+    }
+
+    return bd_found;
+}
+
+static int bt_ipm_set_addr(void)
+{
+    /* the specific table for set addr is 8 bytes:
+     * one byte for config_offset
+     * one byte for length
+     * 6 bytes for payload */
+    uint8_t data[4+8];
+
+    if (get_bd_address(bd_addr_udn)) {
+        /* create ACI_HAL_WRITE_CONFIG_DATA */
+
+        data[0] = BT_BUF_CMD;
+        data[1] = uint8_t(ACI_WRITE_CONFIG_DATA_OPCODE & 0x000000FF); /* OCF */
+        data[2] = uint8_t((ACI_WRITE_CONFIG_DATA_OPCODE & 0x0000FF00) >> 8); /* OGF */
+        data[3] = 8; /* length of parameters */
+        /* fill the ACI_HAL_WRITE_CONFIG_DATA with the addr*/
+        data[4] = CONFIG_DATA_PUBADDR_OFFSET; /* the offset */
+        data[5] = 6; /* is the length of the bd_addr table */
+        memcpy(data + 6, bd_addr_udn, 6);
+        /* send the ACI_HAL_WRITE_CONFIG_DATA */
+        mbox_write(data[0], 11, &data[1]);
+
+        return 1; /* success */
+    } else {
+        return 0; /* Error */
+    }
+}
+
+static int bt_ipm_set_power(void)
+{
+    /* the specific table for power is 3 bytes:
+     * one byte for cmd
+     * two bytes for value */
+    uint8_t data[4+3];
+
+    data[0] = BT_BUF_CMD; /* the type */
+    data[1] = (uint8_t)(ACI_HAL_SET_TX_POWER_LEVEL & 0x000000FF); /* the OPCODE */
+    data[2] = (uint8_t)((ACI_HAL_SET_TX_POWER_LEVEL & 0x0000FF00) >> 8);
+    data[3] = 3; /* the length */
+    /* fill the ACI_HAL_WRITE_CONFIG_DATA */
+    data[4] = 0x0F; /* the command */
+    data[5] = 0x18;
+    data[6] = 0x01;
+
+    /* send the ACI_HAL_WRITE_CONFIG_DATA */
+    mbox_write(data[0], 3, &data[1]);
+
+    return 1; /* success */
+}
+
+#else
     int bt_ipm_ble_init(void)
     {
         uint16_t       opcode;
         static uint8_t randCnt;
-#if 0
+
         /* if event is a command complete event */
         if (*pMsg == HCI_CMD_CMPL_EVT) {
             /* "Command Complete Event Command" */
@@ -707,9 +803,10 @@ size_t HCISharedMemTransportClass::write(const uint8_t* data, size_t length)
 #endif /* DEBUG */
             }
         }
-#endif
-	    return 0;
+
+	    return 1; /* success */
     }
+#endif
 
     uint16_t mbox_write(uint8_t type, uint16_t len, const uint8_t *pData)
     {
@@ -817,40 +914,3 @@ static void init_debug(void)
 
     return;
 }
-
-/* This function fills in a BD address table */
-bool get_bd_address(uint8_t *bd_addr)
-{
-    uint8_t *otp_addr;
-    uint32_t udn;
-    uint32_t company_id;
-    uint32_t device_id;
-    bool bd_found;
-
-    udn = LL_FLASH_GetUDN();
-
-    if (udn != 0xFFFFFFFF) {
-#if defined(DEBUG)
-        tr_info("Found Unique Device Number: %#06x", udn);
-#endif /* DEBUG */
-        company_id = LL_FLASH_GetSTCompanyID();
-        device_id = LL_FLASH_GetDeviceID();
-
-        bd_addr[0] = (uint8_t)(udn & 0x000000FF);
-        bd_addr[1] = (uint8_t)((udn & 0x0000FF00) >> 8);
-        bd_addr[2] = (uint8_t)((udn & 0x00FF0000) >> 16);
-        bd_addr[3] = (uint8_t)device_id;
-        bd_addr[4] = (uint8_t)(company_id & 0x000000FF);
-        bd_addr[5] = (uint8_t)((company_id & 0x0000FF00) >> 8);
-
-        bd_found = true;
-    } else {
-#if defined(DEBUG)
-        tr_info("Cannot find Bluetooth Device ADDRESS to program - will leave hw default");
-#endif /* DEBUG */
-            bd_addr = NULL;
-            bd_found = false;
-    }
-
-    return bd_found;
-}

Diff for: src/utility/HCISharedMemTransport.h

@@ -59,6 +59,9 @@
 #endif
 #define BLE_MODULE_SHARED_MEM_BUFFER_SIZE 128
 
+#define BT_BUF_CMD 1
+#define BT_BUF_ACL_OUT 2
+
 struct aci_set_tx_power {
             uint8_t cmd;
             uint8_t value[2];
@@ -101,6 +104,8 @@ static void acl_data_ack(void);
 static bool acl_data_wait(void);
 static void init_debug(void);
 static bool get_bd_address(uint8_t *bd_addr);
+static int bt_ipm_set_addr(void);
+static int bt_ipm_set_power(void);
 static bool sysevt_wait(void);
 static bool sysevt_check(void);
 static void sysevt_received(void *pdata);