portentaH7: Change BLE public address

Author: polldo

features/FEATURE_BLE/targets/TARGET_STM/TARGET_CYW4343X/HCIDriver.cpp

@@ -383,13 +383,24 @@ class HCIDriver : public cordio::CordioHCIDriver {
 #endif /* BT_UART_NO_3M_SUPPORT */
     }
 
+    void inject_bdaddr(uint8_t* pBuf)
+    {
+        if (service_pack_ptr + service_pack_index == brcm_patchram_buf) {
+            uint8_t bdAddr[6] = { 0xFF, 0xFF, 0xFF, 0x0A, 0x61, 0xA8 }; 
+            uint32_t uniqueId = HAL_GetUIDw0() ^ HAL_GetUIDw1() ^ HAL_GetUIDw2();
+            memcpy(bdAddr, &uniqueId, 3);
+            memcpy(&pBuf[33], bdAddr, sizeof(bdAddr));
+        }
+    }
+
     void send_service_pack_command(void)
     {
         uint16_t cmd_len = service_pack_ptr[service_pack_index + 2];
         uint16_t cmd_opcode = (service_pack_ptr[service_pack_index + 1] << 8) | service_pack_ptr[service_pack_index + 0];
         uint8_t *pBuf = hciCmdAlloc(cmd_opcode, cmd_len);
         if (pBuf) {
             memcpy(pBuf + HCI_CMD_HDR_LEN, service_pack_ptr + service_pack_index + HCI_CMD_HDR_LEN, cmd_len);
+            inject_bdaddr(pBuf);
             hciCmdSend(pBuf);
         } else {
         }