fix: for pairing with Static Random Address

Signed-off-by: Arkadiusz Ambroziak <arekambroziak@op.pl>
Co-Auhthored-by: Frederic Pillon <frederic.pillon@st.com>

Author: fpistm

src/local/BLELocalDevice.cpp

@@ -142,10 +142,22 @@ int BLELocalDevice::begin()
   randomAddress [4] = randomNumber[4];
   randomAddress [5] = randomNumber[5];
 
-  if (HCI.leSetRandomAddress((uint8_t*)randomNumber) != 0) {
+  // Set Random address only when type is STATIC_RANDOM_ADDR
+  if ((_ownBdaddrType == STATIC_RANDOM_ADDR) && (HCI.leSetRandomAddress((uint8_t*)randomNumber) != 0)) {
     end();
     return 0;
   }
+  // Save address to HCI.localAddr variable, which is used to encryption in pairing
+  if(_ownBdaddrType == PUBLIC_ADDR){
+    if (HCI.readBdAddr() != 0) {
+      end();
+      return 0;
+    }
+  } else {
+    for(int k=0; k<6; k++){
+      HCI.localAddr[5-k] = randomAddress[k];
+    }
+  }
 
   uint8_t hciVer;
   uint16_t hciRev;
@@ -301,7 +313,17 @@ bool BLELocalDevice::disconnect()
 String BLELocalDevice::address() const
 {
   uint8_t addr[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
-  HCI.readBdAddr(addr);
+  // return correct device address when is set to STATIC RANDOM (set by HCI)
+  if(_ownBdaddrType == PUBLIC_ADDR) {
+    HCI.readBdAddr(addr);
+  } else {
+    addr[0] = randomAddress[0];
+    addr[1] = randomAddress[1];
+    addr[2] = randomAddress[2];
+    addr[3] = randomAddress[3];
+    addr[4] = randomAddress[4];
+    addr[5] = randomAddress[5];
+  }
 
   char result[18];
   sprintf(result, "%02x:%02x:%02x:%02x:%02x:%02x", addr[5], addr[4], addr[3], addr[2], addr[1], addr[0]);

src/utility/L2CAPSignaling.cpp

@@ -371,10 +371,12 @@ void L2CAPSignalingClass::smCalculateLTKandConfirm(uint16_t handle, uint8_t expe
   uint8_t localAddress[7];
   uint8_t remoteAddress[7];
   ATT.getPeerAddrWithType(handle, remoteAddress);
-  
-  HCI.readBdAddr();
+
+  // Address is taken directly from HCI.localaddress,
+  //  which is set when object DeviceLocal is created
+  // HCI.readBdAddr();
   memcpy(&localAddress[1],HCI.localAddr,6);
-  localAddress[0] = 0; // IOT 33 uses a static address // TODO: confirm for Nano BLE
+  localAddress[0] = ATT.getOwnBdaddrType(); // Adding bit with address type (e.g. Static random or public address)
 
   // Compute the LTK and MacKey
   uint8_t MacKey[16];