/* * Copyright (c) 2015, EURECOM (www.eurecom.fr) * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * * The views and conclusions contained in the software and documentation are those * of the authors and should not be interpreted as representing official policies, * either expressed or implied, of the FreeBSD Project. */ #include <stdio.h> #include <stdlib.h> #include <stdint.h> #include "TLVEncoder.h" #include "TLVDecoder.h" #include "PlmnList.h" int decode_plmn_list(PlmnList *plmnlist, uint8_t iei, uint8_t *buffer, uint32_t len) { int decoded = 0; uint8_t ielen = 0; if (iei > 0) { CHECK_IEI_DECODER(iei, *buffer); decoded++; } ielen = *(buffer + decoded); decoded++; CHECK_LENGTH_DECODER(len - decoded, ielen); plmnlist->mccdigit2 = (*(buffer + decoded) >> 4) & 0xf; plmnlist->mccdigit1 = *(buffer + decoded) & 0xf; decoded++; plmnlist->mncdigit3 = (*(buffer + decoded) >> 4) & 0xf; plmnlist->mccdigit3 = *(buffer + decoded) & 0xf; decoded++; plmnlist->mncdigit2 = (*(buffer + decoded) >> 4) & 0xf; plmnlist->mncdigit1 = *(buffer + decoded) & 0xf; decoded++; #if defined (NAS_DEBUG) dump_plmn_list_xml(plmnlist, iei); #endif return decoded; } int encode_plmn_list(PlmnList *plmnlist, uint8_t iei, uint8_t *buffer, uint32_t len) { uint8_t *lenPtr; uint32_t encoded = 0; /* Checking IEI and pointer */ CHECK_PDU_POINTER_AND_LENGTH_ENCODER(buffer, PLMN_LIST_MINIMUM_LENGTH, len); #if defined (NAS_DEBUG) dump_plmn_list_xml(plmnlist, iei); #endif if (iei > 0) { *buffer = iei; encoded++; } lenPtr = (buffer + encoded); encoded ++; *(buffer + encoded) = 0x00 | ((plmnlist->mccdigit2 & 0xf) << 4) | (plmnlist->mccdigit1 & 0xf); encoded++; *(buffer + encoded) = 0x00 | ((plmnlist->mncdigit3 & 0xf) << 4) | (plmnlist->mccdigit3 & 0xf); encoded++; *(buffer + encoded) = 0x00 | ((plmnlist->mncdigit2 & 0xf) << 4) | (plmnlist->mncdigit1 & 0xf); encoded++; *lenPtr = encoded - 1 - ((iei > 0) ? 1 : 0); return encoded; } void dump_plmn_list_xml(PlmnList *plmnlist, uint8_t iei) { printf("<Plmn List>\n"); if (iei > 0) /* Don't display IEI if = 0 */ printf(" <IEI>0x%X</IEI>\n", iei); printf(" <MCC digit 2>%u</MCC digit 2>\n", plmnlist->mccdigit2); printf(" <MCC digit 1>%u</MCC digit 1>\n", plmnlist->mccdigit1); printf(" <MNC digit 3>%u</MNC digit 3>\n", plmnlist->mncdigit3); printf(" <MCC digit 3>%u</MCC digit 3>\n", plmnlist->mccdigit3); printf(" <MNC digit 2>%u</MNC digit 2>\n", plmnlist->mncdigit2); printf(" <MNC digit 1>%u</MNC digit 1>\n", plmnlist->mncdigit1); printf("</Plmn List>\n"); }