blob: cdd4895d2f59be873c962596c1b95db42a38fafa [file] [log] [blame]
Harald Welteba43de42015-08-29 20:33:16 +02001#include <osmocom/core/msgb.h>
Harald Welteb3dae302015-08-30 12:20:09 +02002#include <osmocom/core/utils.h>
Harald Welteba43de42015-08-29 20:33:16 +02003
Harald Welteb3dae302015-08-30 12:20:09 +02004#include <unistd.h>
Harald Welteee77cff2015-08-30 16:57:53 +02005#include <errno.h>
Harald Welteb3dae302015-08-30 12:20:09 +02006#include <string.h>
7
Harald Welte30afef32015-08-30 12:28:29 +02008#include "asn1helpers.h"
9
Harald Welteba43de42015-08-29 20:33:16 +020010#include "hnbgw.h"
Harald Welte27f9c4a2015-08-30 22:47:18 +020011#include "hnbap_common.h"
12#include "hnbap_ies_defs.h"
Harald Welteba43de42015-08-29 20:33:16 +020013
Harald Welteee77cff2015-08-30 16:57:53 +020014#define IU_MSG_NUM_IES 32
15#define IU_MSG_NUM_EXT_IES 32
16
Harald Welte27f9c4a2015-08-30 22:47:18 +020017static int hnbgw_hnbap_tx(struct hnb_context *ctx, struct msgb *msg)
Harald Welteee77cff2015-08-30 16:57:53 +020018{
Harald Welte7b54e322015-09-07 22:41:45 +020019 if (!msg)
20 return -EINVAL;
21
Harald Welte3f712562015-09-07 21:53:25 +020022 msgb_ppid(msg) = IUH_PPI_HNBAP;
23 return osmo_wqueue_enqueue(&ctx->wqueue, msg);
Harald Welte27f9c4a2015-08-30 22:47:18 +020024}
Harald Welteee77cff2015-08-30 16:57:53 +020025
Harald Welte27f9c4a2015-08-30 22:47:18 +020026static int hnbgw_tx_hnb_register_acc(struct hnb_context *ctx)
27{
28 HNBRegisterAccept_t accept_out;
29 struct msgb *msg;
30 int rc;
31
32 /* Single required response IE: RNC-ID */
33 HNBRegisterAcceptIEs_t accept = {
34 .rnc_id = ctx->gw->config.rnc_id
35 };
36
37 /* encode the Information Elements */
Harald Welte2204f9d2015-09-07 21:10:50 +020038 memset(&accept_out, 0, sizeof(accept_out));
Harald Welte27f9c4a2015-08-30 22:47:18 +020039 rc = hnbap_encode_hnbregisteraccepties(&accept_out, &accept);
40 if (rc < 0) {
41 return rc;
Harald Welteee77cff2015-08-30 16:57:53 +020042 }
43
Harald Welte27f9c4a2015-08-30 22:47:18 +020044 /* generate a successfull outcome PDU */
45 msg = hnbap_generate_successful_outcome(ProcedureCode_id_HNBRegister,
46 Criticality_reject,
47 &asn_DEF_HNBRegisterAccept,
48 &accept_out);
Harald Welteee77cff2015-08-30 16:57:53 +020049
Harald Welte27f9c4a2015-08-30 22:47:18 +020050 return hnbgw_hnbap_tx(ctx, msg);
Harald Welteee77cff2015-08-30 16:57:53 +020051}
52
53
Harald Welte27f9c4a2015-08-30 22:47:18 +020054static int hnbgw_tx_ue_register_acc(struct ue_context *ue)
Harald Welteba43de42015-08-29 20:33:16 +020055{
Harald Welte27f9c4a2015-08-30 22:47:18 +020056 UERegisterAccept_t accept_out;
57 UERegisterAcceptIEs_t accept;
58 struct msgb *msg;
59 int rc;
Harald Welteba43de42015-08-29 20:33:16 +020060
Harald Welte27f9c4a2015-08-30 22:47:18 +020061 /* FIXME accept.uE_Identity; */
Harald Welte2204f9d2015-09-07 21:10:50 +020062 memset(&accept, 0, sizeof(accept));
Harald Welte27f9c4a2015-08-30 22:47:18 +020063 asn1_u32_to_bitstring(&accept.context_ID, &ue->context_id);
Harald Welteba43de42015-08-29 20:33:16 +020064
Harald Welte2204f9d2015-09-07 21:10:50 +020065 memset(&accept_out, 0, sizeof(accept_out));
Harald Welte27f9c4a2015-08-30 22:47:18 +020066 rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
67 if (rc < 0) {
68 return rc;
Harald Welteba43de42015-08-29 20:33:16 +020069 }
Harald Welte27f9c4a2015-08-30 22:47:18 +020070
71 msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
72 Criticality_reject,
73 &asn_DEF_UERegisterAccept,
74 &accept_out);
75 return hnbgw_hnbap_tx(ue->hnb, msg);
Harald Welteba43de42015-08-29 20:33:16 +020076}
77
Harald Welte27f9c4a2015-08-30 22:47:18 +020078static int hnbgw_rx_hnb_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +020079{
Harald Welte27f9c4a2015-08-30 22:47:18 +020080 HNBRegisterRequestIEs_t ies;
81 int rc;
Harald Welteba43de42015-08-29 20:33:16 +020082
Harald Welte27f9c4a2015-08-30 22:47:18 +020083 rc = hnbap_decode_hnbregisterrequesties(&ies, in);
84 if (rc < 0)
85 return rc;
Harald Welteba43de42015-08-29 20:33:16 +020086
Harald Weltea2e6a7a2015-08-29 21:47:39 +020087 /* copy all identity parameters from the message to ctx */
Harald Welte27f9c4a2015-08-30 22:47:18 +020088 asn1_strncpy(ctx->identity_info, &ies.hnB_Identity.hNB_Identity_Info,
89 sizeof(ctx->identity_info));
90 ctx->id.lac = asn1str_to_u16(&ies.lac);
91 ctx->id.sac = asn1str_to_u16(&ies.sac);
92 ctx->id.rac = asn1str_to_u8(&ies.rac);
93 ctx->id.cid = asn1bitstr_to_u32(&ies.cellIdentity);
Harald Welteb3dae302015-08-30 12:20:09 +020094 //ctx->id.mcc FIXME
95 //ctx->id.mnc FIXME
Harald Weltea2e6a7a2015-08-29 21:47:39 +020096
Harald Welteee77cff2015-08-30 16:57:53 +020097 DEBUGP(DMAIN, "HNB-REGISTER-REQ from %s\n", ctx->identity_info);
98
Harald Welte27f9c4a2015-08-30 22:47:18 +020099 /* Send HNBRegisterAccept */
100 return hnbgw_tx_hnb_register_acc(ctx);
Harald Welteba43de42015-08-29 20:33:16 +0200101}
102
Harald Welte27f9c4a2015-08-30 22:47:18 +0200103static int hnbgw_rx_ue_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +0200104{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200105 UERegisterRequestIEs_t ies;
106 struct ue_context *ue;
107 int rc;
Harald Welteba43de42015-08-29 20:33:16 +0200108
Harald Welte27f9c4a2015-08-30 22:47:18 +0200109 rc = hnbap_decode_ueregisterrequesties(&ies, in);
110 if (rc < 0)
111 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200112
Harald Welte27f9c4a2015-08-30 22:47:18 +0200113 DEBUGP(DMAIN, "UE-REGSITER-REQ ID_type=%d cause=%ld\n",
114 ies.uE_Identity.present, ies.registration_Cause);
115
116 /* FIXME: convert UE identity into a more palatable format */
117
118 /* Send UERegisterAccept */
119 return hnbgw_tx_ue_register_acc(ue);
Harald Welteba43de42015-08-29 20:33:16 +0200120}
121
Harald Welte27f9c4a2015-08-30 22:47:18 +0200122static int hnbgw_rx_initiating_msg(struct hnb_context *hnb, InitiatingMessage_t *imsg)
Harald Welteba43de42015-08-29 20:33:16 +0200123{
124 int rc;
125
Harald Welteb3dae302015-08-30 12:20:09 +0200126 switch (imsg->procedureCode) {
Harald Welte27f9c4a2015-08-30 22:47:18 +0200127 case ProcedureCode_id_HNBRegister: /* 8.2 */
128 rc = hnbgw_rx_hnb_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200129 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200130 case ProcedureCode_id_HNBDe_Register: /* 8.3 */
Harald Welteba43de42015-08-29 20:33:16 +0200131 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200132 case ProcedureCode_id_UERegister: /* 8.4 */
133 rc = hnbgw_rx_ue_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200134 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200135 case ProcedureCode_id_UEDe_Register: /* 8.5 */
Harald Welteba43de42015-08-29 20:33:16 +0200136 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200137 case ProcedureCode_id_ErrorIndication: /* 8.6 */
138 case ProcedureCode_id_TNLUpdate: /* 8.9 */
139 case ProcedureCode_id_HNBConfigTransfer: /* 8.10 */
140 case ProcedureCode_id_RelocationComplete: /* 8.11 */
141 case ProcedureCode_id_U_RNTIQuery: /* 8.12 */
142 case ProcedureCode_id_privateMessage:
Harald Welteba43de42015-08-29 20:33:16 +0200143 break;
144 default:
145 break;
146 }
147}
148
Harald Welte27f9c4a2015-08-30 22:47:18 +0200149static int hnbgw_rx_successful_outcome_msg(struct hnb_context *hnb, SuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200150{
151
152}
153
Harald Welte27f9c4a2015-08-30 22:47:18 +0200154static int hnbgw_rx_unsuccessful_outcome_msg(struct hnb_context *hnb, UnsuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200155{
156
157}
158
159
Harald Welte27f9c4a2015-08-30 22:47:18 +0200160static int _hnbgw_hnbap_rx(struct hnb_context *hnb, HNBAP_PDU_t *pdu)
Harald Welteba43de42015-08-29 20:33:16 +0200161{
Harald Welteb3dae302015-08-30 12:20:09 +0200162 int rc;
163
Harald Welteba43de42015-08-29 20:33:16 +0200164 /* it's a bit odd that we can't dispatch on procedure code, but
165 * that's not possible */
Harald Welte27f9c4a2015-08-30 22:47:18 +0200166 switch (pdu->present) {
167 case HNBAP_PDU_PR_initiatingMessage:
168 rc = hnbgw_rx_initiating_msg(hnb, &pdu->choice.initiatingMessage);
Harald Welteba43de42015-08-29 20:33:16 +0200169 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200170 case HNBAP_PDU_PR_successfulOutcome:
171 rc = hnbgw_rx_successful_outcome_msg(hnb, &pdu->choice.successfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200172 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200173 case HNBAP_PDU_PR_unsuccessfulOutcome:
174 rc = hnbgw_rx_unsuccessful_outcome_msg(hnb, &pdu->choice.unsuccessfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200175 break;
176 default:
177 return -1;
178 }
179}
180
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200181int hnbgw_hnbap_rx(struct hnb_context *hnb, struct msgb *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200182{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200183 HNBAP_PDU_t _pdu, *pdu = &_pdu;
184 asn_dec_rval_t dec_ret;
Harald Welteee77cff2015-08-30 16:57:53 +0200185 int rc;
186
187 /* decode and handle to _hnbgw_hnbap_rx() */
188
Harald Welte2204f9d2015-09-07 21:10:50 +0200189 memset(pdu, 0, sizeof(*pdu));
Harald Welte27f9c4a2015-08-30 22:47:18 +0200190 dec_ret = aper_decode(NULL, &asn_DEF_HNBAP_PDU, (void **) &pdu,
191 msg->data, msgb_length(msg), 0, 0);
192 if (dec_ret.code != RC_OK) {
193 LOGP(DMAIN, LOGL_ERROR, "Error in ASN.1 decode\n");
Harald Welteee77cff2015-08-30 16:57:53 +0200194 return rc;
195 }
196
197 rc = _hnbgw_hnbap_rx(hnb, pdu);
Harald Welteee77cff2015-08-30 16:57:53 +0200198
199 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200200}
201
202
203int hnbgw_hnbap_init(void)
204{
205
206}