mirror of https://github.com/pvnis/srsRAN_4G.git
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
126 lines
3.4 KiB
C++
126 lines
3.4 KiB
C++
/**
|
|
*
|
|
* \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>
|
|
#include <srslte/asn1/liblte_rrc.h>
|
|
|
|
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;
|
|
}
|
|
inline std::string plmn_id_to_string(LIBLTE_RRC_PLMN_IDENTITY_STRUCT plmn_id) {
|
|
std::string mcc_str, mnc_str;
|
|
mnc_to_string(plmn_id.mnc, &mnc_str);
|
|
mcc_to_string(plmn_id.mcc, &mcc_str);
|
|
return mcc_str + mnc_str;
|
|
}
|
|
|
|
} // namespace srslte
|
|
|
|
#endif // BCD_HELPERS
|