139 lines
4.9 KiB
C++
139 lines
4.9 KiB
C++
/******************************************************************************
|
|
*
|
|
* Copyright (C) 1999-2012 Broadcom Corporation
|
|
*
|
|
* 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.
|
|
*
|
|
******************************************************************************/
|
|
|
|
/******************************************************************************
|
|
* Construct a buffer that contains multiple Type-Length-Value contents
|
|
* that is used by the HAL in a CORE_SET_CONFIG NCI command.
|
|
******************************************************************************/
|
|
|
|
#define LOG_TAG "NfcNciHal"
|
|
#include "StartupConfig.h"
|
|
#include "_OverrideLog.h"
|
|
|
|
const uint8_t StartupConfig::mMaxLength = 255;
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: initialize
|
|
**
|
|
** Description: Initialize all member variables.
|
|
**
|
|
** Returns: None
|
|
**
|
|
*******************************************************************************/
|
|
StartupConfig::StartupConfig() {
|
|
// set first byte to 0, which is length of payload
|
|
mBuffer.append((uint8_string::size_type)1, (uint8_string::value_type)0);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: initialize
|
|
**
|
|
** Description: Reset all member variables.
|
|
**
|
|
** Returns: None
|
|
**
|
|
*******************************************************************************/
|
|
void StartupConfig::initialize() {
|
|
mBuffer.clear();
|
|
// set first byte to 0, which is length of payload
|
|
mBuffer.append((uint8_string::size_type)1, (uint8_string::value_type)0);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: getInternalBuffer
|
|
**
|
|
** Description: Get the pointer to buffer that contains multiple
|
|
** Type-Length-Value contents.
|
|
**
|
|
** Returns: Pointer to buffer.
|
|
**
|
|
*******************************************************************************/
|
|
const uint8_t* StartupConfig::getInternalBuffer() { return mBuffer.data(); }
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: append
|
|
**
|
|
** Description: Append new config data to internal buffer.
|
|
** newContent: buffer containing new content; newContent[0] is
|
|
** payload length; newContent[1..end] is payload.
|
|
** newContentLen: total length of newContent.
|
|
**
|
|
** Returns: True if ok.
|
|
**
|
|
*******************************************************************************/
|
|
bool StartupConfig::append(const uint8_t* newContent, uint8_t newContentLen) {
|
|
static const char fn[] = "StartupConfig::append";
|
|
if ((newContentLen + mBuffer.size()) > mMaxLength) {
|
|
ALOGE("%s: exceed max length", fn);
|
|
return false;
|
|
}
|
|
|
|
ALOGD("%s: try append %zu bytes", fn,
|
|
(uint8_string::size_type)(newContentLen));
|
|
// append new payload into private buffer
|
|
mBuffer.append(newContent + 1, (uint8_string::size_type)(newContentLen - 1));
|
|
// increase size counter of payload in private buffer
|
|
mBuffer[0] = mBuffer[0] + newContentLen - 1;
|
|
ALOGD("%s: new size %u bytes", fn, mBuffer[0]);
|
|
return true;
|
|
};
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function: disableSecureElement
|
|
**
|
|
** Description: Adjust a TLV to disable secure element(s). The TLV's type
|
|
*is 0xC2.
|
|
** bitmask: 0xC0 = do not detect any secure element.
|
|
** 0x40 = do not detect secure element in slot 0.
|
|
** 0x80 = do not detect secure element in slot 1.
|
|
**
|
|
** Returns: True if ok.
|
|
**
|
|
*******************************************************************************/
|
|
bool StartupConfig::disableSecureElement(uint8_t bitmask) {
|
|
const uint8_t maxLen = mBuffer[0];
|
|
uint8_t index = 1, tlvType = 0, tlvLen = 0;
|
|
bool found0xC2 = false;
|
|
|
|
while (true) {
|
|
if (index > maxLen) break;
|
|
tlvType = mBuffer[index];
|
|
index++;
|
|
tlvLen = mBuffer[index];
|
|
index++;
|
|
if (tlvType == 0xC2) // this TLV controls secure elements
|
|
{
|
|
index++; // index of second byte in TLV's value
|
|
mBuffer[index] = mBuffer[index] | bitmask; // turn on certain bits
|
|
found0xC2 = true;
|
|
} else
|
|
index += tlvLen;
|
|
}
|
|
|
|
if (found0xC2 == false) {
|
|
uint8_t tlv[] = {0x04, 0xC2, 0x02, 0x61, 0x00};
|
|
tlv[4] = tlv[4] | bitmask;
|
|
found0xC2 = append(tlv, 5);
|
|
}
|
|
return found0xC2;
|
|
}
|