UeSecurityCapability.c 2.77 KB
Newer Older
Cedric Roux's avatar
 
Cedric Roux committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>


#include "TLVEncoder.h"
#include "TLVDecoder.h"
#include "UeSecurityCapability.h"

int decode_ue_security_capability(UeSecurityCapability *uesecuritycapability, 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);
    uesecuritycapability->eea = *(buffer + decoded);
    decoded++;
    uesecuritycapability->eia = *(buffer + decoded);
    decoded++;
26 27 28 29 30 31 32 33 34
    if (len == decoded + 3) {
        uesecuritycapability->non_eps_security_present = 1;
        uesecuritycapability->uea = *(buffer + decoded);
        decoded++;
        uesecuritycapability->uia = *(buffer + decoded) & 0x7f;
        decoded++;
        uesecuritycapability->gea = *(buffer + decoded) & 0x7f;
        decoded++;
    }
Cedric Roux's avatar
 
Cedric Roux committed
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#if defined (NAS_DEBUG)
    dump_ue_security_capability_xml(uesecuritycapability, iei);
#endif
    return decoded;
}
int encode_ue_security_capability(UeSecurityCapability *uesecuritycapability, 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, UE_SECURITY_CAPABILITY_MINIMUM_LENGTH, len);
#if defined (NAS_DEBUG)
    dump_ue_security_capability_xml(uesecuritycapability, iei);
#endif
    if (iei > 0)
    {
        *buffer = iei;
        encoded++;
    }
    lenPtr  = (buffer + encoded);
    encoded ++;
    *(buffer + encoded) = uesecuritycapability->eea;
    encoded++;
    *(buffer + encoded) =  uesecuritycapability->eia;
    encoded++;
60 61 62 63 64 65 66 67 68 69
    if (uesecuritycapability->non_eps_security_present == 1) {
        *(buffer + encoded) = uesecuritycapability->uea;
        encoded++;
        *(buffer + encoded) = 0x00 |
        (uesecuritycapability->uia & 0x7f);
        encoded++;
        *(buffer + encoded) = 0x00 |
        (uesecuritycapability->gea & 0x7f);
        encoded++;
    }
Cedric Roux's avatar
 
Cedric Roux committed
70 71 72 73 74 75 76 77 78 79 80 81
    *lenPtr = encoded - 1 - ((iei > 0) ? 1 : 0);
    return encoded;
}

void dump_ue_security_capability_xml(UeSecurityCapability *uesecuritycapability, uint8_t iei)
{
    printf("<Ue Security Capability>\n");
    if (iei > 0)
        /* Don't display IEI if = 0 */
        printf("    <IEI>0x%X</IEI>\n", iei);
    printf("    <EEA>%u</EEA>\n", uesecuritycapability->eea);
    printf("    <EIA>%u</EIA>\n", uesecuritycapability->eia);
82 83 84 85 86
    if (uesecuritycapability->non_eps_security_present == 1) {
        printf("    <UEA>%u</UEA>\n", uesecuritycapability->uea);
        printf("    <UIA>%u</UIA>\n", uesecuritycapability->uia);
        printf("    <GEA>%u</GEA>\n", uesecuritycapability->gea);
    }
Cedric Roux's avatar
 
Cedric Roux committed
87 88 89
    printf("</Ue Security Capability>\n");
}