git-svn-id: http://svn.eurecom.fr/openair4G/trunk@7886 818b1a75-f10b-46b9-bf7c-635c3b92a50f
196 lines
7.9 KiB
C
196 lines
7.9 KiB
C
/*
|
|
* 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 <string.h>
|
|
#include <stdint.h>
|
|
|
|
|
|
#include "TLVEncoder.h"
|
|
#include "TLVDecoder.h"
|
|
#include "EmmInformation.h"
|
|
|
|
int decode_emm_information(emm_information_msg *emm_information, uint8_t *buffer, uint32_t len)
|
|
{
|
|
uint32_t decoded = 0;
|
|
int decoded_result = 0;
|
|
|
|
// Check if we got a NULL pointer and if buffer length is >= minimum length expected for the message.
|
|
CHECK_PDU_POINTER_AND_LENGTH_DECODER(buffer, EMM_INFORMATION_MINIMUM_LENGTH, len);
|
|
|
|
/* Decoding mandatory fields */
|
|
/* Decoding optional fields */
|
|
while(len - decoded > 0) {
|
|
uint8_t ieiDecoded = *(buffer + decoded);
|
|
|
|
/* Type | value iei are below 0x80 so just return the first 4 bits */
|
|
if (ieiDecoded >= 0x80)
|
|
ieiDecoded = ieiDecoded & 0xf0;
|
|
|
|
switch(ieiDecoded) {
|
|
case EMM_INFORMATION_FULL_NAME_FOR_NETWORK_IEI:
|
|
if ((decoded_result =
|
|
decode_network_name(&emm_information->fullnamefornetwork,
|
|
EMM_INFORMATION_FULL_NAME_FOR_NETWORK_IEI, buffer +
|
|
decoded, len - decoded)) <= 0)
|
|
return decoded_result;
|
|
|
|
decoded += decoded_result;
|
|
/* Set corresponding mask to 1 in presencemask */
|
|
emm_information->presencemask |= EMM_INFORMATION_FULL_NAME_FOR_NETWORK_PRESENT;
|
|
break;
|
|
|
|
case EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_IEI:
|
|
if ((decoded_result =
|
|
decode_network_name(&emm_information->shortnamefornetwork,
|
|
EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_IEI, buffer +
|
|
decoded, len - decoded)) <= 0)
|
|
return decoded_result;
|
|
|
|
decoded += decoded_result;
|
|
/* Set corresponding mask to 1 in presencemask */
|
|
emm_information->presencemask |= EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_PRESENT;
|
|
break;
|
|
|
|
case EMM_INFORMATION_LOCAL_TIME_ZONE_IEI:
|
|
if ((decoded_result =
|
|
decode_time_zone(&emm_information->localtimezone,
|
|
EMM_INFORMATION_LOCAL_TIME_ZONE_IEI, buffer + decoded, len
|
|
- decoded)) <= 0)
|
|
return decoded_result;
|
|
|
|
decoded += decoded_result;
|
|
/* Set corresponding mask to 1 in presencemask */
|
|
emm_information->presencemask |= EMM_INFORMATION_LOCAL_TIME_ZONE_PRESENT;
|
|
break;
|
|
|
|
case EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_IEI:
|
|
if ((decoded_result =
|
|
decode_time_zone_and_time(&emm_information->universaltimeandlocaltimezone,
|
|
EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_IEI,
|
|
buffer + decoded, len - decoded)) <= 0)
|
|
return decoded_result;
|
|
|
|
decoded += decoded_result;
|
|
/* Set corresponding mask to 1 in presencemask */
|
|
emm_information->presencemask |= EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_PRESENT;
|
|
break;
|
|
|
|
case EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_IEI:
|
|
if ((decoded_result =
|
|
decode_daylight_saving_time(&emm_information->networkdaylightsavingtime,
|
|
EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_IEI, buffer +
|
|
decoded, len - decoded)) <= 0)
|
|
return decoded_result;
|
|
|
|
decoded += decoded_result;
|
|
/* Set corresponding mask to 1 in presencemask */
|
|
emm_information->presencemask |= EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_PRESENT;
|
|
break;
|
|
|
|
default:
|
|
errorCodeDecoder = TLV_DECODE_UNEXPECTED_IEI;
|
|
return TLV_DECODE_UNEXPECTED_IEI;
|
|
}
|
|
}
|
|
|
|
return decoded;
|
|
}
|
|
|
|
int encode_emm_information(emm_information_msg *emm_information, uint8_t *buffer, uint32_t len)
|
|
{
|
|
int encoded = 0;
|
|
int encode_result = 0;
|
|
|
|
/* Checking IEI and pointer */
|
|
CHECK_PDU_POINTER_AND_LENGTH_ENCODER(buffer, EMM_INFORMATION_MINIMUM_LENGTH, len);
|
|
|
|
if ((emm_information->presencemask & EMM_INFORMATION_FULL_NAME_FOR_NETWORK_PRESENT)
|
|
== EMM_INFORMATION_FULL_NAME_FOR_NETWORK_PRESENT) {
|
|
if ((encode_result =
|
|
encode_network_name(&emm_information->fullnamefornetwork,
|
|
EMM_INFORMATION_FULL_NAME_FOR_NETWORK_IEI, buffer + encoded, len -
|
|
encoded)) < 0)
|
|
// Return in case of error
|
|
return encode_result;
|
|
else
|
|
encoded += encode_result;
|
|
}
|
|
|
|
if ((emm_information->presencemask & EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_PRESENT)
|
|
== EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_PRESENT) {
|
|
if ((encode_result =
|
|
encode_network_name(&emm_information->shortnamefornetwork,
|
|
EMM_INFORMATION_SHORT_NAME_FOR_NETWORK_IEI, buffer + encoded, len
|
|
- encoded)) < 0)
|
|
// Return in case of error
|
|
return encode_result;
|
|
else
|
|
encoded += encode_result;
|
|
}
|
|
|
|
if ((emm_information->presencemask & EMM_INFORMATION_LOCAL_TIME_ZONE_PRESENT)
|
|
== EMM_INFORMATION_LOCAL_TIME_ZONE_PRESENT) {
|
|
if ((encode_result = encode_time_zone(&emm_information->localtimezone,
|
|
EMM_INFORMATION_LOCAL_TIME_ZONE_IEI, buffer + encoded, len -
|
|
encoded)) < 0)
|
|
// Return in case of error
|
|
return encode_result;
|
|
else
|
|
encoded += encode_result;
|
|
}
|
|
|
|
if ((emm_information->presencemask & EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_PRESENT)
|
|
== EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_PRESENT) {
|
|
if ((encode_result =
|
|
encode_time_zone_and_time(&emm_information->universaltimeandlocaltimezone,
|
|
EMM_INFORMATION_UNIVERSAL_TIME_AND_LOCAL_TIME_ZONE_IEI, buffer +
|
|
encoded, len - encoded)) < 0)
|
|
// Return in case of error
|
|
return encode_result;
|
|
else
|
|
encoded += encode_result;
|
|
}
|
|
|
|
if ((emm_information->presencemask & EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_PRESENT)
|
|
== EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_PRESENT) {
|
|
if ((encode_result =
|
|
encode_daylight_saving_time(&emm_information->networkdaylightsavingtime,
|
|
EMM_INFORMATION_NETWORK_DAYLIGHT_SAVING_TIME_IEI, buffer +
|
|
encoded, len - encoded)) < 0)
|
|
// Return in case of error
|
|
return encode_result;
|
|
else
|
|
encoded += encode_result;
|
|
}
|
|
|
|
return encoded;
|
|
}
|
|
|