create a random static address using random data

Author: paul-szczepanek-arm

features/FEATURE_BLE/targets/TARGET_NORDIC/TARGET_NORDIC_CORDIO/TARGET_NRF5x/NRFCordioHCIDriver.cpp

@@ -25,6 +25,7 @@
 #include "mbed_critical.h"
 
 // Cordio Includes
+#include "ll_math.h"
 #include "ll_init_api.h"
 #include "ll_defs.h"
 #include "custom_chci_tr.h"
@@ -350,9 +351,17 @@ void NRFCordioHCIDriver::start_reset_sequence()
 
 bool NRFCordioHCIDriver::get_random_static_address(ble::address_t& address)
 {
-    PalCfgLoadData(PAL_CFG_ID_BD_ADDR, address.data(), sizeof(bdAddr_t));
+    /* Load address from nRF configuration. */
+    uint64_t address_int = (((uint64_t)NRF_FICR->DEVICEID[0]) <<  0) |
+                           (((uint64_t)NRF_FICR->DEVICEID[1]) << 32);
 
-    MBED_ASSERT((address[5] & 0xC0) == 0xC0);
+    unsigned int i = 0;
+    while (i++ < BDA_ADDR_LEN) {
+        address[i] = address_int >> (i * 8);
+    }
+
+    /* Top two bits of static address must be 11 (Vol C, Part 3, section 10.8.1) */
+    address[5] |= 0xC0;
 
     return true;
 }