cellular-infrastructure
/
osmo-iuh
mirror of https://gerrit.osmocom.org/osmo-iuh
9
0
Fork 0
Code Issues Releases Wiki Activity
osmo-iuh/src/hnbgw_ranap.c

701 lines
25 KiB
C
Raw Blame History

/* hnb-gw specific code for RANAP */
/* (C) 2015 by Harald Welte <laforge@gnumonks.org>
* All Rights Reserved
*
* This program 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.
*
* This program 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.
*
* You should have received a copy of the GNU Affero General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
*/
#include <osmocom/core/msgb.h>
#include <osmocom/core/utils.h>
#include <osmocom/gsm/gsm48.h>
#include <unistd.h>
#include <errno.h>
#include <string.h>
#include "asn1helpers.h"
#include "hnbgw.h"
#include "hnbgw_rua.h"
//#include "ranap_common.h"
#include "ranap/RANAP_RANAP-PDU.h"
#include "ranap/RANAP_ResetAcknowledge.h"
#include "ranap/RANAP_Reset.h"
#include "ranap/RANAP_ProtocolIE-ID.h"
#include "ranap/RANAP_Cause.h"
#include "ranap/RANAP_CN-DomainIndicator.h"
#include "ranap/RANAP_GlobalRNC-ID.h"
#include "ranap/RANAP_CriticalityDiagnostics.h"
/***********************************************************************
* BEGIN auto-generated copy+pasted
***********************************************************************/
/* this is copy+pasted from the asn1tostruct generated code that doesn't
* compile as a whole */
#define RANAP_DEBUG(x, args ...) DEBUGP(0, x, ## args)
extern int asn1_xer_print;
struct msgb *ranap_generate_successful_outcome(
e_RANAP_ProcedureCode procedureCode,
RANAP_Criticality_t criticality,
asn_TYPE_descriptor_t * td,
void *sptr);
RANAP_IE_t *ranap_new_ie(RANAP_ProtocolIE_ID_t id, RANAP_Criticality_t criticality,
asn_TYPE_descriptor_t *type, void *sptr);
#define RESETIES_RANAP_GLOBALRNC_ID_PRESENT (1 << 0)
typedef struct RANAP_ResetIEs_s {
uint16_t presenceMask;
RANAP_Cause_t cause;
RANAP_CN_DomainIndicator_t cN_DomainIndicator;
RANAP_GlobalRNC_ID_t globalRNC_ID; ///< Optional field
} RANAP_ResetIEs_t;
#define RESETACKNOWLEDGEIES_RANAP_CRITICALITYDIAGNOSTICS_PRESENT (1 << 0)
#define RESETACKNOWLEDGEIES_RANAP_GLOBALRNC_ID_PRESENT (1 << 1)
typedef struct RANAP_ResetAcknowledgeIEs_s {
uint16_t presenceMask;
RANAP_CN_DomainIndicator_t cN_DomainIndicator;
RANAP_CriticalityDiagnostics_t criticalityDiagnostics; ///< Optional field
RANAP_GlobalRNC_ID_t globalRNC_ID; ///< Optional field
} RANAP_ResetAcknowledgeIEs_t;
int ranap_decode_reseties(
RANAP_ResetIEs_t *resetIEs,
ANY_t *any_p) {
RANAP_Reset_t reset;
RANAP_Reset_t *reset_p = &reset;
int i, decoded = 0;
int tempDecoded = 0;
assert(any_p != NULL);
assert(resetIEs != NULL);
RANAP_DEBUG("Decoding message RANAP_ResetIEs (%s:%d)\n", __FILE__, __LINE__);
ANY_to_type_aper(any_p, &asn_DEF_RANAP_Reset, (void**)&reset_p);
for (i = 0; i < reset_p->reset_ies.list.count; i++) {
RANAP_IE_t *ie_p;
ie_p = reset_p->reset_ies.list.array[i];
switch(ie_p->id) {
case RANAP_ProtocolIE_ID_id_Cause:
{
RANAP_Cause_t ranaP_Cause;
RANAP_Cause_t *ranaP_Cause_p = &ranaP_Cause;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_Cause, (void**)&ranaP_Cause_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE cause failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_Cause, ranaP_Cause_p);
memcpy(&resetIEs->cause, ranaP_Cause_p, sizeof(RANAP_Cause_t));
} break;
case RANAP_ProtocolIE_ID_id_CN_DomainIndicator:
{
RANAP_CN_DomainIndicator_t ranaP_CNDomainIndicator;
RANAP_CN_DomainIndicator_t *ranaP_CNDomainIndicator_p = &ranaP_CNDomainIndicator;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_CN_DomainIndicator, (void**)&ranaP_CNDomainIndicator_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE cN_DomainIndicator failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_CN_DomainIndicator, ranaP_CNDomainIndicator_p);
memcpy(&resetIEs->cN_DomainIndicator, ranaP_CNDomainIndicator_p, sizeof(RANAP_CN_DomainIndicator_t));
} break;
/* Optional field */
case RANAP_ProtocolIE_ID_id_GlobalRNC_ID:
{
#if 0
RANAP_GlobalRNC_ID_t ranaP_GlobalRNCID;
RANAP_GlobalRNC_ID_t *ranaP_GlobalRNCID_p = &ranaP_GlobalRNCID;
resetIEs->presenceMask |= RESETIES_RANAP_GLOBALRNC_ID_PRESENT;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_GlobalRNC_ID, (void**)&ranaP_GlobalRNCID_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE globalRNC_ID failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_GlobalRNC_ID, ranaP_GlobalRNCID_p);
memcpy(&resetIEs->globalRNC_ID, ranaP_GlobalRNCID_p, sizeof(RANAP_GlobalRNC_ID_t));
#endif
} break;
default:
RANAP_DEBUG("Unknown protocol IE id (%d) for message reseties\n", (int)ie_p->id);
return -1;
}
}
return decoded;
}
int ranap_encode_resetacknowledgeies(
RANAP_ResetAcknowledge_t *resetAcknowledge,
RANAP_ResetAcknowledgeIEs_t *resetAcknowledgeIEs) {
RANAP_IE_t *ie;
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_CN_DomainIndicator,
RANAP_Criticality_reject,
&asn_DEF_RANAP_CN_DomainIndicator,
&resetAcknowledgeIEs->cN_DomainIndicator)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&resetAcknowledge->resetAcknowledge_ies.list, ie);
/* Optional field */
if ((resetAcknowledgeIEs->presenceMask & RESETACKNOWLEDGEIES_RANAP_CRITICALITYDIAGNOSTICS_PRESENT)
== RESETACKNOWLEDGEIES_RANAP_CRITICALITYDIAGNOSTICS_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_CriticalityDiagnostics,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_CriticalityDiagnostics,
&resetAcknowledgeIEs->criticalityDiagnostics)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&resetAcknowledge->resetAcknowledge_ies.list, ie);
}
/* Optional field */
if ((resetAcknowledgeIEs->presenceMask & RESETACKNOWLEDGEIES_RANAP_GLOBALRNC_ID_PRESENT)
== RESETACKNOWLEDGEIES_RANAP_GLOBALRNC_ID_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_GlobalRNC_ID,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_GlobalRNC_ID,
&resetAcknowledgeIEs->globalRNC_ID)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&resetAcknowledge->resetAcknowledge_ies.list, ie);
}
return 0;
}
#include "ranap/RANAP_InitialUE-Message.h"
#include "ranap/RANAP_CN-DomainIndicator.h"
#include "ranap/RANAP_LAI.h"
#include "ranap/RANAP_SAI.h"
#include "ranap/RANAP_NAS-PDU.h"
#include "ranap/RANAP_IuSignallingConnectionIdentifier.h"
#include "ranap/RANAP_GlobalCN-ID.h"
typedef struct RANAP_InitialUE_MessageIEs_s {
RANAP_CN_DomainIndicator_t cN_DomainIndicator;
RANAP_LAI_t lai;
RANAP_SAI_t sai;
RANAP_NAS_PDU_t nas_pdu;
RANAP_IuSignallingConnectionIdentifier_t iuSigConId;
RANAP_GlobalRNC_ID_t globalRNC_ID;
} RANAP_InitialUE_MessageIEs_t;
int ranap_decode_initialue_messageies(
RANAP_InitialUE_MessageIEs_t *initialUE_MessageIEs,
ANY_t *any_p) {
RANAP_InitialUE_Message_t initialUE_Message;
RANAP_InitialUE_Message_t *initialUE_Message_p = &initialUE_Message;
int i, decoded = 0;
int tempDecoded = 0;
assert(any_p != NULL);
assert(initialUE_MessageIEs != NULL);
RANAP_DEBUG("Decoding message RANAP_InitialUE_MessageIEs (%s:%d)\n", __FILE__, __LINE__);
ANY_to_type_aper(any_p, &asn_DEF_RANAP_InitialUE_Message, (void**)&initialUE_Message_p);
for (i = 0; i < initialUE_Message_p->initialUE_Message_ies.list.count; i++) {
RANAP_IE_t *ie_p;
ie_p = initialUE_Message_p->initialUE_Message_ies.list.array[i];
switch(ie_p->id) {
case RANAP_ProtocolIE_ID_id_CN_DomainIndicator:
{
RANAP_CN_DomainIndicator_t ranaP_CNDomainIndicator;
RANAP_CN_DomainIndicator_t *ranaP_CNDomainIndicator_p = &ranaP_CNDomainIndicator;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_CN_DomainIndicator, (void**)&ranaP_CNDomainIndicator_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE cN_DomainIndicator failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_CN_DomainIndicator, ranaP_CNDomainIndicator_p);
memcpy(&initialUE_MessageIEs->cN_DomainIndicator, ranaP_CNDomainIndicator_p, sizeof(RANAP_CN_DomainIndicator_t));
} break;
case RANAP_ProtocolIE_ID_id_LAI:
{
RANAP_LAI_t ranap_lai;
RANAP_LAI_t *ranap_lai_p = &ranap_lai;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_LAI, (void**)&ranap_lai_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE lai failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_LAI, ranap_lai_p);
memcpy(&initialUE_MessageIEs->lai, ranap_lai_p, sizeof(RANAP_LAI_t));
} break;
case RANAP_ProtocolIE_ID_id_SAI:
{
RANAP_SAI_t ranap_sai;
RANAP_SAI_t *ranap_sai_p = &ranap_sai;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_SAI, (void**)&ranap_sai_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE sai failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_SAI, ranap_sai_p);
memcpy(&initialUE_MessageIEs->sai, ranap_sai_p, sizeof(RANAP_SAI_t));
} break;
case RANAP_ProtocolIE_ID_id_NAS_PDU:
{
RANAP_NAS_PDU_t ranap_naspdu;
RANAP_NAS_PDU_t *ranap_naspdu_p = &ranap_naspdu;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_NAS_PDU, (void**)&ranap_naspdu_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE nas_pdu failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_NAS_PDU, ranap_naspdu_p);
memcpy(&initialUE_MessageIEs->nas_pdu, ranap_naspdu_p, sizeof(RANAP_NAS_PDU_t));
} break;
case RANAP_ProtocolIE_ID_id_IuSigConId:
{
RANAP_IuSignallingConnectionIdentifier_t ranaP_IuSignallingConnectionIdentifier;
RANAP_IuSignallingConnectionIdentifier_t *ranaP_IuSignallingConnectionIdentifier_p = &ranaP_IuSignallingConnectionIdentifier;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_IuSignallingConnectionIdentifier, (void**)&ranaP_IuSignallingConnectionIdentifier_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE iuSigConId failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_IuSignallingConnectionIdentifier, ranaP_IuSignallingConnectionIdentifier_p);
memcpy(&initialUE_MessageIEs->iuSigConId, ranaP_IuSignallingConnectionIdentifier_p, sizeof(RANAP_IuSignallingConnectionIdentifier_t));
} break;
case RANAP_ProtocolIE_ID_id_GlobalRNC_ID:
{
RANAP_GlobalRNC_ID_t ranaP_GlobalRNCID;
RANAP_GlobalRNC_ID_t *ranaP_GlobalRNCID_p = &ranaP_GlobalRNCID;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_GlobalRNC_ID, (void**)&ranaP_GlobalRNCID_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE globalRNC_ID failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_GlobalRNC_ID, ranaP_GlobalRNCID_p);
memcpy(&initialUE_MessageIEs->globalRNC_ID, ranaP_GlobalRNCID_p, sizeof(RANAP_GlobalRNC_ID_t));
} break;
default:
RANAP_DEBUG("Unknown protocol IE id (%d) for message initialue_messageies\n", (int)ie_p->id);
return -1;
}
}
return decoded;
}
#include "ranap/RANAP_DirectTransfer.h"
#include "ranap/RANAP_SAPI.h"
#include "ranap/RANAP_RAC.h"
#define DIRECTTRANSFERIES_RANAP_LAI_PRESENT (1 << 0)
#define DIRECTTRANSFERIES_RANAP_RAC_PRESENT (1 << 1)
#define DIRECTTRANSFERIES_RANAP_SAI_PRESENT (1 << 2)
#define DIRECTTRANSFERIES_RANAP_SAPI_PRESENT (1 << 3)
typedef struct RANAP_DirectTransferIEs_s {
uint16_t presenceMask;
RANAP_NAS_PDU_t nas_pdu;
RANAP_LAI_t lai; ///< Optional field
RANAP_RAC_t rac; ///< Optional field
RANAP_SAI_t sai; ///< Optional field
RANAP_SAPI_t sapi; ///< Optional field
} RANAP_DirectTransferIEs_t;
int ranap_decode_directtransferies(
RANAP_DirectTransferIEs_t *directTransferIEs,
ANY_t *any_p) {
RANAP_DirectTransfer_t directTransfer;
RANAP_DirectTransfer_t *directTransfer_p = &directTransfer;
int i, decoded = 0;
int tempDecoded = 0;
assert(any_p != NULL);
assert(directTransferIEs != NULL);
RANAP_DEBUG("Decoding message RANAP_DirectTransferIEs (%s:%d)\n", __FILE__, __LINE__);
ANY_to_type_aper(any_p, &asn_DEF_RANAP_DirectTransfer, (void**)&directTransfer_p);
for (i = 0; i < directTransfer_p->directTransfer_ies.list.count; i++) {
RANAP_IE_t *ie_p;
ie_p = directTransfer_p->directTransfer_ies.list.array[i];
switch(ie_p->id) {
case RANAP_ProtocolIE_ID_id_NAS_PDU:
{
RANAP_NAS_PDU_t ranap_naspdu;
RANAP_NAS_PDU_t *ranap_naspdu_p = &ranap_naspdu;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_NAS_PDU, (void**)&ranap_naspdu_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE nas_pdu failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_NAS_PDU, ranap_naspdu_p);
memcpy(&directTransferIEs->nas_pdu, ranap_naspdu_p, sizeof(RANAP_NAS_PDU_t));
} break;
/* Optional field */
case RANAP_ProtocolIE_ID_id_LAI:
{
RANAP_LAI_t ranap_lai;
RANAP_LAI_t *ranap_lai_p = &ranap_lai;
directTransferIEs->presenceMask |= DIRECTTRANSFERIES_RANAP_LAI_PRESENT;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_LAI, (void**)&ranap_lai_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE lai failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_LAI, ranap_lai_p);
memcpy(&directTransferIEs->lai, ranap_lai_p, sizeof(RANAP_LAI_t));
} break;
/* Optional field */
case RANAP_ProtocolIE_ID_id_RAC:
{
RANAP_RAC_t ranap_rac;
RANAP_RAC_t *ranap_rac_p = &ranap_rac;
directTransferIEs->presenceMask |= DIRECTTRANSFERIES_RANAP_RAC_PRESENT;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_RAC, (void**)&ranap_rac_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE rac failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_RAC, ranap_rac_p);
memcpy(&directTransferIEs->rac, ranap_rac_p, sizeof(RANAP_RAC_t));
} break;
/* Optional field */
case RANAP_ProtocolIE_ID_id_SAI:
{
RANAP_SAI_t ranap_sai;
RANAP_SAI_t *ranap_sai_p = &ranap_sai;
directTransferIEs->presenceMask |= DIRECTTRANSFERIES_RANAP_SAI_PRESENT;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_SAI, (void**)&ranap_sai_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE sai failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_SAI, ranap_sai_p);
memcpy(&directTransferIEs->sai, ranap_sai_p, sizeof(RANAP_SAI_t));
} break;
/* Optional field */
case RANAP_ProtocolIE_ID_id_SAPI:
{
RANAP_SAPI_t ranap_sapi;
RANAP_SAPI_t *ranap_sapi_p = &ranap_sapi;
directTransferIEs->presenceMask |= DIRECTTRANSFERIES_RANAP_SAPI_PRESENT;
tempDecoded = ANY_to_type_aper(&ie_p->value, &asn_DEF_RANAP_SAPI, (void**)&ranap_sapi_p);
if (tempDecoded < 0) {
RANAP_DEBUG("Decoding of IE sapi failed\n");
return -1;
}
decoded += tempDecoded;
if (asn1_xer_print)
xer_fprint(stdout, &asn_DEF_RANAP_SAPI, ranap_sapi_p);
memcpy(&directTransferIEs->sapi, ranap_sapi_p, sizeof(RANAP_SAPI_t));
} break;
default:
RANAP_DEBUG("Unknown protocol IE id (%d) for message directtransferies\n", (int)ie_p->id);
return -1;
}
}
return decoded;
}
int ranap_encode_directtransferies(
RANAP_DirectTransfer_t *directTransfer,
RANAP_DirectTransferIEs_t *directTransferIEs) {
RANAP_IE_t *ie;
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_NAS_PDU,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_NAS_PDU,
&directTransferIEs->nas_pdu)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&directTransfer->directTransfer_ies.list, ie);
/* Optional field */
if ((directTransferIEs->presenceMask & DIRECTTRANSFERIES_RANAP_LAI_PRESENT)
== DIRECTTRANSFERIES_RANAP_LAI_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_LAI,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_LAI,
&directTransferIEs->lai)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&directTransfer->directTransfer_ies.list, ie);
}
/* Optional field */
if ((directTransferIEs->presenceMask & DIRECTTRANSFERIES_RANAP_RAC_PRESENT)
== DIRECTTRANSFERIES_RANAP_RAC_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_RAC,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_RAC,
&directTransferIEs->rac)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&directTransfer->directTransfer_ies.list, ie);
}
/* Optional field */
if ((directTransferIEs->presenceMask & DIRECTTRANSFERIES_RANAP_SAI_PRESENT)
== DIRECTTRANSFERIES_RANAP_SAI_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_SAI,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_SAI,
&directTransferIEs->sai)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&directTransfer->directTransfer_ies.list, ie);
}
/* Optional field */
if ((directTransferIEs->presenceMask & DIRECTTRANSFERIES_RANAP_SAPI_PRESENT)
== DIRECTTRANSFERIES_RANAP_SAPI_PRESENT) {
if ((ie = ranap_new_ie(RANAP_ProtocolIE_ID_id_SAPI,
RANAP_Criticality_ignore,
&asn_DEF_RANAP_SAPI,
&directTransferIEs->sapi)) == NULL) {
return -1;
}
ASN_SEQUENCE_ADD(&directTransfer->directTransfer_ies.list, ie);
}
return 0;
}
/***********************************************************************
* END auto-generated copy+pasted
***********************************************************************/
static int ranap_tx_reset_ack(struct hnb_context *hnb,
RANAP_CN_DomainIndicator_t domain)
{
RANAP_ResetAcknowledge_t out;
RANAP_ResetAcknowledgeIEs_t ies;
struct msgb *msg;
int rc;
memset(&ies, 0, sizeof(ies));
ies.cN_DomainIndicator = domain;
memset(&out, 0, sizeof(out));
rc = ranap_encode_resetacknowledgeies(&out, &ies);
if (rc < 0) {
LOGP(DMAIN, LOGL_ERROR, "error encoding reset ack IEs: %d\n", rc);
return rc;
}
msg = ranap_generate_successful_outcome(RANAP_ProcedureCode_id_Reset,
RANAP_Criticality_reject,
&asn_DEF_RANAP_ResetAcknowledge,
&out);
if (!msg)
return -1;
msg->dst = hnb;
rc = rua_tx_udt(msg);
return rc;
}
static int ranap_rx_init_reset(struct hnb_context *hnb, ANY_t *in)
{
RANAP_ResetIEs_t ies;
int rc;
rc = ranap_decode_reseties(&ies, in);
if (rc < 0)
return rc;
DEBUGP(DMAIN, "RESET.req\n");
/* FIXME: Actually we have to wait for some guard time? */
/* FIXME: Reset all resources related to this HNB/RNC */
ranap_tx_reset_ack(hnb, ies.cN_DomainIndicator);
return 0;
}
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;
}
static int ranap_rx_init_ue_msg(struct hnb_context *hnb, ANY_t *in)
{
RANAP_InitialUE_MessageIEs_t ies;
struct gprs_ra_id ra_id;
int rc;
rc = ranap_decode_initialue_messageies(&ies, in);
if (rc < 0)
return rc;
/* location area ID of the serving cell */
ranap_parse_lai(&ra_id, &ies.lai);
DEBUGP(DMAIN, "%u-%u-%u: InitialUE: %s\n", ra_id.mcc, ra_id.mnc,
ra_id.lac, osmo_hexdump(ies.nas_pdu.buf, ies.nas_pdu.size));
/* FIXME: hand NAS PDU into MSC */
return 0;
}
static int ranap_rx_dt(struct hnb_context *hnb, ANY_t *in)
{
RANAP_DirectTransferIEs_t ies;
int sapi = 0;
int rc;
rc = ranap_decode_directtransferies(&ies, in);
if (rc < 0)
return rc;
if (ies.presenceMask & DIRECTTRANSFERIES_RANAP_SAPI_PRESENT)
sapi = ies.sapi;
if (ies.presenceMask & DIRECTTRANSFERIES_RANAP_LAI_PRESENT) {
/* FIXME: Update LAI associated with UE */
}
if (ies.presenceMask & DIRECTTRANSFERIES_RANAP_RAC_PRESENT) {
/* FIXME: Update RAC associated with UE */
}
DEBUGP(DMAIN, "DirectTransfer: %s\n",
osmo_hexdump(ies.nas_pdu.buf, ies.nas_pdu.size));
/* FIXME: hand NAS PDU into MSC */
}
static int ranap_rx_initiating_msg(struct hnb_context *hnb, RANAP_InitiatingMessage_t *imsg)
{
int rc;
switch (imsg->procedureCode) {
case RANAP_ProcedureCode_id_Reset:
rc = ranap_rx_init_reset(hnb, &imsg->value);
break;
case RANAP_ProcedureCode_id_InitialUE_Message:
rc = ranap_rx_init_ue_msg(hnb, &imsg->value);
break;
case RANAP_ProcedureCode_id_DirectTransfer:
rc = ranap_rx_dt(hnb, &imsg->value);
break;
}
}
static int _hnbgw_ranap_rx(struct hnb_context *hnb, RANAP_RANAP_PDU_t *pdu)
{
int rc;
switch (pdu->present) {
case RANAP_RANAP_PDU_PR_initiatingMessage:
rc = ranap_rx_initiating_msg(hnb, &pdu->choice.initiatingMessage);
break;
case RANAP_RANAP_PDU_PR_successfulOutcome:
break;
case RANAP_RANAP_PDU_PR_unsuccessfulOutcome:
break;
default:
break;
}
}
int hnbgw_ranap_rx(struct msgb *msg, uint8_t *data, size_t len)
{
RANAP_RANAP_PDU_t _pdu, *pdu = &_pdu;
asn_dec_rval_t dec_ret;
int rc;
memset(pdu, 0, sizeof(*pdu));
dec_ret = aper_decode(NULL,&asn_DEF_RANAP_RANAP_PDU, (void **) &pdu,
data, len, 0, 0);
if (dec_ret.code != RC_OK) {
LOGP(DMAIN, LOGL_ERROR, "Error in RANAP ASN.1 decode\n");
return rc;
}
rc = _hnbgw_ranap_rx(msg->dst, pdu);
return rc;
}
int hnbgw_ranap_init(void)
{
}
View Git Blame Copy Permalink