/**
 *
 * \section COPYRIGHT
 *
 * Copyright 2013-2015 Software Radio Systems Limited
 *
 * \section LICENSE
 *
 * This file is part of the srsUE library.
 *
 * srsUE is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Affero General Public License as
 * published by the Free Software Foundation, either version 3 of
 * the License, or (at your option) any later version.
 *
 * srsUE is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU Affero General Public License for more details.
 *
 * A copy of the GNU Affero General Public License can be found in
 * the LICENSE file in the top-level directory of this distribution
 * and at http://www.gnu.org/licenses/.
 *
 */

#ifndef BCD_HELPERS
#define BCD_HELPERS

#include <ctype.h>
#include <stdint.h>
#include <string>

namespace srslte {

/******************************************************************************
 * Convert between string and BCD-coded MCC.
 * Digits are represented by 4-bit nibbles. Unused nibbles are filled with 0xF.
 * MCC 001 results in 0xF001
 *****************************************************************************/
inline bool string_to_mcc(std::string str, uint16_t *mcc)
{
  uint32_t len = str.size();
  if(len != 3) {
    return false;
  }
  if(!isdigit(str[0]) || !isdigit(str[1]) || !isdigit(str[2])) {
    return false;
  }
  *mcc = 0xF000;
  *mcc |= ((uint8_t)(str[0]-'0') << 8);
  *mcc |= ((uint8_t)(str[1]-'0') << 4);
  *mcc |= ((uint8_t)(str[2]-'0'));
  return true;
}

inline bool mcc_to_string(uint16_t mcc, std::string *str)
{
  if((mcc & 0xF000) != 0xF000) {
    return false;
  }
  *str = "";
  *str += ((mcc & 0x0F00) >> 8) + '0';
  *str += ((mcc & 0x00F0) >> 4) + '0';
  *str += (mcc & 0x000F) + '0';
  return true;
}

/******************************************************************************
 * Convert between string and BCD-coded MNC.
 * Digits are represented by 4-bit nibbles. Unused nibbles are filled with 0xF.
 * MNC 001 results in 0xF001
 * MNC 01 results in 0xFF01
 *****************************************************************************/
inline bool string_to_mnc(std::string str, uint16_t *mnc)
{
  uint32_t len = str.size();
  if(len != 3 && len != 2) {
    return false;
  }
  if(len == 3) {
    if(!isdigit(str[0]) || !isdigit(str[1]) || !isdigit(str[2])) {
      return false;
    }
    *mnc = 0xF000;
    *mnc |= ((uint8_t)(str[0]-'0') << 8);
    *mnc |= ((uint8_t)(str[1]-'0') << 4);
    *mnc |= ((uint8_t)(str[2]-'0'));
  }
  if(len == 2) {
    if(!isdigit(str[0]) || !isdigit(str[1])) {
      return false;
    }
    *mnc = 0xFF00;
    *mnc |= ((uint8_t)(str[0]-'0') << 4);
    *mnc |= ((uint8_t)(str[1]-'0'));
  }

  return true;
}

inline bool mnc_to_string(uint16_t mnc, std::string *str)
{
  if((mnc & 0xF000) != 0xF000) {
    return false;
  }
  *str = "";
  if((mnc & 0xFF00) != 0xFF00) {
    *str += ((mnc & 0x0F00) >> 8) + '0';
  }
  *str += ((mnc & 0x00F0) >> 4) + '0';
  *str += (mnc & 0x000F) + '0';
  return true;
}

} // namespace srslte

#endif // BCD_HELPERS