199 lines
4.6 KiB
C
199 lines
4.6 KiB
C
#include <osmocom/core/msgb.h>
|
|
#include <osmocom/core/utils.h>
|
|
|
|
#include <unistd.h>
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
|
|
#include "asn1helpers.h"
|
|
|
|
#include "hnbgw.h"
|
|
#include "hnbap_common.h"
|
|
#include "hnbap_ies_defs.h"
|
|
|
|
#define IU_MSG_NUM_IES 32
|
|
#define IU_MSG_NUM_EXT_IES 32
|
|
|
|
static int hnbgw_hnbap_tx(struct hnb_context *ctx, struct msgb *msg)
|
|
{
|
|
/* FIXME */
|
|
}
|
|
|
|
static int hnbgw_tx_hnb_register_acc(struct hnb_context *ctx)
|
|
{
|
|
HNBRegisterAccept_t accept_out;
|
|
struct msgb *msg;
|
|
int rc;
|
|
|
|
/* Single required response IE: RNC-ID */
|
|
HNBRegisterAcceptIEs_t accept = {
|
|
.rnc_id = ctx->gw->config.rnc_id
|
|
};
|
|
|
|
/* encode the Information Elements */
|
|
rc = hnbap_encode_hnbregisteraccepties(&accept_out, &accept);
|
|
if (rc < 0) {
|
|
return rc;
|
|
}
|
|
|
|
/* generate a successfull outcome PDU */
|
|
msg = hnbap_generate_successful_outcome(ProcedureCode_id_HNBRegister,
|
|
Criticality_reject,
|
|
&asn_DEF_HNBRegisterAccept,
|
|
&accept_out);
|
|
|
|
return hnbgw_hnbap_tx(ctx, msg);
|
|
}
|
|
|
|
|
|
static int hnbgw_tx_ue_register_acc(struct ue_context *ue)
|
|
{
|
|
UERegisterAccept_t accept_out;
|
|
UERegisterAcceptIEs_t accept;
|
|
struct msgb *msg;
|
|
int rc;
|
|
|
|
/* FIXME accept.uE_Identity; */
|
|
asn1_u32_to_bitstring(&accept.context_ID, &ue->context_id);
|
|
|
|
rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
|
|
if (rc < 0) {
|
|
return rc;
|
|
}
|
|
|
|
msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
|
|
Criticality_reject,
|
|
&asn_DEF_UERegisterAccept,
|
|
&accept_out);
|
|
return hnbgw_hnbap_tx(ue->hnb, msg);
|
|
}
|
|
|
|
static int hnbgw_rx_hnb_register_req(struct hnb_context *ctx, ANY_t *in)
|
|
{
|
|
HNBRegisterRequestIEs_t ies;
|
|
int rc;
|
|
|
|
rc = hnbap_decode_hnbregisterrequesties(&ies, in);
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
/* copy all identity parameters from the message to ctx */
|
|
asn1_strncpy(ctx->identity_info, &ies.hnB_Identity.hNB_Identity_Info,
|
|
sizeof(ctx->identity_info));
|
|
ctx->id.lac = asn1str_to_u16(&ies.lac);
|
|
ctx->id.sac = asn1str_to_u16(&ies.sac);
|
|
ctx->id.rac = asn1str_to_u8(&ies.rac);
|
|
ctx->id.cid = asn1bitstr_to_u32(&ies.cellIdentity);
|
|
//ctx->id.mcc FIXME
|
|
//ctx->id.mnc FIXME
|
|
|
|
DEBUGP(DMAIN, "HNB-REGISTER-REQ from %s\n", ctx->identity_info);
|
|
|
|
/* Send HNBRegisterAccept */
|
|
return hnbgw_tx_hnb_register_acc(ctx);
|
|
}
|
|
|
|
static int hnbgw_rx_ue_register_req(struct hnb_context *ctx, ANY_t *in)
|
|
{
|
|
UERegisterRequestIEs_t ies;
|
|
struct ue_context *ue;
|
|
int rc;
|
|
|
|
rc = hnbap_decode_ueregisterrequesties(&ies, in);
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
DEBUGP(DMAIN, "UE-REGSITER-REQ ID_type=%d cause=%ld\n",
|
|
ies.uE_Identity.present, ies.registration_Cause);
|
|
|
|
/* FIXME: convert UE identity into a more palatable format */
|
|
|
|
/* Send UERegisterAccept */
|
|
return hnbgw_tx_ue_register_acc(ue);
|
|
}
|
|
|
|
static int hnbgw_rx_initiating_msg(struct hnb_context *hnb, InitiatingMessage_t *imsg)
|
|
{
|
|
int rc;
|
|
|
|
switch (imsg->procedureCode) {
|
|
case ProcedureCode_id_HNBRegister: /* 8.2 */
|
|
rc = hnbgw_rx_hnb_register_req(hnb, &imsg->value);
|
|
break;
|
|
case ProcedureCode_id_HNBDe_Register: /* 8.3 */
|
|
break;
|
|
case ProcedureCode_id_UERegister: /* 8.4 */
|
|
rc = hnbgw_rx_ue_register_req(hnb, &imsg->value);
|
|
break;
|
|
case ProcedureCode_id_UEDe_Register: /* 8.5 */
|
|
break;
|
|
case ProcedureCode_id_ErrorIndication: /* 8.6 */
|
|
case ProcedureCode_id_TNLUpdate: /* 8.9 */
|
|
case ProcedureCode_id_HNBConfigTransfer: /* 8.10 */
|
|
case ProcedureCode_id_RelocationComplete: /* 8.11 */
|
|
case ProcedureCode_id_U_RNTIQuery: /* 8.12 */
|
|
case ProcedureCode_id_privateMessage:
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static int hnbgw_rx_successful_outcome_msg(struct hnb_context *hnb, SuccessfulOutcome_t *msg)
|
|
{
|
|
|
|
}
|
|
|
|
static int hnbgw_rx_unsuccessful_outcome_msg(struct hnb_context *hnb, UnsuccessfulOutcome_t *msg)
|
|
{
|
|
|
|
}
|
|
|
|
|
|
static int _hnbgw_hnbap_rx(struct hnb_context *hnb, HNBAP_PDU_t *pdu)
|
|
{
|
|
int rc;
|
|
|
|
/* it's a bit odd that we can't dispatch on procedure code, but
|
|
* that's not possible */
|
|
switch (pdu->present) {
|
|
case HNBAP_PDU_PR_initiatingMessage:
|
|
rc = hnbgw_rx_initiating_msg(hnb, &pdu->choice.initiatingMessage);
|
|
break;
|
|
case HNBAP_PDU_PR_successfulOutcome:
|
|
rc = hnbgw_rx_successful_outcome_msg(hnb, &pdu->choice.successfulOutcome);
|
|
break;
|
|
case HNBAP_PDU_PR_unsuccessfulOutcome:
|
|
rc = hnbgw_rx_unsuccessful_outcome_msg(hnb, &pdu->choice.unsuccessfulOutcome);
|
|
break;
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
int hnbgw_hnbap_rx(struct hnb_context *hnb, struct msgb *msg)
|
|
{
|
|
HNBAP_PDU_t _pdu, *pdu = &_pdu;
|
|
asn_dec_rval_t dec_ret;
|
|
int rc;
|
|
|
|
/* decode and handle to _hnbgw_hnbap_rx() */
|
|
|
|
dec_ret = aper_decode(NULL, &asn_DEF_HNBAP_PDU, (void **) &pdu,
|
|
msg->data, msgb_length(msg), 0, 0);
|
|
if (dec_ret.code != RC_OK) {
|
|
LOGP(DMAIN, LOGL_ERROR, "Error in ASN.1 decode\n");
|
|
return rc;
|
|
}
|
|
|
|
rc = _hnbgw_hnbap_rx(hnb, pdu);
|
|
|
|
return rc;
|
|
}
|
|
|
|
|
|
int hnbgw_hnbap_init(void)
|
|
{
|
|
|
|
}
|