blob: 8fba13c765f0be370472b1992122a869914df771 [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) {
Neels Hofmeyr2293df02018-01-18 19:01:09 +010066 LOGP(DHNBAP, LOGL_ERROR, "Failure to encode HNB-REGISTER-ACCEPT to %s: rc=%d\n",
67 ctx->identity_info, rc);
Harald Welte27f9c4a2015-08-30 22:47:18 +020068 return rc;
Harald Welteee77cff2015-08-30 16:57:53 +020069 }
70
Harald Welte27f9c4a2015-08-30 22:47:18 +020071 /* generate a successfull outcome PDU */
72 msg = hnbap_generate_successful_outcome(ProcedureCode_id_HNBRegister,
73 Criticality_reject,
74 &asn_DEF_HNBRegisterAccept,
75 &accept_out);
Harald Welteee77cff2015-08-30 16:57:53 +020076
Daniel Willmann59d17d82015-12-17 17:56:56 +010077 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_HNBRegisterAccept, &accept_out);
78
Harald Welte27f9c4a2015-08-30 22:47:18 +020079 return hnbgw_hnbap_tx(ctx, msg);
Harald Welteee77cff2015-08-30 16:57:53 +020080}
81
82
Harald Welte27f9c4a2015-08-30 22:47:18 +020083static int hnbgw_tx_ue_register_acc(struct ue_context *ue)
Harald Welteba43de42015-08-29 20:33:16 +020084{
Harald Welte27f9c4a2015-08-30 22:47:18 +020085 UERegisterAccept_t accept_out;
86 UERegisterAcceptIEs_t accept;
87 struct msgb *msg;
Harald Welte10dfc5a2015-09-11 01:34:45 +020088 uint8_t encoded_imsi[10];
Daniel Willmann92247312015-12-09 19:04:33 +010089 uint32_t ctx_id;
Harald Welte10dfc5a2015-09-11 01:34:45 +020090 size_t encoded_imsi_len;
Harald Welte27f9c4a2015-08-30 22:47:18 +020091 int rc;
Harald Welteba43de42015-08-29 20:33:16 +020092
Harald Welte056984f2016-01-03 16:31:31 +010093 encoded_imsi_len = ranap_imsi_encode(encoded_imsi,
Harald Welte1d2c39d2015-09-11 17:49:37 +020094 sizeof(encoded_imsi), ue->imsi);
Harald Welte10dfc5a2015-09-11 01:34:45 +020095
Harald Welte2204f9d2015-09-07 21:10:50 +020096 memset(&accept, 0, sizeof(accept));
Harald Welte10dfc5a2015-09-11 01:34:45 +020097 accept.uE_Identity.present = UE_Identity_PR_iMSI;
Harald Welte1d2c39d2015-09-11 17:49:37 +020098 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.iMSI,
99 (const char *)encoded_imsi, encoded_imsi_len);
Daniel Willmann92247312015-12-09 19:04:33 +0100100 asn1_u24_to_bitstring(&accept.context_ID, &ctx_id, ue->context_id);
Harald Welteba43de42015-08-29 20:33:16 +0200101
Harald Welte2204f9d2015-09-07 21:10:50 +0200102 memset(&accept_out, 0, sizeof(accept_out));
Harald Welte27f9c4a2015-08-30 22:47:18 +0200103 rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
104 if (rc < 0) {
105 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200106 }
Harald Welte27f9c4a2015-08-30 22:47:18 +0200107
108 msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
109 Criticality_reject,
110 &asn_DEF_UERegisterAccept,
111 &accept_out);
Daniel Willmann541e4292015-12-22 16:25:29 +0100112
113 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING, &accept.uE_Identity.choice.iMSI);
114 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterAccept, &accept_out);
115
Harald Welte27f9c4a2015-08-30 22:47:18 +0200116 return hnbgw_hnbap_tx(ue->hnb, msg);
Harald Welteba43de42015-08-29 20:33:16 +0200117}
118
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200119static int hnbgw_tx_ue_register_rej_tmsi(struct hnb_context *hnb, UE_Identity_t *ue_id)
120{
121 UERegisterReject_t reject_out;
122 UERegisterRejectIEs_t reject;
123 struct msgb *msg;
124 int rc;
125
126 memset(&reject, 0, sizeof(reject));
127 reject.uE_Identity.present = ue_id->present;
128
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200129 /* Copy the identity over to the reject message */
130 switch (ue_id->present) {
131 case UE_Identity_PR_tMSILAI:
132 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id tMSI %d %s\n",
133 ue_id->choice.tMSILAI.tMSI.size,
134 osmo_hexdump(ue_id->choice.tMSILAI.tMSI.buf,
135 ue_id->choice.tMSILAI.tMSI.size));
136
137 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pLMNID %d %s\n",
138 ue_id->choice.tMSILAI.lAI.pLMNID.size,
139 osmo_hexdump(ue_id->choice.tMSILAI.lAI.pLMNID.buf,
140 ue_id->choice.tMSILAI.lAI.pLMNID.size));
141
142 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id lAC %d %s\n",
143 ue_id->choice.tMSILAI.lAI.lAC.size,
144 osmo_hexdump(ue_id->choice.tMSILAI.lAI.lAC.buf,
145 ue_id->choice.tMSILAI.lAI.lAC.size));
146
147 BIT_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.tMSI,
148 ue_id->choice.tMSILAI.tMSI.buf,
149 ue_id->choice.tMSILAI.tMSI.size * 8
150 - ue_id->choice.tMSILAI.tMSI.bits_unused);
151 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.lAI.pLMNID,
152 ue_id->choice.tMSILAI.lAI.pLMNID.buf,
153 ue_id->choice.tMSILAI.lAI.pLMNID.size);
154 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.tMSILAI.lAI.lAC,
155 ue_id->choice.tMSILAI.lAI.lAC.buf,
156 ue_id->choice.tMSILAI.lAI.lAC.size);
157 break;
158
159 case UE_Identity_PR_pTMSIRAI:
160 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pTMSI %d %s\n",
161 ue_id->choice.pTMSIRAI.pTMSI.size,
162 osmo_hexdump(ue_id->choice.pTMSIRAI.pTMSI.buf,
163 ue_id->choice.pTMSIRAI.pTMSI.size));
164
165 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id pLMNID %d %s\n",
166 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size,
167 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
168 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size));
169
170 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id lAC %d %s\n",
171 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size,
172 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
173 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size));
174
175 LOGP(DHNBAP, LOGL_DEBUG, "REJ UE_Id rAC %d %s\n",
176 ue_id->choice.pTMSIRAI.rAI.rAC.size,
177 osmo_hexdump(ue_id->choice.pTMSIRAI.rAI.rAC.buf,
178 ue_id->choice.pTMSIRAI.rAI.rAC.size));
179
180 BIT_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.pTMSI,
181 ue_id->choice.pTMSIRAI.pTMSI.buf,
182 ue_id->choice.pTMSIRAI.pTMSI.size * 8
183 - ue_id->choice.pTMSIRAI.pTMSI.bits_unused);
184 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID,
185 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
186 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size);
187 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC,
188 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
189 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size);
190 OCTET_STRING_fromBuf(&reject.uE_Identity.choice.pTMSIRAI.rAI.rAC,
191 ue_id->choice.pTMSIRAI.rAI.rAC.buf,
192 ue_id->choice.pTMSIRAI.rAI.rAC.size);
193 break;
194
195 default:
196 LOGP(DHNBAP, LOGL_ERROR, "Cannot compose UE Register Reject:"
197 " unsupported UE ID (present=%d)\n", ue_id->present);
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200198 return -1;
199 }
200
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200201 LOGP(DHNBAP, LOGL_ERROR, "Rejecting UE Register Request:"
202 " TMSI identity registration is switched off\n");
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200203
204 reject.cause.present = Cause_PR_radioNetwork;
205 reject.cause.choice.radioNetwork = CauseRadioNetwork_invalid_UE_identity;
206
207 memset(&reject_out, 0, sizeof(reject_out));
208 rc = hnbap_encode_ueregisterrejecties(&reject_out, &reject);
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200209 if (rc < 0)
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200210 return rc;
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200211
212 msg = hnbap_generate_unsuccessful_outcome(ProcedureCode_id_UERegister,
213 Criticality_reject,
214 &asn_DEF_UERegisterReject,
215 &reject_out);
216
Neels Hofmeyrc94ed092016-09-26 01:27:55 +0200217 /* Free copied identity IEs */
218 switch (ue_id->present) {
219 case UE_Identity_PR_tMSILAI:
220 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
221 &reject.uE_Identity.choice.tMSILAI.tMSI);
222 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
223 &reject.uE_Identity.choice.tMSILAI.lAI.pLMNID);
224 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
225 &reject.uE_Identity.choice.tMSILAI.lAI.lAC);
226 break;
227
228 case UE_Identity_PR_pTMSIRAI:
229 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
230 &reject.uE_Identity.choice.pTMSIRAI.pTMSI);
231 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
232 &reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID);
233 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
234 &reject.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC);
235 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
236 &reject.uE_Identity.choice.pTMSIRAI.rAI.rAC);
237 break;
238
239 default:
240 /* should never happen after above switch() */
241 break;
242 }
243
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200244 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterReject, &reject_out);
245
246 return hnbgw_hnbap_tx(hnb, msg);
247}
248
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200249static int hnbgw_tx_ue_register_acc_tmsi(struct hnb_context *hnb, UE_Identity_t *ue_id)
250{
251 UERegisterAccept_t accept_out;
252 UERegisterAcceptIEs_t accept;
253 struct msgb *msg;
254 uint32_t ctx_id;
255 uint32_t tmsi = 0;
256 struct ue_context *ue;
257 int rc;
258
259 memset(&accept, 0, sizeof(accept));
260 accept.uE_Identity.present = ue_id->present;
261
262 switch (ue_id->present) {
263 case UE_Identity_PR_tMSILAI:
264 BIT_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.tMSI,
265 ue_id->choice.tMSILAI.tMSI.buf,
266 ue_id->choice.tMSILAI.tMSI.size * 8
267 - ue_id->choice.tMSILAI.tMSI.bits_unused);
268 tmsi = *(uint32_t*)accept.uE_Identity.choice.tMSILAI.tMSI.buf;
269 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.lAI.pLMNID,
270 ue_id->choice.tMSILAI.lAI.pLMNID.buf,
271 ue_id->choice.tMSILAI.lAI.pLMNID.size);
272 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.tMSILAI.lAI.lAC,
273 ue_id->choice.tMSILAI.lAI.lAC.buf,
274 ue_id->choice.tMSILAI.lAI.lAC.size);
275 break;
276
277 case UE_Identity_PR_pTMSIRAI:
278 BIT_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.pTMSI,
279 ue_id->choice.pTMSIRAI.pTMSI.buf,
280 ue_id->choice.pTMSIRAI.pTMSI.size * 8
281 - ue_id->choice.pTMSIRAI.pTMSI.bits_unused);
282 tmsi = *(uint32_t*)accept.uE_Identity.choice.pTMSIRAI.pTMSI.buf;
283 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID,
284 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.buf,
285 ue_id->choice.pTMSIRAI.rAI.lAI.pLMNID.size);
286 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC,
287 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.buf,
288 ue_id->choice.pTMSIRAI.rAI.lAI.lAC.size);
289 OCTET_STRING_fromBuf(&accept.uE_Identity.choice.pTMSIRAI.rAI.rAC,
290 ue_id->choice.pTMSIRAI.rAI.rAC.buf,
291 ue_id->choice.pTMSIRAI.rAI.rAC.size);
292 break;
293
294 default:
295 LOGP(DHNBAP, LOGL_ERROR, "Unsupportedccept UE ID (present=%d)\n",
296 ue_id->present);
297 return -1;
298 }
299
300 tmsi = ntohl(tmsi);
301 LOGP(DHNBAP, LOGL_DEBUG, "HNBAP register with TMSI %x\n",
302 tmsi);
303
304 ue = ue_context_by_tmsi(hnb->gw, tmsi);
305 if (!ue)
306 ue = ue_context_alloc(hnb, NULL, tmsi);
307
308 asn1_u24_to_bitstring(&accept.context_ID, &ctx_id, ue->context_id);
309
310 memset(&accept_out, 0, sizeof(accept_out));
311 rc = hnbap_encode_ueregisteraccepties(&accept_out, &accept);
312 if (rc < 0)
313 return rc;
314
315 msg = hnbap_generate_successful_outcome(ProcedureCode_id_UERegister,
316 Criticality_reject,
317 &asn_DEF_UERegisterAccept,
318 &accept_out);
319
320 switch (ue_id->present) {
321 case UE_Identity_PR_tMSILAI:
322 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
323 &accept.uE_Identity.choice.tMSILAI.tMSI);
324 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
325 &accept.uE_Identity.choice.tMSILAI.lAI.pLMNID);
326 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
327 &accept.uE_Identity.choice.tMSILAI.lAI.lAC);
328 break;
329
330 case UE_Identity_PR_pTMSIRAI:
331 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_BIT_STRING,
332 &accept.uE_Identity.choice.pTMSIRAI.pTMSI);
333 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
334 &accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.pLMNID);
335 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
336 &accept.uE_Identity.choice.pTMSIRAI.rAI.lAI.lAC);
337 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_OCTET_STRING,
338 &accept.uE_Identity.choice.pTMSIRAI.rAI.rAC);
339 break;
340
341 default:
342 /* should never happen after above switch() */
343 break;
344 }
345
346 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_UERegisterAccept, &accept_out);
347
348 return hnbgw_hnbap_tx(hnb, msg);
349}
350
Daniel Willmannb433b972016-01-06 18:08:21 +0100351static int hnbgw_rx_hnb_deregister(struct hnb_context *ctx, ANY_t *in)
352{
353 HNBDe_RegisterIEs_t ies;
354 int rc;
355
356 rc = hnbap_decode_hnbde_registeries(&ies, in);
357 if (rc < 0)
358 return rc;
359
Harald Welteda86fe52017-11-21 08:14:37 +0100360 DEBUGP(DHNBAP, "HNB-DE-REGISTER cause=%s\n",
361 hnbap_cause_str(&ies.cause));
Daniel Willmannb433b972016-01-06 18:08:21 +0100362
Daniel Willmannd10002c2016-01-07 12:27:41 +0100363 hnbap_free_hnbde_registeries(&ies);
Daniel Willmannb433b972016-01-06 18:08:21 +0100364 hnb_context_release(ctx);
365
366 return 0;
367}
368
Harald Welte27f9c4a2015-08-30 22:47:18 +0200369static int hnbgw_rx_hnb_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +0200370{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200371 HNBRegisterRequestIEs_t ies;
372 int rc;
Harald Welteba43de42015-08-29 20:33:16 +0200373
Harald Welte27f9c4a2015-08-30 22:47:18 +0200374 rc = hnbap_decode_hnbregisterrequesties(&ies, in);
Neels Hofmeyr2293df02018-01-18 19:01:09 +0100375 if (rc < 0) {
376 LOGP(DHNBAP, LOGL_ERROR, "Failure to decode HNB-REGISTER-REQ from %s: rc=%d\n",
377 ctx->identity_info, rc);
Harald Welte27f9c4a2015-08-30 22:47:18 +0200378 return rc;
Neels Hofmeyr2293df02018-01-18 19:01:09 +0100379 }
Harald Welteba43de42015-08-29 20:33:16 +0200380
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200381 /* copy all identity parameters from the message to ctx */
Harald Welte27f9c4a2015-08-30 22:47:18 +0200382 asn1_strncpy(ctx->identity_info, &ies.hnB_Identity.hNB_Identity_Info,
383 sizeof(ctx->identity_info));
384 ctx->id.lac = asn1str_to_u16(&ies.lac);
385 ctx->id.sac = asn1str_to_u16(&ies.sac);
386 ctx->id.rac = asn1str_to_u8(&ies.rac);
Daniel Willmannd6a45b42015-12-08 13:55:17 +0100387 ctx->id.cid = asn1bitstr_to_u28(&ies.cellIdentity);
Neels Hofmeyr66d6d762017-12-20 05:25:02 +0100388 gsm48_mcc_mnc_from_bcd(ies.plmNidentity.buf, &ctx->id.mcc, &ctx->id.mnc);
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200389
Daniel Willmannbded9842015-12-17 11:51:17 +0100390 DEBUGP(DHNBAP, "HNB-REGISTER-REQ from %s\n", ctx->identity_info);
Harald Welteee77cff2015-08-30 16:57:53 +0200391
Harald Welte27f9c4a2015-08-30 22:47:18 +0200392 /* Send HNBRegisterAccept */
Daniel Willmannd10002c2016-01-07 12:27:41 +0100393 rc = hnbgw_tx_hnb_register_acc(ctx);
394 hnbap_free_hnbregisterrequesties(&ies);
395 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200396}
397
Harald Welte27f9c4a2015-08-30 22:47:18 +0200398static int hnbgw_rx_ue_register_req(struct hnb_context *ctx, ANY_t *in)
Harald Welteba43de42015-08-29 20:33:16 +0200399{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200400 UERegisterRequestIEs_t ies;
401 struct ue_context *ue;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200402 char imsi[16];
Harald Welte27f9c4a2015-08-30 22:47:18 +0200403 int rc;
Harald Welteba43de42015-08-29 20:33:16 +0200404
Harald Welte27f9c4a2015-08-30 22:47:18 +0200405 rc = hnbap_decode_ueregisterrequesties(&ies, in);
406 if (rc < 0)
407 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200408
Harald Welte10dfc5a2015-09-11 01:34:45 +0200409 switch (ies.uE_Identity.present) {
410 case UE_Identity_PR_iMSI:
Harald Welte056984f2016-01-03 16:31:31 +0100411 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSI.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200412 ies.uE_Identity.choice.iMSI.size);
413 break;
414 case UE_Identity_PR_iMSIDS41:
Harald Welte056984f2016-01-03 16:31:31 +0100415 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSIDS41.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200416 ies.uE_Identity.choice.iMSIDS41.size);
417 break;
418 case UE_Identity_PR_iMSIESN:
Harald Welte056984f2016-01-03 16:31:31 +0100419 ranap_bcd_decode(imsi, sizeof(imsi), ies.uE_Identity.choice.iMSIESN.iMSIDS41.buf,
Harald Welte10dfc5a2015-09-11 01:34:45 +0200420 ies.uE_Identity.choice.iMSIESN.iMSIDS41.size);
421 break;
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200422 case UE_Identity_PR_tMSILAI:
423 case UE_Identity_PR_pTMSIRAI:
424 if (ctx->gw->config.hnbap_allow_tmsi)
425 rc = hnbgw_tx_ue_register_acc_tmsi(ctx, &ies.uE_Identity);
426 else
427 rc = hnbgw_tx_ue_register_rej_tmsi(ctx, &ies.uE_Identity);
428 /* all has been handled by TMSI, skip the IMSI code below */
429 hnbap_free_ueregisterrequesties(&ies);
430 return rc;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200431 default:
Neels Hofmeyr12181a92016-04-25 15:05:32 +0200432 LOGP(DHNBAP, LOGL_NOTICE,
433 "UE-REGISTER-REQ with unsupported UE Id type %d\n",
434 ies.uE_Identity.present);
Neels Hofmeyrb248c8c2016-04-25 14:51:27 +0200435 hnbap_free_ueregisterrequesties(&ies);
Neels Hofmeyr1a0bb512016-04-25 14:55:35 +0200436 return rc;
Harald Welte10dfc5a2015-09-11 01:34:45 +0200437 }
Harald Welteb534e5c2015-09-11 00:15:16 +0200438
Harald Welte706213a2015-12-25 10:33:09 +0100439 DEBUGP(DHNBAP, "UE-REGISTER-REQ ID_type=%d imsi=%s cause=%ld\n",
Harald Welte10dfc5a2015-09-11 01:34:45 +0200440 ies.uE_Identity.present, imsi, ies.registration_Cause);
441
Harald Weltec4338de2015-12-24 00:40:52 +0100442 ue = ue_context_by_imsi(ctx->gw, imsi);
Harald Welte10dfc5a2015-09-11 01:34:45 +0200443 if (!ue)
Neels Hofmeyrf33e8352016-09-22 18:06:59 +0200444 ue = ue_context_alloc(ctx, imsi, 0);
Harald Welte27f9c4a2015-08-30 22:47:18 +0200445
Daniel Willmannd10002c2016-01-07 12:27:41 +0100446 hnbap_free_ueregisterrequesties(&ies);
Harald Welte27f9c4a2015-08-30 22:47:18 +0200447 /* Send UERegisterAccept */
448 return hnbgw_tx_ue_register_acc(ue);
Harald Welteba43de42015-08-29 20:33:16 +0200449}
450
Daniel Willmannefceb182015-12-15 20:30:12 +0100451static int hnbgw_rx_ue_deregister(struct hnb_context *ctx, ANY_t *in)
452{
453 UEDe_RegisterIEs_t ies;
454 struct ue_context *ue;
455 int rc;
456 uint32_t ctxid;
457
458 rc = hnbap_decode_uede_registeries(&ies, in);
459 if (rc < 0)
460 return rc;
461
462 ctxid = asn1bitstr_to_u24(&ies.context_ID);
463
Harald Welteda86fe52017-11-21 08:14:37 +0100464 DEBUGP(DHNBAP, "UE-DE-REGISTER context=%u cause=%s\n",
Harald Welte2963ee22015-12-25 10:32:37 +0100465 ctxid, hnbap_cause_str(&ies.cause));
Daniel Willmannefceb182015-12-15 20:30:12 +0100466
Harald Weltec4338de2015-12-24 00:40:52 +0100467 ue = ue_context_by_id(ctx->gw, ctxid);
Daniel Willmannefceb182015-12-15 20:30:12 +0100468 if (ue)
469 ue_context_free(ue);
470
Daniel Willmannd10002c2016-01-07 12:27:41 +0100471 hnbap_free_uede_registeries(&ies);
Daniel Willmannefceb182015-12-15 20:30:12 +0100472 return 0;
473}
474
Harald Welte3af1db82015-09-11 17:03:16 +0200475static int hnbgw_rx_err_ind(struct hnb_context *hnb, ANY_t *in)
476{
477 ErrorIndicationIEs_t ies;
478 int rc;
479
Harald Welte1d2c39d2015-09-11 17:49:37 +0200480 rc = hnbap_decode_errorindicationies(&ies, in);
Harald Welte3af1db82015-09-11 17:03:16 +0200481 if (rc < 0)
482 return rc;
483
Daniel Willmannbded9842015-12-17 11:51:17 +0100484 LOGP(DHNBAP, LOGL_NOTICE, "HNBAP ERROR.ind, cause: %s\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200485 hnbap_cause_str(&ies.cause));
486
Daniel Willmannd10002c2016-01-07 12:27:41 +0100487 hnbap_free_errorindicationies(&ies);
Harald Welte3af1db82015-09-11 17:03:16 +0200488 return 0;
489}
490
Harald Welte27f9c4a2015-08-30 22:47:18 +0200491static int hnbgw_rx_initiating_msg(struct hnb_context *hnb, InitiatingMessage_t *imsg)
Harald Welteba43de42015-08-29 20:33:16 +0200492{
Harald Welteda86fe52017-11-21 08:14:37 +0100493 int rc = 0;
Harald Welteba43de42015-08-29 20:33:16 +0200494
Harald Welteb3dae302015-08-30 12:20:09 +0200495 switch (imsg->procedureCode) {
Harald Welte27f9c4a2015-08-30 22:47:18 +0200496 case ProcedureCode_id_HNBRegister: /* 8.2 */
497 rc = hnbgw_rx_hnb_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200498 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200499 case ProcedureCode_id_HNBDe_Register: /* 8.3 */
Daniel Willmannb433b972016-01-06 18:08:21 +0100500 rc = hnbgw_rx_hnb_deregister(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200501 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200502 case ProcedureCode_id_UERegister: /* 8.4 */
503 rc = hnbgw_rx_ue_register_req(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200504 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200505 case ProcedureCode_id_UEDe_Register: /* 8.5 */
Daniel Willmannefceb182015-12-15 20:30:12 +0100506 rc = hnbgw_rx_ue_deregister(hnb, &imsg->value);
Harald Welteba43de42015-08-29 20:33:16 +0200507 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200508 case ProcedureCode_id_ErrorIndication: /* 8.6 */
Harald Welte3af1db82015-09-11 17:03:16 +0200509 rc = hnbgw_rx_err_ind(hnb, &imsg->value);
510 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200511 case ProcedureCode_id_TNLUpdate: /* 8.9 */
512 case ProcedureCode_id_HNBConfigTransfer: /* 8.10 */
513 case ProcedureCode_id_RelocationComplete: /* 8.11 */
514 case ProcedureCode_id_U_RNTIQuery: /* 8.12 */
515 case ProcedureCode_id_privateMessage:
Daniel Willmannbded9842015-12-17 11:51:17 +0100516 LOGP(DHNBAP, LOGL_NOTICE, "Unimplemented HNBAP Procedure %ld\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200517 imsg->procedureCode);
Harald Welteba43de42015-08-29 20:33:16 +0200518 break;
519 default:
Daniel Willmannbded9842015-12-17 11:51:17 +0100520 LOGP(DHNBAP, LOGL_NOTICE, "Unknown HNBAP Procedure %ld\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200521 imsg->procedureCode);
Harald Welteba43de42015-08-29 20:33:16 +0200522 break;
523 }
Harald Welteda86fe52017-11-21 08:14:37 +0100524
525 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200526}
527
Harald Welte27f9c4a2015-08-30 22:47:18 +0200528static int hnbgw_rx_successful_outcome_msg(struct hnb_context *hnb, SuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200529{
Neels Hofmeyr02296af2018-01-15 23:30:06 +0100530 /* We don't care much about HNBAP */
531 return 0;
Harald Welteba43de42015-08-29 20:33:16 +0200532}
533
Harald Welte27f9c4a2015-08-30 22:47:18 +0200534static int hnbgw_rx_unsuccessful_outcome_msg(struct hnb_context *hnb, UnsuccessfulOutcome_t *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200535{
Neels Hofmeyr02296af2018-01-15 23:30:06 +0100536 /* We don't care much about HNBAP */
Neels Hofmeyr8a2b6e22018-01-15 23:34:37 +0100537 LOGP(DHNBAP, LOGL_ERROR, "Received Unsuccessful Outcome, procedureCode %ld, criticality %ld,"
538 " from '%s', cell mcc %u mnc %u lac %u rac %u sac %u cid %u\n",
539 msg->procedureCode, msg->criticality, hnb->identity_info,
540 hnb->id.mcc, hnb->id.mnc, hnb->id.lac, hnb->id.rac, hnb->id.sac, hnb->id.cid);
Neels Hofmeyr02296af2018-01-15 23:30:06 +0100541 return 0;
Harald Welteba43de42015-08-29 20:33:16 +0200542}
543
544
Harald Welte27f9c4a2015-08-30 22:47:18 +0200545static int _hnbgw_hnbap_rx(struct hnb_context *hnb, HNBAP_PDU_t *pdu)
Harald Welteba43de42015-08-29 20:33:16 +0200546{
Daniel Willmann5f810f42015-12-17 17:57:51 +0100547 int rc = 0;
Harald Welteb3dae302015-08-30 12:20:09 +0200548
Harald Welteba43de42015-08-29 20:33:16 +0200549 /* it's a bit odd that we can't dispatch on procedure code, but
550 * that's not possible */
Harald Welte27f9c4a2015-08-30 22:47:18 +0200551 switch (pdu->present) {
552 case HNBAP_PDU_PR_initiatingMessage:
553 rc = hnbgw_rx_initiating_msg(hnb, &pdu->choice.initiatingMessage);
Harald Welteba43de42015-08-29 20:33:16 +0200554 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200555 case HNBAP_PDU_PR_successfulOutcome:
556 rc = hnbgw_rx_successful_outcome_msg(hnb, &pdu->choice.successfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200557 break;
Harald Welte27f9c4a2015-08-30 22:47:18 +0200558 case HNBAP_PDU_PR_unsuccessfulOutcome:
559 rc = hnbgw_rx_unsuccessful_outcome_msg(hnb, &pdu->choice.unsuccessfulOutcome);
Harald Welteba43de42015-08-29 20:33:16 +0200560 break;
561 default:
Daniel Willmannbded9842015-12-17 11:51:17 +0100562 LOGP(DHNBAP, LOGL_NOTICE, "Unknown HNBAP Presence %u\n",
Harald Welte3af1db82015-09-11 17:03:16 +0200563 pdu->present);
Daniel Willmann5f810f42015-12-17 17:57:51 +0100564 rc = -1;
Harald Welteba43de42015-08-29 20:33:16 +0200565 }
Daniel Willmann5f810f42015-12-17 17:57:51 +0100566
567 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200568}
569
Harald Weltea2e6a7a2015-08-29 21:47:39 +0200570int hnbgw_hnbap_rx(struct hnb_context *hnb, struct msgb *msg)
Harald Welteba43de42015-08-29 20:33:16 +0200571{
Harald Welte27f9c4a2015-08-30 22:47:18 +0200572 HNBAP_PDU_t _pdu, *pdu = &_pdu;
573 asn_dec_rval_t dec_ret;
Harald Welteee77cff2015-08-30 16:57:53 +0200574 int rc;
575
576 /* decode and handle to _hnbgw_hnbap_rx() */
577
Harald Welte2204f9d2015-09-07 21:10:50 +0200578 memset(pdu, 0, sizeof(*pdu));
Harald Welte27f9c4a2015-08-30 22:47:18 +0200579 dec_ret = aper_decode(NULL, &asn_DEF_HNBAP_PDU, (void **) &pdu,
580 msg->data, msgb_length(msg), 0, 0);
581 if (dec_ret.code != RC_OK) {
Daniel Willmannbded9842015-12-17 11:51:17 +0100582 LOGP(DHNBAP, LOGL_ERROR, "Error in ASN.1 decode\n");
Neels Hofmeyra6a68e62016-11-25 13:21:02 +0100583 return -1;
Harald Welteee77cff2015-08-30 16:57:53 +0200584 }
585
586 rc = _hnbgw_hnbap_rx(hnb, pdu);
Harald Welteee77cff2015-08-30 16:57:53 +0200587
Daniel Willmann59d17d82015-12-17 17:56:56 +0100588 ASN_STRUCT_FREE_CONTENTS_ONLY(asn_DEF_HNBAP_PDU, pdu);
589
Harald Welteee77cff2015-08-30 16:57:53 +0200590 return rc;
Harald Welteba43de42015-08-29 20:33:16 +0200591}
592
593
594int hnbgw_hnbap_init(void)
595{
Harald Welteda86fe52017-11-21 08:14:37 +0100596 return 0;
Harald Welteba43de42015-08-29 20:33:16 +0200597}