/******************************************************************************
 *
 *  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 %u 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;
}