441 lines
15 KiB
C
441 lines
15 KiB
C
|
/***************************************************************************
|
||
|
*
|
||
|
* Copyright 2015-2019 BES.
|
||
|
* All rights reserved. All unpublished rights reserved.
|
||
|
*
|
||
|
* No part of this work may be used or reproduced in any form or by any
|
||
|
* means, or stored in a database or retrieval system, without prior written
|
||
|
* permission of BES.
|
||
|
*
|
||
|
* Use of this work is governed by a license granted by BES.
|
||
|
* This work contains confidential and proprietary information of
|
||
|
* BES. which is protected by copyright, trade secret,
|
||
|
* trademark and other intellectual property rights.
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
#if defined(NEW_NV_RECORD_ENABLED)
|
||
|
#include <string.h>
|
||
|
#include <stdbool.h>
|
||
|
#include <assert.h>
|
||
|
#include "nvrecord_extension.h"
|
||
|
#include "nvrecord_ble.h"
|
||
|
#include "hal_trace.h"
|
||
|
#include "co_math.h"
|
||
|
#include "tgt_hardware.h"
|
||
|
#include "hal_timer.h"
|
||
|
#include "besbt.h"
|
||
|
|
||
|
#define ble_nv_debug
|
||
|
#ifdef ble_nv_debug
|
||
|
#define ble_trace TRACE
|
||
|
#else
|
||
|
#define ble_trace
|
||
|
#endif
|
||
|
|
||
|
static NV_RECORD_PAIRED_BLE_DEV_INFO_T *nvrecord_ble_p = NULL;
|
||
|
static uint8_t INVALID_ADDR[BTIF_BD_ADDR_SIZE] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
||
|
|
||
|
void nvrecord_rebuild_paired_ble_dev_info(NV_RECORD_PAIRED_BLE_DEV_INFO_T *pPairedBtInfo)
|
||
|
{
|
||
|
memset(( uint8_t * )pPairedBtInfo, 0, sizeof(NV_RECORD_PAIRED_BLE_DEV_INFO_T));
|
||
|
pPairedBtInfo->saved_list_num = 0; //init saved num
|
||
|
|
||
|
uint8_t index;
|
||
|
//avoid ble irk collision low probability
|
||
|
uint32_t generatedSeed = hal_sys_timer_get();
|
||
|
for (uint8_t index = 0; index < sizeof(bt_addr); index++)
|
||
|
{
|
||
|
generatedSeed ^= (((uint32_t)(bt_addr[index])) << (hal_sys_timer_get() & 0xF));
|
||
|
}
|
||
|
srand(generatedSeed);
|
||
|
|
||
|
// generate a new IRK
|
||
|
for (index = 0; index < BLE_IRK_SIZE; index++)
|
||
|
{
|
||
|
pPairedBtInfo->self_info.ble_irk[index] = ( uint8_t )co_rand_word();
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static bool blerec_specific_value_prepare(const BleDeviceinfo *param_rec)
|
||
|
{
|
||
|
// Preparations before adding new ble record:
|
||
|
// 1. If not existing. Check the record count. If it's BLE_RECORD_NUM,
|
||
|
// move 0-(BLE_RECORD_NUM-2) right side by one slot, to discard the last one and
|
||
|
// leave slot 0, decrease the record number.
|
||
|
// If it's smaller than BLE_RECORD_NUM, move 0-(count-1) right side by one slot, leave slot 0,
|
||
|
// don't change the record number.
|
||
|
// 2. If existing already and the location is entryToFree , move 0-(entryToFree-1)
|
||
|
// right side by one slot, leave slot 0. Decrease the record number for adding the new one.
|
||
|
|
||
|
bool isEntryExisting = false;
|
||
|
uint8_t entryToFree = 0;
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T *dest_ptr;
|
||
|
|
||
|
dest_ptr = nvrecord_ble_p;
|
||
|
TRACE(3,"%s start search addr %p list_num=%d", __func__, dest_ptr, dest_ptr->saved_list_num);
|
||
|
|
||
|
if (dest_ptr->saved_list_num > 0)
|
||
|
{
|
||
|
for (uint8_t i = 0; i < dest_ptr->saved_list_num; i++)
|
||
|
{
|
||
|
if (0 == memcmp(dest_ptr->ble_nv[i].peer_bleAddr, param_rec->peer_bleAddr, BLE_ADDR_SIZE))
|
||
|
{
|
||
|
ble_trace(2,"%s Find the existing entry %d", __func__, i);
|
||
|
DUMP8("%02x ", ( uint8_t * )param_rec, sizeof(BleDeviceinfo));
|
||
|
DUMP8("%02x ", ( uint8_t * )&dest_ptr->ble_nv[i], sizeof(BleDeviceinfo));
|
||
|
if (!memcmp(( uint8_t * )param_rec, ( uint8_t * )&dest_ptr->ble_nv[i], sizeof(BleDeviceinfo)))
|
||
|
{
|
||
|
ble_trace(0,"The new coming BLE device info is the same as the recorded.");
|
||
|
return false;
|
||
|
}
|
||
|
memset(&(dest_ptr->ble_nv[i]), 0, sizeof(BleDeviceinfo));
|
||
|
entryToFree = i;
|
||
|
dest_ptr->saved_list_num--;
|
||
|
isEntryExisting = true;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
if (!isEntryExisting)
|
||
|
{
|
||
|
if (BLE_RECORD_NUM == dest_ptr->saved_list_num)
|
||
|
{
|
||
|
TRACE(0,"<=====>blerec list is full,delete the oldest and add param_rec to list");
|
||
|
for (uint8_t k = 0; k < BLE_RECORD_NUM - 1; k++)
|
||
|
{
|
||
|
memcpy(&(dest_ptr->ble_nv[BLE_RECORD_NUM - 1 - k]),
|
||
|
&(dest_ptr->ble_nv[BLE_RECORD_NUM - 2 - k]),
|
||
|
sizeof(BleDeviceinfo));
|
||
|
}
|
||
|
dest_ptr->saved_list_num--;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
for (uint8_t k = 0; k < dest_ptr->saved_list_num; k++)
|
||
|
{
|
||
|
memcpy(&(dest_ptr->ble_nv[dest_ptr->saved_list_num - k]),
|
||
|
&(dest_ptr->ble_nv[dest_ptr->saved_list_num - 1 - k]),
|
||
|
sizeof(BleDeviceinfo));
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
for (uint8_t list_updata = 0; list_updata < entryToFree; list_updata++)
|
||
|
{
|
||
|
memcpy(&(dest_ptr->ble_nv[entryToFree - list_updata]),
|
||
|
&(dest_ptr->ble_nv[entryToFree - list_updata - 1]),
|
||
|
sizeof(BleDeviceinfo));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
void nv_record_blerec_init(void)
|
||
|
{
|
||
|
uint32_t lock = nv_record_pre_write_operation();
|
||
|
if (NULL == nvrecord_ble_p)
|
||
|
{
|
||
|
nvrecord_ble_p = &(nvrecord_extension_p->ble_pair_info);
|
||
|
if (!memcmp(nvrecord_ble_p->self_info.ble_addr, INVALID_ADDR, BTIF_BD_ADDR_SIZE))
|
||
|
{
|
||
|
memcpy(nvrecord_ble_p->self_info.ble_addr, bt_get_ble_local_address(), BTIF_BD_ADDR_SIZE);
|
||
|
}
|
||
|
}
|
||
|
nv_record_post_write_operation(lock);
|
||
|
}
|
||
|
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T* nv_record_blerec_get_ptr(void)
|
||
|
{
|
||
|
return nvrecord_ble_p;
|
||
|
}
|
||
|
|
||
|
void nv_record_blerec_get_local_irk(uint8_t *pIrk)
|
||
|
{
|
||
|
memcpy(pIrk, nvrecord_ble_p->self_info.ble_irk, BLE_IRK_SIZE);
|
||
|
}
|
||
|
|
||
|
bool nv_record_blerec_get_bd_addr_from_irk(uint8_t *pBdAddr, uint8_t *pIrk)
|
||
|
{
|
||
|
if (nvrecord_ble_p->saved_list_num > 0)
|
||
|
{
|
||
|
for (uint8_t index = 0; index < nvrecord_ble_p->saved_list_num; index++)
|
||
|
{
|
||
|
if (!memcmp(pIrk, nvrecord_ble_p->ble_nv[index].IRK, BLE_IRK_SIZE))
|
||
|
{
|
||
|
memcpy(pBdAddr, nvrecord_ble_p->ble_nv[index].peer_bleAddr, BLE_ADDR_SIZE);
|
||
|
return true;
|
||
|
}
|
||
|
}
|
||
|
return false;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
int nv_record_blerec_add(const BleDeviceinfo *param_rec)
|
||
|
{
|
||
|
int nRet = 0;
|
||
|
|
||
|
uint8_t isNeedToUpdateNv = true;
|
||
|
isNeedToUpdateNv = blerec_specific_value_prepare(param_rec);
|
||
|
|
||
|
if (isNeedToUpdateNv)
|
||
|
{
|
||
|
uint32_t lock = nv_record_pre_write_operation();
|
||
|
|
||
|
//add device info into nv struct
|
||
|
memcpy(nvrecord_ble_p->ble_nv[0].peer_bleAddr, param_rec->peer_bleAddr, BLE_ADDR_SIZE); //addr
|
||
|
nvrecord_ble_p->ble_nv[0].EDIV = param_rec->EDIV; //EDIV
|
||
|
memcpy(nvrecord_ble_p->ble_nv[0].RANDOM, param_rec->RANDOM, BLE_ENC_RANDOM_SIZE); //RANDOM
|
||
|
memcpy(nvrecord_ble_p->ble_nv[0].LTK, param_rec->LTK, BLE_LTK_SIZE); //LTK
|
||
|
memcpy(nvrecord_ble_p->ble_nv[0].IRK, param_rec->IRK, BLE_IRK_SIZE); //IRK
|
||
|
nvrecord_ble_p->ble_nv[0].bonded = param_rec->bonded; //bond status
|
||
|
nvrecord_ble_p->saved_list_num++; //updata saved num
|
||
|
nv_record_post_write_operation(lock);
|
||
|
|
||
|
nv_record_update_runtime_userdata();
|
||
|
nv_record_execute_async_flush();
|
||
|
TRACE(2,"%s CURRENT BLE LIST NUM=%d", __func__, nvrecord_ble_p->saved_list_num);
|
||
|
}
|
||
|
|
||
|
#ifdef ble_nv_debug
|
||
|
for (uint8_t k = 0; k < nvrecord_ble_p->saved_list_num; k++)
|
||
|
{
|
||
|
TRACE(0,"=========================================");
|
||
|
TRACE(1,"Num %d BLE record:", k);
|
||
|
TRACE(0,"BLE addr:");
|
||
|
DUMP8("%02x ", ( uint8_t * )nvrecord_ble_p->ble_nv[k].peer_bleAddr, BLE_ADDR_SIZE);
|
||
|
TRACE(1,"NV EDIV %d and random is:", nvrecord_ble_p->ble_nv[k].EDIV);
|
||
|
DUMP8("%02x ", ( uint8_t * )nvrecord_ble_p->ble_nv[k].RANDOM, BLE_ENC_RANDOM_SIZE);
|
||
|
TRACE(0,"NV LTK:");
|
||
|
DUMP8("%02x ", ( uint8_t * )nvrecord_ble_p->ble_nv[k].LTK, BLE_LTK_SIZE);
|
||
|
TRACE(0,"NV irk:");
|
||
|
DUMP8("%02x ", ( uint8_t * )nvrecord_ble_p->ble_nv[k].IRK, BLE_IRK_SIZE);
|
||
|
}
|
||
|
#endif
|
||
|
return nRet;
|
||
|
}
|
||
|
|
||
|
uint8_t nv_record_ble_fill_irk(uint8_t *irkToFill)
|
||
|
{
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T *find_ptr = nvrecord_ble_p;
|
||
|
|
||
|
if ((NULL == find_ptr) || (0 == find_ptr->saved_list_num))
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (find_ptr->saved_list_num > 0)
|
||
|
{
|
||
|
for (uint8_t index = 0; index < find_ptr->saved_list_num; index++)
|
||
|
{
|
||
|
memcpy(irkToFill + index * BLE_IRK_SIZE, find_ptr->ble_nv[index].IRK, BLE_IRK_SIZE);
|
||
|
}
|
||
|
return find_ptr->saved_list_num;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
//when master send encription req,if bonded,use ltk to bonding again(skip the pair step)
|
||
|
bool nv_record_ble_record_find_ltk_through_static_bd_addr(uint8_t *pBdAddr, uint8_t *ltk)
|
||
|
{
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T *find_ptr = nvrecord_ble_p;
|
||
|
|
||
|
if ((NULL == find_ptr) || (0 == find_ptr->saved_list_num))
|
||
|
{
|
||
|
TRACE(3,"%s find data failed, ptr:%x, list_num:%d", __func__, (uint32_t)find_ptr, find_ptr->saved_list_num);
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
for (uint8_t find_index = 0; find_index < find_ptr->saved_list_num; find_index++)
|
||
|
{
|
||
|
if (!memcmp(find_ptr->ble_nv[find_index].peer_bleAddr, pBdAddr, BLE_ADDR_SIZE))
|
||
|
{
|
||
|
ble_trace(2,"%s FIND LTK IN NV SUCCESS %p", __func__, find_ptr->ble_nv[find_index].LTK);
|
||
|
memcpy(ltk, find_ptr->ble_nv[find_index].LTK, BLE_LTK_SIZE);
|
||
|
return true;
|
||
|
}
|
||
|
}
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
bool nv_record_ble_record_Once_a_device_has_been_bonded(void)
|
||
|
{
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T *find_ptr = nvrecord_ble_p;
|
||
|
|
||
|
if ((NULL == find_ptr) || (0 == find_ptr->saved_list_num))
|
||
|
{
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
for (uint8_t find_index = 0; find_index < find_ptr->saved_list_num; find_index++)
|
||
|
{
|
||
|
if (find_ptr->ble_nv[find_index].bonded == true)
|
||
|
{
|
||
|
return true;
|
||
|
}
|
||
|
}
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
void nv_record_ble_delete_entry(uint8_t *pBdAddr)
|
||
|
{
|
||
|
NV_RECORD_PAIRED_BLE_DEV_INFO_T *find_ptr = nvrecord_ble_p;
|
||
|
|
||
|
if ((NULL == find_ptr) || (0 == find_ptr->saved_list_num))
|
||
|
{
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
int8_t indexToDelete = -1;
|
||
|
|
||
|
for (uint8_t find_index = 0; find_index < find_ptr->saved_list_num; find_index++)
|
||
|
{
|
||
|
if (!memcmp(find_ptr->ble_nv[find_index].peer_bleAddr, pBdAddr, BLE_ADDR_SIZE))
|
||
|
{
|
||
|
indexToDelete = find_index;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (indexToDelete >= 0)
|
||
|
{
|
||
|
uint32_t lock = nv_record_pre_write_operation();
|
||
|
|
||
|
uint8_t index;
|
||
|
for (index = indexToDelete; index < find_ptr->saved_list_num - 1; index++)
|
||
|
{
|
||
|
memcpy(&(find_ptr->ble_nv[index]),
|
||
|
&(find_ptr->ble_nv[index + 1]),
|
||
|
sizeof(BleDeviceinfo));
|
||
|
}
|
||
|
|
||
|
memset(( uint8_t * )&(find_ptr->ble_nv[index]), 0, sizeof(BleDeviceinfo));
|
||
|
find_ptr->saved_list_num--;
|
||
|
nv_record_update_runtime_userdata();
|
||
|
nv_record_post_write_operation(lock);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
#ifdef TWS_SYSTEM_ENABLED
|
||
|
static bool tws_use_same_ble_addr(uint8_t *peer_ble_addr)
|
||
|
{
|
||
|
TRACE(1,"[%s] peer addr:", __func__);
|
||
|
DUMP8("%x ", peer_ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
|
||
|
NV_EXTENSION_RECORD_T *pNvExtRec = nv_record_get_extension_entry_ptr();
|
||
|
|
||
|
if (!memcmp(pNvExtRec->ble_pair_info.self_info.ble_addr, peer_ble_addr, BTIF_BD_ADDR_SIZE))
|
||
|
{
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
void nv_record_extension_update_tws_ble_info(NV_RECORD_PAIRED_BLE_DEV_INFO_T *info)
|
||
|
{
|
||
|
ASSERT(info, "null pointer received in [%s]", __func__);
|
||
|
|
||
|
bool isNvExtentionPendingForUpdate = false;
|
||
|
NV_EXTENSION_RECORD_T *pNvExtRec = nv_record_get_extension_entry_ptr();
|
||
|
|
||
|
if (tws_use_same_ble_addr(info->self_info.ble_addr))
|
||
|
{
|
||
|
if (memcmp(&pNvExtRec->ble_pair_info.self_info, &info->self_info, sizeof(BLE_BASIC_INFO_T)))
|
||
|
{
|
||
|
TRACE(0,"save the peer ble info to self_info");
|
||
|
memcpy(&pNvExtRec->ble_pair_info.self_info, &info->self_info, sizeof(BLE_BASIC_INFO_T));
|
||
|
nv_record_extension_update();
|
||
|
isNvExtentionPendingForUpdate = true;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (memcmp(&pNvExtRec->tws_info.ble_info, &info->self_info, sizeof(BLE_BASIC_INFO_T)))
|
||
|
{
|
||
|
TRACE(0,"save the peer ble info to tws_info");
|
||
|
memcpy(&pNvExtRec->tws_info.ble_info, &info->self_info, sizeof(BLE_BASIC_INFO_T));
|
||
|
nv_record_extension_update();
|
||
|
isNvExtentionPendingForUpdate = true;
|
||
|
}
|
||
|
|
||
|
if (isNvExtentionPendingForUpdate)
|
||
|
{
|
||
|
nv_record_execute_async_flush();
|
||
|
}
|
||
|
|
||
|
TRACE(0,"peer addr:");
|
||
|
DUMP8("0x%02x ", pNvExtRec->tws_info.ble_info.ble_addr,BTIF_BD_ADDR_SIZE);
|
||
|
TRACE(0,"peer irk");
|
||
|
DUMP8("0x%02x ", pNvExtRec->tws_info.ble_info.ble_irk, BLE_IRK_SIZE);
|
||
|
}
|
||
|
|
||
|
void nv_record_tws_exchange_ble_info(void)
|
||
|
{
|
||
|
TRACE(1,"[%s]+++", __func__);
|
||
|
return;
|
||
|
NV_EXTENSION_RECORD_T *pNvExtRec = nv_record_get_extension_entry_ptr();
|
||
|
uint8_t ble_address[6] = {0, 0, 0, 0, 0, 0};
|
||
|
|
||
|
if (tws_use_same_ble_addr(pNvExtRec->tws_info.ble_info.ble_addr))
|
||
|
{
|
||
|
TRACE(0,"tws use same ble addr");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (!memcmp(pNvExtRec->tws_info.ble_info.ble_addr, ble_address, BTIF_BD_ADDR_SIZE))
|
||
|
{
|
||
|
TRACE(0,"don't have tws ble addr");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
#ifdef BLE_USE_RPA
|
||
|
uint8_t temp_ble_irk[BLE_IRK_SIZE];
|
||
|
memcpy(temp_ble_irk, pNvExtRec->ble_pair_info.self_info.ble_irk, BLE_IRK_SIZE);
|
||
|
memcpy(pNvExtRec->ble_pair_info.self_info.ble_irk, pNvExtRec->tws_info.ble_info.ble_irk, BLE_IRK_SIZE);
|
||
|
memcpy(pNvExtRec->tws_info.ble_info.ble_irk, temp_ble_irk, BLE_IRK_SIZE);
|
||
|
TRACE(0,"current local ble irk:");
|
||
|
DUMP8("0x%02x ", pNvExtRec->ble_pair_info.self_info.ble_irk, BLE_IRK_SIZE);
|
||
|
#else
|
||
|
uint8_t temp_ble_addr[BTIF_BD_ADDR_SIZE];
|
||
|
memcpy(temp_ble_addr, pNvExtRec->ble_pair_info.self_info.ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
memcpy(pNvExtRec->ble_pair_info.self_info.ble_addr, pNvExtRec->tws_info.ble_info.ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
memcpy(pNvExtRec->tws_info.ble_info.ble_addr, temp_ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
memcpy(bt_get_ble_local_address(), pNvExtRec->ble_pair_info.self_info.ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
TRACE(0,"current local ble addr:");
|
||
|
DUMP8("0x%02x ", pNvExtRec->ble_pair_info.self_info.ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
|
||
|
bt_set_ble_local_address(pNvExtRec->ble_pair_info.self_info.ble_addr);
|
||
|
#endif
|
||
|
|
||
|
nv_record_extension_update();
|
||
|
TRACE(1,"[%s]---", __func__);
|
||
|
}
|
||
|
|
||
|
uint8_t *nv_record_tws_get_self_ble_info(void)
|
||
|
{
|
||
|
TRACE(1,"[%s]+++", __func__);
|
||
|
NV_EXTENSION_RECORD_T *pNvExtRec = nv_record_get_extension_entry_ptr();
|
||
|
|
||
|
TRACE(0,"current local ble addr:");
|
||
|
DUMP8("0x%02x ", pNvExtRec->ble_pair_info.self_info.ble_addr, BTIF_BD_ADDR_SIZE);
|
||
|
|
||
|
TRACE(1,"[%s]---", __func__);
|
||
|
return pNvExtRec->ble_pair_info.self_info.ble_addr;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
#endif //#if defined(NEW_NV_RECORD_ENABLED)
|