ranap_common.c: Add ranap_parse_lai()

This commit is contained in:
Harald Welte 2015-12-26 08:42:31 +01:00
parent 8c572fee2a
commit 37704d907d
1 changed files with 26 additions and 0 deletions

View File

@ -21,6 +21,7 @@
#include <stdint.h>
#include <osmocom/core/msgb.h>
#include <osmocom/gsm/gsm48.h>
#include "ranap_common.h"
#include "hnbgw.h"
@ -491,3 +492,28 @@ RANAP_ProtocolIE_FieldPair_t *ranap_new_ie_pair(RANAP_ProtocolIE_ID_t id,
return buff;
}
int ranap_parse_lai(struct gprs_ra_id *ra_id, const RANAP_LAI_t *lai)
{
uint8_t *ptr = lai->pLMNidentity.buf;
/* TS 25.413 9.2.3.55 */
if (lai->pLMNidentity.size != 3)
return -1;
ra_id->mcc = (ptr[0] & 0xF) * 100 +
(ptr[0] >> 4) * 10 +
(ptr[1] & 0xF);
ra_id->mnc = (ptr[2] & 0xF) +
(ptr[2] >> 4) * 10;
if ((ptr[1] >> 4) != 0xF)
ra_id->mnc += (ptr[1] >> 4) * 100;
ra_id->lac = asn1str_to_u16(&lai->lAC);
/* TS 25.413 9.2.3.6 */
if (ra_id->lac == 0 || ra_id->lac == 0xfffe)
return -1;
return 0;
}