blob: 59150c91b367422aebec17aa3a05f0752d50055c [file] [log] [blame]
Harald Welte77847ad2015-10-06 22:07:04 +02001/* hnb-gw specific code for HNBAP */
2
3/* (C) 2015 by Harald Welte <laforge@gnumonks.org>
4 * All Rights Reserved
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU Affero General Public License as published by
8 * the Free Software Foundation; either version 3 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU Affero General Public License for more details.
15 *
16 * You should have received a copy of the GNU Affero General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 *
19 */
20
Harald Welteba43de42015-08-29 20:33:16 +020021#include <osmocom/core/msgb.h>
Harald Welteb3dae302015-08-30 12:20:09 +020022#include <osmocom/core/utils.h>
Harald Welte10dfc5a2015-09-11 01:34:45 +020023#include <osmocom/gsm/gsm48.h>
Harald Welteffa7c0a2015-12-23 00:03:41 +010024#include <osmocom/netif/stream.h>
Harald Welteba43de42015-08-29 20:33:16 +020025
Harald Welteb3dae302015-08-30 12:20:09 +020026#include <unistd.h>
Harald Welteee77cff2015-08-30 16:57:53 +020027#include <errno.h>
Harald Welteb3dae302015-08-30 12:20:09 +020028#include <string.h>
29
Harald Welte30afef32015-08-30 12:28:29 +020030#include "asn1helpers.h"
Neels Hofmeyr83457922016-08-26 23:56:44 +020031#include <osmocom/hnbap/hnbap_common.h>
Neels Hofmeyr96979af2016-01-05 15:19:44 +010032#include <osmocom/ranap/iu_helpers.h>
Harald Welte30afef32015-08-30 12:28:29 +020033
Neels Hofmeyrdf63de22016-08-18 13:13:55 +020034#include <osmocom/iuh/hnbgw.h>
Neels Hofmeyr83457922016-08-26 23:56:44 +020035#include <osmocom/hnbap/hnbap_ies_defs.h>
Harald Welteba43de42015-08-29 20:33:16 +020036
Harald Welteee77cff2015-08-30 16:57:53 +020037#define IU_MSG_NUM_IES 32
38#define IU_MSG_NUM_EXT_IES 32
39
Harald Welte27f9c4a2015-08-30 22:47:18 +020040static int hnbgw_hnbap_tx(struct hnb_context *ctx, struct msgb *msg)
Harald Welteee77cff2015-08-30 16:57:53 +020041{
Harald Welte7b54e322015-09-07 22:41:45 +020042 if (!msg)
43 return -EINVAL;
44
Harald Welteffa7c0a2015-12-23 00:03:41 +010045 msgb_sctp_ppid(msg) = IUH_PPI_HNBAP;
Daniel Willmann6480cad2016-01-06 18:06:26 +010046 osmo_stream_srv_send(ctx->conn, msg);
47
48 return 0;
Harald Welte27f9c4a2015-08-30 22:47:18 +020049}
Harald Welteee77cff2015-08-30 16:57:53 +020050
Harald Welte27f9c4a2015-08-30 22:47:18 +020051static int hnbgw_tx_hnb_register_acc(struct hnb_context *ctx)
52{
53 HNBRegisterAccept_t accept_out;
54 struct msgb *msg;
55 int rc;
56
57 /* Single required response IE: RNC-ID */
58 HNBRegisterAcceptIEs_t accept = {
59 .rnc_id = ctx->gw->config.rnc_id
60 };
61
62 /* encode the Information Elements */
Harald Welte2204f9d2015-09-07 21:10:50 +020063 memset(&accept_out, 0, sizeof(accept_out));
Harald Welte27f9c4a2015-08-30 22:47:18 +020064 rc = hnbap_encode_hnbregisteraccepties(&accept_out, &accept);
65 if (rc < 0) {
66 return rc;
Harald Welteee77cff2015-08-30 16:57:53 +020067 }
68
Harald Welte27f9c4a2015-08-30 22:47:18 +020069 /* generate a successfull outcome PDU */
70 msg = hnbap_generate_successful_outcome(ProcedureCode_id_HNBRegister,
71 Criticality_reject,
72 &asn_DEF_HNBRegisterAccept,
73 &accept_out);
Harald Welteee77cff2015-08-30 16:57:53 +020074
Daniel Willmann59d17d82015-12-17 17:56:56 +010075 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_HNBRegisterAccept, &accept_out);
76
Harald Welte27f9c4a2015-08-30 22:47:18 +020077 return hnbgw_hnbap_tx(ctx, msg);
Harald Welteee77cff2015-08-30 16:57:53 +020078}
79
80
Harald Welte27f9c4a2015-08-30 22:47:18 +020081static int hnbgw_tx_ue_register_acc(struct ue_context *ue)
Harald Welteba43de42015-08-29 20:33:16 +020082{
Harald Welte27f9c4a2015-08-30 22:47:18 +020083 UERegisterAccept_t accept_out;
84 UERegisterAcceptIEs_t accept;
85 struct msgb *msg;
Harald Welte10dfc5a2015-09-11 01:34:45 +020086 uint8_t encoded_imsi[10];
Daniel Willmann92247312015-12-09 19:04:33 +010087 uint32_t ctx_id;
Harald Welte10dfc5a2015-09-11 01:34:45 +020088 size_t encoded_imsi_len;
Harald Welte27f9c4a2015-08-30 22:47:18 +020089 int rc;
Harald Welteba43de42015-08-29 20:33:16 +020090
Harald Welte056984f2016-01-03 16:31:31 +010091 encoded_imsi_len = ranap_imsi_encode(encoded_imsi,
Harald Welte1d2c39d2015-09-11 17:49:37 +020092 sizeof(encoded_imsi), ue->imsi);
Harald Welte10dfc5a2015-09-11 01:34:45 +020093
Harald Welte2204f9d2015-09-07 21:10:50 +020094 memset(&accept, 0, sizeof(accept));
Harald Welte10dfc5a2015-09-11 01:34:45 +020095 accept.uE_Identity.present = UE_Identity_PR_iMSI;
Harald Welte1d2c39d2015-09-11 17:49:37 +020096 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.iMSI,
97 (const char *)encoded_imsi, encoded_imsi_len);
Daniel Willmann92247312015-12-09 19:04:33 +010098 asn1_u24_to_bitstring(&accept.context_ID, &ctx_id, ue->context_id);
Harald Welteba43de42015-08-29 20:33:16 +020099
Harald Welte2204f9d2015-09-07 21:10:50 +0200100 memset(&accept_out, 0, sizeof(accept_out));
Harald Welte27f9c4a2015-08-30 22:47:18 +0200101 rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
102 if (rc < 0) {
103 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200104 }
Harald Welte27f9c4a2015-08-30 22:47:18 +0200105
106 msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
107 Criticality_reject,
108 &asn_DEF_UERegisterAccept,
109 &accept_out);
Daniel Willmann541e4292015-12-22 16:25:29 +0100110
111 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING, &accept.uE_Identity.choice.iMSI);
112 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterAccept, &accept_out);
113
Harald Welte27f9c4a2015-08-30 22:47:18 +0200114 return hnbgw_hnbap_tx(ue->hnb, msg);
Harald Welteba43de42015-08-29 20:33:16 +0200115}
116
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200117static int hnbgw_tx_ue_register_rej_tmsi(struct hnb_context *hnb, UE_Identity_t *ue_id)
118{
119 UERegisterReject_t reject_out;
120 UERegisterRejectIEs_t reject;
121 struct msgb *msg;
122 int rc;
123
124 memset(&reject, 0, sizeof(reject));
125 reject.uE_Identity.present = ue_id->present;
126
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200127 /* Copy the identity over to the reject message */
128 switch (ue_id->present) {
129 case UE_Identity_PR_tMSILAI:
130 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id tMSI %d %s\n",
131 ue_id->choice.tMSILAI.tMSI.size,
132 osmo_hexdump(ue_id->choice.tMSILAI.tMSI.buf,
133 ue_id->choice.tMSILAI.tMSI.size));
134
135 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pLMNID %d %s\n",
136 ue_id->choice.tMSILAI.lAI.pLMNID.size,
137 osmo_hexdump(ue_id->choice.tMSILAI.lAI.pLMNID.buf,
138 ue_id->choice.tMSILAI.lAI.pLMNID.size));
139
140 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id lAC %d %s\n",
141 ue_id->choice.tMSILAI.lAI.lAC.size,
142 osmo_hexdump(ue_id->choice.tMSILAI.lAI.lAC.buf,
143 ue_id->choice.tMSILAI.lAI.lAC.size));
144
145 BIT_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.tMSI,
146 ue_id->choice.tMSILAI.tMSI.buf,
147 ue_id->choice.tMSILAI.tMSI.size * 8
148 - ue_id->choice.tMSILAI.tMSI.bits_unused);
149 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.lAI.pLMNID,
150 ue_id->choice.tMSILAI.lAI.pLMNID.buf,
151 ue_id->choice.tMSILAI.lAI.pLMNID.size);
152 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.lAI.lAC,
153 ue_id->choice.tMSILAI.lAI.lAC.buf,
154 ue_id->choice.tMSILAI.lAI.lAC.size);
155 break;
156
157 case UE_Identity_PR_pTMSIRAI:
158 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pTMSI %d %s\n",
159 ue_id->choice.pTMSIRAI.pTMSI.size,
160 osmo_hexdump(ue_id->choice.pTMSIRAI.pTMSI.buf,
161 ue_id->choice.pTMSIRAI.pTMSI.size));
162
163 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pLMNID %d %s\n",
164 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size,
165 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
166 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size));
167
168 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id lAC %d %s\n",
169 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size,
170 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
171 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size));
172
173 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id rAC %d %s\n",
174 ue_id->choice.pTMSIRAI.rAI.rAC.size,
175 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.rAC.buf,
176 ue_id->choice.pTMSIRAI.rAI.rAC.size));
177
178 BIT_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.pTMSI,
179 ue_id->choice.pTMSIRAI.pTMSI.buf,
180 ue_id->choice.pTMSIRAI.pTMSI.size * 8
181 - ue_id->choice.pTMSIRAI.pTMSI.bits_unused);
182 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID,
183 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
184 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size);
185 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC,
186 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
187 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size);
188 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.rAC,
189 ue_id->choice.pTMSIRAI.rAI.rAC.buf,
190 ue_id->choice.pTMSIRAI.rAI.rAC.size);
191 break;
192
193 default:
194 LOGP(DHNBAP, LOGL_ERROR, "Cannot compose UE Register Reject:"
195 " unsupported UE ID (present=%d)\n", ue_id->present);
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200196 return -1;
197 }
198
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200199 LOGP(DHNBAP, LOGL_ERROR, "Rejecting UE Register Request:"
200 " TMSI identity registration is switched off\n");
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200201
202 reject.cause.present = Cause_PR_radioNetwork;
203 reject.cause.choice.radioNetwork = CauseRadioNetwork_invalid_UE_identity;
204
205 memset(&reject_out, 0, sizeof(reject_out));
206 rc = hnbap_encode_ueregisterrejecties(&reject_out, &reject);
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200207 if (rc < 0)
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200208 return rc;
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200209
210 msg = hnbap_generate_unsuccessful_outcome(ProcedureCode_id_UERegister,
211 Criticality_reject,
212 &asn_DEF_UERegisterReject,
213 &reject_out);
214
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200215 /* Free copied identity IEs */
216 switch (ue_id->present) {
217 case UE_Identity_PR_tMSILAI:
218 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
219 &reject.uE_Identity.choice.tMSILAI.tMSI);
220 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
221 &reject.uE_Identity.choice.tMSILAI.lAI.pLMNID);
222 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
223 &reject.uE_Identity.choice.tMSILAI.lAI.lAC);
224 break;
225
226 case UE_Identity_PR_pTMSIRAI:
227 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
228 &reject.uE_Identity.choice.pTMSIRAI.pTMSI);
229 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
230 &reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID);
231 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
232 &reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC);
233 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
234 &reject.uE_Identity.choice.pTMSIRAI.rAI.rAC);
235 break;
236
237 default:
238 /* should never happen after above switch() */
239 break;
240 }
241
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200242 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterReject, &reject_out);
243
244 return hnbgw_hnbap_tx(hnb, msg);
245}
246
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200247static int hnbgw_tx_ue_register_acc_tmsi(struct hnb_context *hnb, UE_Identity_t *ue_id)
248{
249 UERegisterAccept_t accept_out;
250 UERegisterAcceptIEs_t accept;
251 struct msgb *msg;
252 uint32_t ctx_id;
253 uint32_t tmsi = 0;
254 struct ue_context *ue;
255 int rc;
256
257 memset(&accept, 0, sizeof(accept));
258 accept.uE_Identity.present = ue_id->present;
259
260 switch (ue_id->present) {
261 case UE_Identity_PR_tMSILAI:
262 BIT_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.tMSI,
263 ue_id->choice.tMSILAI.tMSI.buf,
264 ue_id->choice.tMSILAI.tMSI.size * 8
265 - ue_id->choice.tMSILAI.tMSI.bits_unused);
266 tmsi = *(uint32_t*)accept.uE_Identity.choice.tMSILAI.tMSI.buf;
267 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.lAI.pLMNID,
268 ue_id->choice.tMSILAI.lAI.pLMNID.buf,
269 ue_id->choice.tMSILAI.lAI.pLMNID.size);
270 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.lAI.lAC,
271 ue_id->choice.tMSILAI.lAI.lAC.buf,
272 ue_id->choice.tMSILAI.lAI.lAC.size);
273 break;
274
275 case UE_Identity_PR_pTMSIRAI:
276 BIT_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.pTMSI,
277 ue_id->choice.pTMSIRAI.pTMSI.buf,
278 ue_id->choice.pTMSIRAI.pTMSI.size * 8
279 - ue_id->choice.pTMSIRAI.pTMSI.bits_unused);
280 tmsi = *(uint32_t*)accept.uE_Identity.choice.pTMSIRAI.pTMSI.buf;
281 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID,
282 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
283 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size);
284 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC,
285 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
286 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size);
287 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.rAC,
288 ue_id->choice.pTMSIRAI.rAI.rAC.buf,
289 ue_id->choice.pTMSIRAI.rAI.rAC.size);
290 break;
291
292 default:
293 LOGP(DHNBAP, LOGL_ERROR, "Unsupportedccept UE ID (present=%d)\n",
294 ue_id->present);
295 return -1;
296 }
297
298 tmsi = ntohl(tmsi);
299 LOGP(DHNBAP, LOGL_DEBUG, "HNBAP register with TMSI %x\n",
300 tmsi);
301
302 ue = ue_context_by_tmsi(hnb->gw, tmsi);
303 if (!ue)
304 ue = ue_context_alloc(hnb, NULL, tmsi);
305
306 asn1_u24_to_bitstring(&accept.context_ID, &ctx_id, ue->context_id);
307
308 memset(&accept_out, 0, sizeof(accept_out));
309 rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
310 if (rc < 0)
311 return rc;
312
313 msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
314 Criticality_reject,
315 &asn_DEF_UERegisterAccept,
316 &accept_out);
317
318 switch (ue_id->present) {
319 case UE_Identity_PR_tMSILAI:
320 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
321 &accept.uE_Identity.choice.tMSILAI.tMSI);
322 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
323 &accept.uE_Identity.choice.tMSILAI.lAI.pLMNID);
324 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
325 &accept.uE_Identity.choice.tMSILAI.lAI.lAC);
326 break;
327
328 case UE_Identity_PR_pTMSIRAI:
329 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
330 &accept.uE_Identity.choice.pTMSIRAI.pTMSI);
331 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
332 &accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID);
333 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
334 &accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC);
335 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
336 &accept.uE_Identity.choice.pTMSIRAI.rAI.rAC);
337 break;
338
339 default:
340 /* should never happen after above switch() */
341 break;
342 }
343
344 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterAccept, &accept_out);
345
346 return hnbgw_hnbap_tx(hnb, msg);
347}
348
Daniel Willmannb433b972016-01-06 18:08:21 +0100349static int hnbgw_rx_hnb_deregister(struct hnb_context *ctx, ANY_t *in)
350{
351 HNBDe_RegisterIEs_t ies;
352 int rc;
353
354 rc = hnbap_decode_hnbde_registeries(&ies, in);
355 if (rc < 0)
356 return rc;
357
Neels Hofmeyr9246cc92016-04-25 14:47:26 +0200358 DEBUGP(DHNBAP, "HNB-DE-REGISTER cause=%ld\n",
Daniel Willmannb433b972016-01-06 18:08:21 +0100359 ies.cause);
360
Daniel Willmannd10002c2016-01-07 12:27:41 +0100361 hnbap_free_hnbde_registeries(&ies);
Daniel Willmannb433b972016-01-06 18:08:21 +0100362 hnb_context_release(ctx);
363
364 return 0;
365}
366
Harald Welte27f9c4a2015-08-30 22:47:18 +0200367static int hnbgw_rx_hnb_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +0200368{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200369 HNBRegisterRequestIEs_t ies;
370 int rc;
Harald Welteba43de42015-08-29 20:33:16 +0200371
Harald Welte27f9c4a2015-08-30 22:47:18 +0200372 rc = hnbap_decode_hnbregisterrequesties(&ies, in);
373 if (rc < 0)
374 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200375
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200376 /* copy all identity parameters from the message to ctx */
Harald Welte27f9c4a2015-08-30 22:47:18 +0200377 asn1_strncpy(ctx->identity_info, &ies.hnB_Identity.hNB_Identity_Info,
378 sizeof(ctx->identity_info));
379 ctx->id.lac = asn1str_to_u16(&ies.lac);
380 ctx->id.sac = asn1str_to_u16(&ies.sac);
381 ctx->id.rac = asn1str_to_u8(&ies.rac);
Daniel Willmannd6a45b42015-12-08 13:55:17 +0100382 ctx->id.cid = asn1bitstr_to_u28(&ies.cellIdentity);
Harald Welteb3dae302015-08-30 12:20:09 +0200383 //ctx->id.mcc FIXME
384 //ctx->id.mnc FIXME
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200385
Daniel Willmannbded9842015-12-17 11:51:17 +0100386 DEBUGP(DHNBAP, "HNB-REGISTER-REQ from %s\n", ctx->identity_info);
Harald Welteee77cff2015-08-30 16:57:53 +0200387
Harald Welte27f9c4a2015-08-30 22:47:18 +0200388 /* Send HNBRegisterAccept */
Daniel Willmannd10002c2016-01-07 12:27:41 +0100389 rc = hnbgw_tx_hnb_register_acc(ctx);
390 hnbap_free_hnbregisterrequesties(&ies);
391 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200392}
393
Harald Welte27f9c4a2015-08-30 22:47:18 +0200394static int hnbgw_rx_ue_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +0200395{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200396 UERegisterRequestIEs_t ies;
397 struct ue_context *ue;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200398 char imsi[16];
Harald Welte27f9c4a2015-08-30 22:47:18 +0200399 int rc;
Harald Welteba43de42015-08-29 20:33:16 +0200400
Harald Welte27f9c4a2015-08-30 22:47:18 +0200401 rc = hnbap_decode_ueregisterrequesties(&ies, in);
402 if (rc < 0)
403 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200404
Harald Welte10dfc5a2015-09-11 01:34:45 +0200405 switch (ies.uE_Identity.present) {
406 case UE_Identity_PR_iMSI:
Harald Welte056984f2016-01-03 16:31:31 +0100407 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSI.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200408 ies.uE_Identity.choice.iMSI.size);
409 break;
410 case UE_Identity_PR_iMSIDS41:
Harald Welte056984f2016-01-03 16:31:31 +0100411 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSIDS41.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200412 ies.uE_Identity.choice.iMSIDS41.size);
413 break;
414 case UE_Identity_PR_iMSIESN:
Harald Welte056984f2016-01-03 16:31:31 +0100415 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSIESN.iMSIDS41.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200416 ies.uE_Identity.choice.iMSIESN.iMSIDS41.size);
417 break;
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200418 case UE_Identity_PR_tMSILAI:
419 case UE_Identity_PR_pTMSIRAI:
420 if (ctx->gw->config.hnbap_allow_tmsi)
421 rc = hnbgw_tx_ue_register_acc_tmsi(ctx, &ies.uE_Identity);
422 else
423 rc = hnbgw_tx_ue_register_rej_tmsi(ctx, &ies.uE_Identity);
424 /* all has been handled by TMSI, skip the IMSI code below */
425 hnbap_free_ueregisterrequesties(&ies);
426 return rc;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200427 default:
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200428 LOGP(DHNBAP, LOGL_NOTICE,
429 "UE-REGISTER-REQ with unsupported UE Id type %d\n",
430 ies.uE_Identity.present);
Neels Hofmeyrb248c8c2016-04-25 14:51:27 +0200431 hnbap_free_ueregisterrequesties(&ies);
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200432 return rc;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200433 }
Harald Welteb534e5c2015-09-11 00:15:16 +0200434
Harald Welte706213a2015-12-25 10:33:09 +0100435 DEBUGP(DHNBAP, "UE-REGISTER-REQ ID_type=%d imsi=%s cause=%ld\n",
Harald Welte10dfc5a2015-09-11 01:34:45 +0200436 ies.uE_Identity.present, imsi, ies.registration_Cause);
437
Harald Weltec4338de2015-12-24 00:40:52 +0100438 ue = ue_context_by_imsi(ctx->gw, imsi);
Harald Welte10dfc5a2015-09-11 01:34:45 +0200439 if (!ue)
Neels Hofmeyrf33e8352016-09-22 18:06:59 +0200440 ue = ue_context_alloc(ctx, imsi, 0);
Harald Welte27f9c4a2015-08-30 22:47:18 +0200441
Daniel Willmannd10002c2016-01-07 12:27:41 +0100442 hnbap_free_ueregisterrequesties(&ies);
Harald Welte27f9c4a2015-08-30 22:47:18 +0200443 /* Send UERegisterAccept */
444 return hnbgw_tx_ue_register_acc(ue);
Harald Welteba43de42015-08-29 20:33:16 +0200445}
446
Daniel Willmannefceb182015-12-15 20:30:12 +0100447static int hnbgw_rx_ue_deregister(struct hnb_context *ctx, ANY_t *in)
448{
449 UEDe_RegisterIEs_t ies;
450 struct ue_context *ue;
451 int rc;
452 uint32_t ctxid;
453
454 rc = hnbap_decode_uede_registeries(&ies, in);
455 if (rc < 0)
456 return rc;
457
458 ctxid = asn1bitstr_to_u24(&ies.context_ID);
459
Harald Welte706213a2015-12-25 10:33:09 +0100460 DEBUGP(DHNBAP, "UE-DE-REGISTER context=%ld cause=%s\n",
Harald Welte2963ee22015-12-25 10:32:37 +0100461 ctxid, hnbap_cause_str(&ies.cause));
Daniel Willmannefceb182015-12-15 20:30:12 +0100462
Harald Weltec4338de2015-12-24 00:40:52 +0100463 ue = ue_context_by_id(ctx->gw, ctxid);
Daniel Willmannefceb182015-12-15 20:30:12 +0100464 if (ue)
465 ue_context_free(ue);
466
Daniel Willmannd10002c2016-01-07 12:27:41 +0100467 hnbap_free_uede_registeries(&ies);
Daniel Willmannefceb182015-12-15 20:30:12 +0100468 return 0;
469}
470
Harald Welte3af1db82015-09-11 17:03:16 +0200471static int hnbgw_rx_err_ind(struct hnb_context *hnb, ANY_t *in)
472{
473 ErrorIndicationIEs_t ies;
474 int rc;
475
Harald Welte1d2c39d2015-09-11 17:49:37 +0200476 rc = hnbap_decode_errorindicationies(&ies, in);
Harald Welte3af1db82015-09-11 17:03:16 +0200477 if (rc < 0)
478 return rc;
479
Daniel Willmannbded9842015-12-17 11:51:17 +0100480 LOGP(DHNBAP, LOGL_NOTICE, "HNBAP ERROR.ind, cause: %s\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200481 hnbap_cause_str(&ies.cause));
482
Daniel Willmannd10002c2016-01-07 12:27:41 +0100483 hnbap_free_errorindicationies(&ies);
Harald Welte3af1db82015-09-11 17:03:16 +0200484 return 0;
485}
486
Harald Welte27f9c4a2015-08-30 22:47:18 +0200487static int hnbgw_rx_initiating_msg(struct hnb_context *hnb, InitiatingMessage_t *imsg)
Harald Welteba43de42015-08-29 20:33:16 +0200488{
489 int rc;
490
Harald Welteb3dae302015-08-30 12:20:09 +0200491 switch (imsg->procedureCode) {
Harald Welte27f9c4a2015-08-30 22:47:18 +0200492 case ProcedureCode_id_HNBRegister: /* 8.2 */
493 rc = hnbgw_rx_hnb_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200494 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200495 case ProcedureCode_id_HNBDe_Register: /* 8.3 */
Daniel Willmannb433b972016-01-06 18:08:21 +0100496 rc = hnbgw_rx_hnb_deregister(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200497 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200498 case ProcedureCode_id_UERegister: /* 8.4 */
499 rc = hnbgw_rx_ue_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200500 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200501 case ProcedureCode_id_UEDe_Register: /* 8.5 */
Daniel Willmannefceb182015-12-15 20:30:12 +0100502 rc = hnbgw_rx_ue_deregister(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200503 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200504 case ProcedureCode_id_ErrorIndication: /* 8.6 */
Harald Welte3af1db82015-09-11 17:03:16 +0200505 rc = hnbgw_rx_err_ind(hnb, &imsg->value);
506 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200507 case ProcedureCode_id_TNLUpdate: /* 8.9 */
508 case ProcedureCode_id_HNBConfigTransfer: /* 8.10 */
509 case ProcedureCode_id_RelocationComplete: /* 8.11 */
510 case ProcedureCode_id_U_RNTIQuery: /* 8.12 */
511 case ProcedureCode_id_privateMessage:
Daniel Willmannbded9842015-12-17 11:51:17 +0100512 LOGP(DHNBAP, LOGL_NOTICE, "Unimplemented HNBAP Procedure %ld\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200513 imsg->procedureCode);
Harald Welteba43de42015-08-29 20:33:16 +0200514 break;
515 default:
Daniel Willmannbded9842015-12-17 11:51:17 +0100516 LOGP(DHNBAP, LOGL_NOTICE, "Unknown HNBAP Procedure %ld\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200517 imsg->procedureCode);
Harald Welteba43de42015-08-29 20:33:16 +0200518 break;
519 }
520}
521
Harald Welte27f9c4a2015-08-30 22:47:18 +0200522static int hnbgw_rx_successful_outcome_msg(struct hnb_context *hnb, SuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200523{
524
525}
526
Harald Welte27f9c4a2015-08-30 22:47:18 +0200527static int hnbgw_rx_unsuccessful_outcome_msg(struct hnb_context *hnb, UnsuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200528{
529
530}
531
532
Harald Welte27f9c4a2015-08-30 22:47:18 +0200533static int _hnbgw_hnbap_rx(struct hnb_context *hnb, HNBAP_PDU_t *pdu)
Harald Welteba43de42015-08-29 20:33:16 +0200534{
Daniel Willmann5f810f42015-12-17 17:57:51 +0100535 int rc = 0;
Harald Welteb3dae302015-08-30 12:20:09 +0200536
Harald Welteba43de42015-08-29 20:33:16 +0200537 /* it's a bit odd that we can't dispatch on procedure code, but
538 * that's not possible */
Harald Welte27f9c4a2015-08-30 22:47:18 +0200539 switch (pdu->present) {
540 case HNBAP_PDU_PR_initiatingMessage:
541 rc = hnbgw_rx_initiating_msg(hnb, &pdu->choice.initiatingMessage);
Harald Welteba43de42015-08-29 20:33:16 +0200542 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200543 case HNBAP_PDU_PR_successfulOutcome:
544 rc = hnbgw_rx_successful_outcome_msg(hnb, &pdu->choice.successfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200545 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200546 case HNBAP_PDU_PR_unsuccessfulOutcome:
547 rc = hnbgw_rx_unsuccessful_outcome_msg(hnb, &pdu->choice.unsuccessfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200548 break;
549 default:
Daniel Willmannbded9842015-12-17 11:51:17 +0100550 LOGP(DHNBAP, LOGL_NOTICE, "Unknown HNBAP Presence %u\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200551 pdu->present);
Daniel Willmann5f810f42015-12-17 17:57:51 +0100552 rc = -1;
Harald Welteba43de42015-08-29 20:33:16 +0200553 }
Daniel Willmann5f810f42015-12-17 17:57:51 +0100554
555 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200556}
557
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200558int hnbgw_hnbap_rx(struct hnb_context *hnb, struct msgb *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200559{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200560 HNBAP_PDU_t _pdu, *pdu = &_pdu;
561 asn_dec_rval_t dec_ret;
Harald Welteee77cff2015-08-30 16:57:53 +0200562 int rc;
563
564 /* decode and handle to _hnbgw_hnbap_rx() */
565
Harald Welte2204f9d2015-09-07 21:10:50 +0200566 memset(pdu, 0, sizeof(*pdu));
Harald Welte27f9c4a2015-08-30 22:47:18 +0200567 dec_ret = aper_decode(NULL, &asn_DEF_HNBAP_PDU, (void **) &pdu,
568 msg->data, msgb_length(msg), 0, 0);
569 if (dec_ret.code != RC_OK) {
Daniel Willmannbded9842015-12-17 11:51:17 +0100570 LOGP(DHNBAP, LOGL_ERROR, "Error in ASN.1 decode\n");
Harald Welteee77cff2015-08-30 16:57:53 +0200571 return rc;
572 }
573
574 rc = _hnbgw_hnbap_rx(hnb, pdu);
Harald Welteee77cff2015-08-30 16:57:53 +0200575
Daniel Willmann59d17d82015-12-17 17:56:56 +0100576 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_HNBAP_PDU, pdu);
577
Harald Welteee77cff2015-08-30 16:57:53 +0200578 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200579}
580
581
582int hnbgw_hnbap_init(void)
583{
584
585}