king
/
v811_spc009
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
Branches Tags
${ item.name }
Create tag ${ searchTerm }
Create branch ${ searchTerm }
from '70a66d9bf5'
${ noResults }
v811_spc009/hardware/st/nfc/st21nfc/hal/hal_fd.cc

742 lines
26 KiB
Raw Blame History

/******************************************************************************
*
* Copyright (C) 2018 ST Microelectronics S.A.
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
*
******************************************************************************/
#define LOG_TAG "NfcHalFd"
#include "hal_fd.h"
#include <cutils/properties.h>
#include <dlfcn.h>
#include <errno.h>
#include <hardware/nfc.h>
#include <string.h>
#include "android_logmsg.h"
#include "halcore.h"
/* Initialize fw info structure pointer used to access fw info structure */
FWInfo *mFWInfo = NULL;
FILE *mFwFileBin;
FILE *mCustomFileBin;
fpos_t mPos;
fpos_t mPosInit;
uint8_t mBinData[260];
bool mRetry = true;
bool mCustomParamFailed = false;
bool mCustomParamDone = false;
bool mUwbConfigDone = false;
bool mUwbConfigNeeded = false;
bool mGetCustomerField = false;
uint8_t *pCmd;
int mFWRecovCount = 0;
const char *FwType = "generic";
char mApduAuthent[24];
static const uint8_t propNfcModeSetCmdOn[] = {0x2f, 0x02, 0x02, 0x02, 0x01};
static const uint8_t coreInitCmd[] = {0x20, 0x01, 0x02, 0x00, 0x00};
static const uint8_t NciPropNfcFwUpdate[] = {0x2F, 0x02, 0x05, 0x06,
0x00, 0x01, 0x02, 0x03};
static uint8_t ApduEraseNfcKeepAppliAndNdef[] = {
0x2F, 0x04, 0x16, 0x80, 0x0C, 0x00, 0x00, 0x11, 0x05,
0x00, 0x23, 0xDF, 0x00, 0x00, 0x23, 0xDF, 0xFF, 0x00,
0x23, 0xE0, 0x00, 0x00, 0x23, 0xFF, 0xFF};
static const uint8_t ApduExitLoadMode[] = {0x2F, 0x04, 0x06, 0x80, 0xA0,
0x00, 0x00, 0x01, 0x01};
static const uint8_t nciHeaderPropSetUwbConfig[9] = {
0x2F, 0x02, 0x00, 0x04, 0x00, 0x16, 0x01, 0x00, 0x00};
static const uint8_t nciGetPropConfig[8] = {0x2F, 0x02, 0x05, 0x03,
0x00, 0x06, 0x01, 0x00};
static const uint8_t nciSetPropConfig[9] = {0x2F, 0x02, 0x00, 0x04, 0x00,
0x06, 0x01, 0x00, 0x00};
static uint8_t nciPropSetUwbConfig[128];
static uint8_t nciPropSetConfig_CustomField[64];
hal_fd_state_e mHalFDState = HAL_FD_STATE_AUTHENTICATE;
void SendExitLoadMode(HALHANDLE mmHalHandle);
extern void hal_wrapper_update_complete();
typedef size_t (*STLoadUwbParams)(void *out_buff,
size_t buf_size);
/**
* Send a HW reset and decode NCI_CORE_RESET_NTF information
* @param pHwVersion is used to return HW version, part of NCI_CORE_RESET_NTF
* @param pFwVersion is used to return FW version, part of NCI_CORE_RESET_NTF
* @param pLoaderVersion is used to return Loader version, part of
* NCI_CORE_RESET_NTF
* @param pCustVersion si used to return Customer field value, part of
* NCI_CORE_RESET_NTF when in router mode
*
* @return mode: FT_CLF_MODE_ROUTER if router mode
* FT_CLF_MODE_LOADER if loader mode
* FT_CLF_MODE_ERROR if Error
*/
int hal_fd_init() {
uint8_t result = 0;
char FwPath[256];
char ConfPath[256];
char fwBinName[256];
char fwConfName[256];
STLOG_HAL_D(" %s - enter", __func__);
if (!GetStrValue(NAME_STNFC_FW_PATH_STORAGE, (char *)FwPath,
sizeof(FwPath))) {
STLOG_HAL_D(
"%s - FW path not found in conf. use default location /vendor/firmware "
"\n", __func__);
strcpy(FwPath, "/vendor/firmware");
}
if (!GetStrValue(NAME_STNFC_FW_BIN_NAME, (char *)fwBinName,
sizeof(fwBinName))) {
STLOG_HAL_D(
"%s - FW binary file name not found in conf. use default name "
"/st21nfc_fw.bin \n", __func__);
strcpy(fwBinName, "/st21nfc_fw.bin");
}
if (!GetStrValue(NAME_STNFC_FW_CONF_NAME, (char *)fwConfName,
sizeof(fwConfName))) {
STLOG_HAL_D(
"%s - FW config file name not found in conf. use default name "
"/st21nfc_conf.bin \n", __func__);
strcpy(fwConfName, "/st21nfc_conf.bin");
}
// Getting information about FW patch, if any
strcpy(ConfPath, FwPath);
strncat(FwPath, fwBinName, sizeof(FwPath) - strlen(FwPath) - 1);
strncat(ConfPath, fwConfName, sizeof(ConfPath) - strlen(ConfPath) - 1);
STLOG_HAL_D("%s - FW update binary file = %s", __func__, FwPath);
STLOG_HAL_D("%s - FW config binary file = %s", __func__, ConfPath);
// Initializing structure holding FW patch details
mFWInfo = (FWInfo *)malloc(sizeof(FWInfo));
if (mFWInfo == NULL) {
result = 0;
}
memset(mFWInfo, 0, sizeof(FWInfo));
mFwFileBin = NULL;
mCustomFileBin = NULL;
// Check if FW patch binary file is present
// If not, get recovery FW patch file
if ((mFwFileBin = fopen((char *)FwPath, "r")) == NULL) {
STLOG_HAL_D("%s - %s not detected", __func__, fwBinName);
} else {
STLOG_HAL_D("%s - %s file detected\n", __func__, fwBinName);
result |= FW_PATCH_AVAILABLE;
fread(mBinData, sizeof(uint8_t), 4, mFwFileBin);
mFWInfo->patchVersion =
mBinData[0] << 24 | mBinData[1] << 16 | mBinData[2] << 8 | mBinData[3];
fread(mApduAuthent, sizeof(uint8_t), 24, mFwFileBin);
fgetpos(mFwFileBin, &mPosInit);
STLOG_HAL_D(
"%s --> st21nfc_fw integrates patch NFC FW version 0x%08X (%s)\n",
__func__, mFWInfo->patchVersion, FwType);
}
if ((mCustomFileBin = fopen((char *)ConfPath, "r")) == NULL) {
STLOG_HAL_D("%s - st21nfc custom configuration not detected\n", __func__);
} else {
STLOG_HAL_D("%s - %s file detected\n", __func__, ConfPath);
fread(mBinData, sizeof(uint8_t), 2, mCustomFileBin);
mFWInfo->confVersion = mBinData[0] << 8 | mBinData[1];
STLOG_HAL_D("%s --> st21nfc_custom configuration version 0x%04X \n",
__func__, mFWInfo->confVersion);
result |= FW_CUSTOM_PARAM_AVAILABLE;
}
if (ft_CheckUWBConf()) {
result |= FW_UWB_PARAM_AVAILABLE;
}
return result;
}
void hal_fd_close() {
STLOG_HAL_D(" %s -enter", __func__);
mCustomParamFailed = false;
if (mFWInfo != NULL) {
free(mFWInfo);
mFWInfo = NULL;
}
if (mFwFileBin != NULL) {
fclose(mFwFileBin);
mFwFileBin = NULL;
}
if (mCustomFileBin != NULL) {
fclose(mCustomFileBin);
mCustomFileBin = NULL;
}
}
/**
* Send a HW reset and decode NCI_CORE_RESET_NTF information
* @param pHwVersion is used to return HW version, part of NCI_CORE_RESET_NTF
* @param pFwVersion is used to return FW version, part of NCI_CORE_RESET_NTF
* @param pLoaderVersion is used to return Loader version, part of
* NCI_CORE_RESET_NTF
* @param pCustVersion si used to return Customer field value, part of
* NCI_CORE_RESET_NTF when in router mode
*
* @return mode: FT_CLF_MODE_ROUTER if router mode
* FT_CLF_MODE_LOADER if loader mode
* FT_CLF_MODE_ERROR if Error
*/
uint8_t ft_cmd_HwReset(uint8_t *pdata, uint8_t *clf_mode) {
uint8_t result = 0;
STLOG_HAL_D(" %s - execution", __func__);
if ((pdata[1] == 0x0) && (pdata[3] == 0x1)) {
STLOG_HAL_D("-> Router Mode NCI_CORE_RESET_NTF received after HW Reset");
/* retrieve HW Version from NCI_CORE_RESET_NTF */
mFWInfo->hwVersion = pdata[8];
STLOG_HAL_D(" HwVersion = 0x%02X", mFWInfo->hwVersion);
/* retrieve FW Version from NCI_CORE_RESET_NTF */
mFWInfo->fwVersion =
(pdata[10] << 24) | (pdata[11] << 16) | (pdata[12] << 8) | pdata[13];
STLOG_HAL_D(" FwVersion = 0x%08X", mFWInfo->fwVersion);
/* retrieve Loader Version from NCI_CORE_RESET_NTF */
mFWInfo->loaderVersion = (pdata[14] << 16) | (pdata[15] << 8) | pdata[16];
STLOG_HAL_D(" LoaderVersion = 0x%06X", mFWInfo->loaderVersion);
/* retrieve Customer Version from NCI_CORE_RESET_NTF */
mFWInfo->custVersion = (pdata[31] << 8) | pdata[32];
STLOG_HAL_D(" CustomerVersion = 0x%04X", mFWInfo->custVersion);
/* retrieve Uwb param Version from NCI_CORE_RESET_NTF */
mFWInfo->uwbFwVersion = (pdata[29] << 8) | pdata[30];
STLOG_HAL_D(" uwbVersion = 0x%04X", mFWInfo->uwbFwVersion);
*clf_mode = FT_CLF_MODE_ROUTER;
} else if ((pdata[2] == 0x39) && (pdata[3] == 0xA1)) {
STLOG_HAL_D("-> Loader Mode NCI_CORE_RESET_NTF received after HW Reset");
/* deduce HW Version from Factory Loader version */
if (pdata[16] == 0x01) {
mFWInfo->hwVersion = 0x05; // ST54J
} else if (pdata[16] == 0x02) {
mFWInfo->hwVersion = 0x04; // ST21NFCD
} else {
mFWInfo->hwVersion = 0x03; // ST21NFCD
}
STLOG_HAL_D(" HwVersion = 0x%02X", mFWInfo->hwVersion);
/* Identify the Active loader. Normally only one should be detected*/
if (pdata[11] == 0xA0) {
mFWInfo->loaderVersion = (pdata[8] << 16) | (pdata[9] << 8) | pdata[10];
STLOG_HAL_D(" - Most recent loader activated, revision 0x%06X",
mFWInfo->loaderVersion);
}
if (pdata[15] == 0xA0) {
mFWInfo->loaderVersion = (pdata[12] << 16) | (pdata[13] << 8) | pdata[14];
STLOG_HAL_D(" - Least recent loader activated, revision 0x%06X",
mFWInfo->loaderVersion);
}
if (pdata[19] == 0xA0) {
mFWInfo->loaderVersion = (pdata[16] << 16) | (pdata[17] << 8) | pdata[18];
STLOG_HAL_D(" - Factory loader activated, revision 0x%06X",
mFWInfo->loaderVersion);
}
*clf_mode = FT_CLF_MODE_LOADER;
} else {
STLOG_HAL_E(
"%s --> ERROR: wrong NCI_CORE_RESET_NTF received after HW Reset",
__func__);
*clf_mode = FT_CLF_MODE_ERROR;
}
// Allow update only for ST54J
if (mFWInfo->hwVersion == 0x05) {
if ((mFwFileBin != NULL) && (mFWInfo->patchVersion != mFWInfo->fwVersion)) {
STLOG_HAL_D("---> Firmware update needed\n");
result |= FW_UPDATE_NEEDED;
} else {
STLOG_HAL_D("---> No Firmware update needed\n");
}
if ((mFWInfo->confVersion != 0) &&
(mFWInfo->custVersion != mFWInfo->confVersion)) {
STLOG_HAL_D(
"%s - Need to apply new st21nfc custom configuration settings\n",
__func__);
if (!mCustomParamFailed) result |= CONF_UPDATE_NEEDED;
} else {
STLOG_HAL_D("%s - No need to apply custom configuration settings\n",
__func__);
}
}
if ((mFWInfo->uwbVersion != 0) &&
(mFWInfo->uwbVersion != mFWInfo->uwbFwVersion)) {
result |= UWB_CONF_UPDATE_NEEDED;
STLOG_HAL_D("%s - Need to apply new uwb param configuration \n", __func__);
mUwbConfigNeeded = true;
}
return result;
} /* ft_cmd_HwReset */
void ExitHibernateHandler(HALHANDLE mHalHandle, uint16_t data_len,
uint8_t *p_data) {
STLOG_HAL_D("%s - Enter", __func__);
if (data_len < 3) {
STLOG_HAL_E("%s - Error, too short data (%d)", __func__, data_len);
return;
}
switch (p_data[0]) {
case 0x40: //
STLOG_HAL_D("%s - hibernate_exited = %d ", __func__,
mFWInfo->hibernate_exited);
// CORE_INIT_RSP
if ((p_data[1] == 0x1) && (p_data[3] == 0x0) &&
(mFWInfo->hibernate_exited == 0)) {
// Send PROP_NFC_MODE_SET_CMD(ON)
if (!HalSendDownstream(mHalHandle, propNfcModeSetCmdOn,
sizeof(propNfcModeSetCmdOn))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else if ((p_data[1] == 0x1) && (p_data[3] == 0x0) &&
(mFWInfo->hibernate_exited == 1)) {
STLOG_HAL_D(
"%s - send NCI_PROP_NFC_FW_UPDATE_CMD and use 100 ms timer for "
"each cmd from here",
__func__);
if (!HalSendDownstreamTimer(mHalHandle, NciPropNfcFwUpdate,
sizeof(NciPropNfcFwUpdate),
FW_TIMER_DURATION)) {
STLOG_HAL_E("%s SendDownstream failed", __func__);
}
} else if (p_data[3] != 0x00) {
STLOG_HAL_D("%s - Wrong response. Retry HW reset", __func__);
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
}
break;
case 0x4f: //
if ((p_data[1] == 0x02) && (p_data[3] == 0x00) &&
(mFWInfo->hibernate_exited == 1)) {
STLOG_HAL_D("%s - NCI_PROP_NFC_FW_RSP : loader mode", __func__);
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
} else if (p_data[3] != 0x00) {
STLOG_HAL_D("%s - Wrong response. Retry HW reset", __func__);
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
}
break;
case 0x60: //
if (p_data[3] == 0x2) {
STLOG_HAL_D("%s - CORE_RESET_NTF : after core_reset_cmd", __func__);
if (!HalSendDownstream(mHalHandle, coreInitCmd, sizeof(coreInitCmd))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else if (p_data[3] == 0xa0) {
mFWInfo->hibernate_exited = 1;
STLOG_HAL_D("%s - hibernate_exited = %d ", __func__,
mFWInfo->hibernate_exited);
if (!HalSendDownstream(mHalHandle, coreInitCmd, sizeof(coreInitCmd))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
}
break;
}
}
bool ft_CheckUWBConf() {
char uwbLibName[256];
STLOG_HAL_D("%s", __func__);
if (!GetStrValue(NAME_STNFC_UWB_LIB_NAME, (char *)uwbLibName,
sizeof(uwbLibName))) {
STLOG_HAL_D(
"%s - UWB conf library name not found in conf. use default name ", __func__);
strcpy(uwbLibName, "/vendor/lib64/libqorvo_uwb_params_nfcc.so");
}
STLOG_HAL_D("%s - UWB conf library = %s", __func__, uwbLibName);
void *stdll = dlopen(uwbLibName, RTLD_NOW);
if (stdll) {
STLoadUwbParams fn =
(STLoadUwbParams)dlsym(stdll, "load_uwb_params_from_files");
if (fn) {
size_t lengthOutput =
fn(nciPropSetUwbConfig + 9, 100);
STLOG_HAL_D("%s: lengthOutput = %zu", __func__, lengthOutput);
if (lengthOutput > 0) {
memcpy(nciPropSetUwbConfig, nciHeaderPropSetUwbConfig, 9);
nciPropSetUwbConfig[2] = lengthOutput + 6;
nciPropSetUwbConfig[8] = lengthOutput;
mFWInfo->uwbVersion =
nciPropSetUwbConfig[9] << 8 | nciPropSetUwbConfig[10];
STLOG_HAL_D("%s --> uwb configuration version 0x%04X \n", __func__,
mFWInfo->uwbVersion);
return true;
} else {
STLOG_HAL_D("%s: lengthOutput null", __func__);
}
}
} else {
STLOG_HAL_D("libqorvo_uwb_params_nfcc not found, do nothing.");
}
return false;
}
void resetHandlerState() {
STLOG_HAL_D("%s", __func__);
mHalFDState = HAL_FD_STATE_AUTHENTICATE;
}
void UpdateHandler(HALHANDLE mHalHandle, uint16_t data_len, uint8_t *p_data) {
HalSendDownstreamStopTimer(mHalHandle);
switch (mHalFDState) {
case HAL_FD_STATE_AUTHENTICATE:
STLOG_HAL_D("%s - mHalFDState = HAL_FD_STATE_AUTHENTICATE", __func__);
if ((p_data[data_len - 2] == 0x90) && (p_data[data_len - 1] == 0x00)) {
STLOG_HAL_D("%s - send APDU_AUTHENTICATION_CMD", __func__);
if (!HalSendDownstreamTimer(mHalHandle, (uint8_t *)mApduAuthent,
sizeof(mApduAuthent), FW_TIMER_DURATION)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
mHalFDState = HAL_FD_STATE_ERASE_FLASH;
} else {
STLOG_HAL_D("%s - FW flash not succeeded", __func__);
SendExitLoadMode(mHalHandle);
}
break;
case HAL_FD_STATE_ERASE_FLASH: // 1
STLOG_HAL_D("%s - mHalFDState = HAL_FD_STATE_ERASE_FLASH", __func__);
if ((p_data[0] == 0x4f) && (p_data[1] == 0x04)) {
if ((p_data[data_len - 2] == 0x90) && (p_data[data_len - 1] == 0x00)) {
STLOG_HAL_D(
" %s - send APDU_ERASE_FLASH_CMD (keep appli and NDEF areas)",
__func__);
if (!HalSendDownstreamTimer(mHalHandle, ApduEraseNfcKeepAppliAndNdef,
sizeof(ApduEraseNfcKeepAppliAndNdef),
FW_TIMER_DURATION)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
fsetpos(mFwFileBin, &mPosInit); // reset pos in stream
mHalFDState = HAL_FD_STATE_SEND_RAW_APDU;
} else {
STLOG_HAL_D("%s - FW flash not succeeded", __func__);
SendExitLoadMode(mHalHandle);
}
}
break;
case HAL_FD_STATE_SEND_RAW_APDU: // 3
STLOG_HAL_D("%s - mHalFDState = HAL_FD_STATE_SEND_RAW_APDU", __func__);
if ((p_data[0] == 0x4f) && (p_data[1] == 0x04)) {
if ((p_data[data_len - 2] == 0x90) && (p_data[data_len - 1] == 0x00)) {
mRetry = true;
fgetpos(mFwFileBin, &mPos); // save current position in stream
if ((fread(mBinData, sizeof(uint8_t), 3, mFwFileBin) == 3) &&
(fread(mBinData + 3, sizeof(uint8_t), mBinData[2], mFwFileBin) ==
mBinData[2])) {
if (!HalSendDownstreamTimer(mHalHandle, mBinData, mBinData[2] + 3,
FW_TIMER_DURATION)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else {
STLOG_HAL_D("%s - EOF of FW binary", __func__);
SendExitLoadMode(mHalHandle);
}
} else if (mRetry == true) {
STLOG_HAL_D("%s - Last Tx was NOK. Retry", __func__);
mRetry = false;
fsetpos(mFwFileBin, &mPos);
if ((fread(mBinData, sizeof(uint8_t), 3, mFwFileBin) == 3) &&
(fread(mBinData + 3, sizeof(uint8_t), mBinData[2], mFwFileBin) ==
mBinData[2])) {
if (!HalSendDownstreamTimer(mHalHandle, mBinData, mBinData[2] + 3,
FW_TIMER_DURATION)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
fgetpos(mFwFileBin, &mPos); // save current position in stream
} else {
STLOG_HAL_D("%s - EOF of FW binary", __func__);
SendExitLoadMode(mHalHandle);
}
} else {
STLOG_HAL_D("%s - FW flash not succeeded.", __func__);
I2cResetPulse();
SendExitLoadMode(mHalHandle);
}
}
break;
case HAL_FD_STATE_EXIT_APDU: // 2
STLOG_HAL_D("%s - mHalFDState = HAL_FD_STATE_EXIT_APDU", __func__);
if ((p_data[data_len - 2] != 0x90) || (p_data[data_len - 1] != 0x00)) {
STLOG_HAL_D(
"%s - Error exiting loader mode, i.e. a problem occured during FW "
"update", __func__);
}
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
mHalFDState = HAL_FD_STATE_AUTHENTICATE;
break;
default:
STLOG_HAL_D("%s - mHalFDState = unknown", __func__);
STLOG_HAL_D("%s - FW flash not succeeded", __func__);
SendExitLoadMode(mHalHandle);
break;
}
}
void ApplyCustomParamHandler(HALHANDLE mHalHandle, uint16_t data_len,
uint8_t *p_data) {
STLOG_HAL_D("%s - Enter ", __func__);
if (data_len < 3) {
STLOG_HAL_E("%s : Error, too short data (%d)", __func__, data_len);
return;
}
switch (p_data[0]) {
case 0x40: //
// CORE_RESET_RSP
if ((p_data[1] == 0x0) && (p_data[3] == 0x0)) {
// do nothing
} else if ((p_data[1] == 0x1) && (p_data[3] == 0x0)) {
if (mFWInfo->hibernate_exited == 0) {
// Send a NFC mode on .
if (!HalSendDownstream(mHalHandle, propNfcModeSetCmdOn,
sizeof(propNfcModeSetCmdOn))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
// CORE_INIT_RSP
} else if (mFWInfo->hibernate_exited == 1) {
if ((fread(mBinData, sizeof(uint8_t), 3, mCustomFileBin)) &&
(fread(mBinData + 3, sizeof(uint8_t), mBinData[2],
mCustomFileBin))) {
if (!HalSendDownstream(mHalHandle, mBinData, mBinData[2] + 3)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
}
}
} else {
STLOG_HAL_D("%s - Error in custom param application", __func__);
mCustomParamFailed = true;
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
}
break;
case 0x4f:
if (mFWInfo->hibernate_exited == 1) {
if ((fread(mBinData, sizeof(uint8_t), 3, mCustomFileBin) == 3) &&
(fread(mBinData + 3, sizeof(uint8_t), mBinData[2],
mCustomFileBin) == mBinData[2])) {
if (!HalSendDownstream(mHalHandle, mBinData, mBinData[2] + 3)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else {
STLOG_HAL_D("%s - mCustomParamDone = %d", __func__, mCustomParamDone);
if (!mGetCustomerField) {
mGetCustomerField = true;
if (!HalSendDownstream(mHalHandle, nciGetPropConfig,
sizeof(nciGetPropConfig))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
mGetCustomerField = true;
} else if (!mCustomParamDone) {
STLOG_HAL_D("%s - EOF of custom file.", __func__);
memset(nciPropSetConfig_CustomField, 0x0,
sizeof(nciPropSetConfig_CustomField));
memcpy(nciPropSetConfig_CustomField, nciSetPropConfig, 9);
nciPropSetConfig_CustomField[8] = p_data[6];
nciPropSetConfig_CustomField[2] = p_data[6] + 6;
memcpy(nciPropSetConfig_CustomField + 9, p_data + 7, p_data[6]);
nciPropSetConfig_CustomField[13] = mFWInfo->uwbFwVersion >> 8;
nciPropSetConfig_CustomField[14] = mFWInfo->uwbFwVersion;
if (!HalSendDownstream(mHalHandle, nciPropSetConfig_CustomField,
nciPropSetConfig_CustomField[2] + 3)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
mCustomParamDone = true;
} else {
I2cResetPulse();
if (mUwbConfigNeeded) {
mCustomParamDone = false;
mGetCustomerField = false;
hal_wrapper_set_state(HAL_WRAPPER_STATE_APPLY_UWB_PARAM);
}
}
}
}
// Check if an error has occurred for PROP_SET_CONFIG_CMD
// Only log a warning, do not exit code
if (p_data[3] != 0x00) {
STLOG_HAL_D("%s - Error in custom file, continue anyway", __func__);
}
break;
case 0x60: //
if (p_data[1] == 0x0) {
if (p_data[3] == 0xa0) {
mFWInfo->hibernate_exited = 1;
}
if (!HalSendDownstream(mHalHandle, coreInitCmd, sizeof(coreInitCmd))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else if ((p_data[1] == 0x6) && mCustomParamDone) {
mCustomParamDone = false;
mGetCustomerField = false;
hal_wrapper_update_complete();
}
break;
}
}
void ApplyUwbParamHandler(HALHANDLE mHalHandle, uint16_t data_len,
uint8_t *p_data) {
STLOG_HAL_D("%s - Enter ", __func__);
if (data_len < 3) {
STLOG_HAL_E("%s : Error, too short data (%d)", __func__, data_len);
return;
}
switch (p_data[0]) {
case 0x40: //
// CORE_RESET_RSP
if ((p_data[1] == 0x0) && (p_data[3] == 0x0)) {
// do nothing
} else if ((p_data[1] == 0x1) && (p_data[3] == 0x0)) {
if (mFWInfo->hibernate_exited == 0) {
// Send a NFC mode on .
if (!HalSendDownstream(mHalHandle, propNfcModeSetCmdOn,
sizeof(propNfcModeSetCmdOn))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
// CORE_INIT_RSP
} else if ((mFWInfo->hibernate_exited == 1) && !mUwbConfigDone) {
if (!HalSendDownstream(mHalHandle, nciPropSetUwbConfig,
nciPropSetUwbConfig[2] + 3)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
}
} else {
STLOG_HAL_D("%s - Error in uwb param application", __func__);
I2cResetPulse();
hal_wrapper_set_state(HAL_WRAPPER_STATE_OPEN);
}
break;
case 0x4f:
if (mFWInfo->hibernate_exited == 1) {
if (!mUwbConfigDone) {
mUwbConfigDone = true;
// Check if an error has occurred for PROP_SET_CONFIG_CMD
// Only log a warning, do not exit code
if (p_data[3] != 0x00) {
STLOG_HAL_D("%s - Error in uwb file, continue anyway", __func__);
}
if (!HalSendDownstream(mHalHandle, nciGetPropConfig,
sizeof(nciGetPropConfig))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else if ((p_data[1] == 0x2) && (p_data[2] == 0x0c)) {
memset(nciPropSetConfig_CustomField, 0x0,
sizeof(nciPropSetConfig_CustomField));
memcpy(nciPropSetConfig_CustomField, nciSetPropConfig, 9);
nciPropSetConfig_CustomField[8] = p_data[6];
nciPropSetConfig_CustomField[2] = p_data[6] + 6;
memcpy(nciPropSetConfig_CustomField + 9, p_data + 7, p_data[6]);
nciPropSetConfig_CustomField[13] = mFWInfo->uwbVersion >> 8;
nciPropSetConfig_CustomField[14] = mFWInfo->uwbVersion;
if (!HalSendDownstream(mHalHandle, nciPropSetConfig_CustomField,
nciPropSetConfig_CustomField[2] + 3)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else {
I2cResetPulse();
}
}
break;
case 0x60: //
if (p_data[1] == 0x0) {
if (p_data[3] == 0xa0) {
mFWInfo->hibernate_exited = 1;
}
if (!HalSendDownstream(mHalHandle, coreInitCmd, sizeof(coreInitCmd))) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
} else if ((p_data[1] == 0x6) && mUwbConfigDone) {
mUwbConfigNeeded = false;
mUwbConfigDone = false;
hal_wrapper_update_complete();
}
break;
}
}
void SendExitLoadMode(HALHANDLE mmHalHandle) {
STLOG_HAL_D("%s - Send APDU_EXIT_LOAD_MODE_CMD", __func__);
if (!HalSendDownstreamTimer(mmHalHandle, ApduExitLoadMode,
sizeof(ApduExitLoadMode), FW_TIMER_DURATION)) {
STLOG_HAL_E("%s - SendDownstream failed", __func__);
}
mHalFDState = HAL_FD_STATE_EXIT_APDU;
}
Reference in new issue View Git Blame Copy Permalink