blob: d612e40ea3edf53fbb06fafa4ea3db011327a8e9 [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Mobile Radio Interface Layer 3 messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 04.08 version 7.21.0 Release 1998 / ETSI TS 100 940 V7.21.0 */
3
Harald Welte2483f1b2016-06-19 18:06:02 +02004/* (C) 2008-2016 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01005 * (C) 2008-2012 by Holger Hans Peter Freyther <zecke@selfish.org>
Harald Welte8470bf22008-12-25 23:28:35 +00006 *
Harald Welte52b1f982008-12-23 20:25:15 +00007 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +010010 * it under the terms of the GNU Affero General Public License as published by
11 * the Free Software Foundation; either version 3 of the License, or
Harald Welte52b1f982008-12-23 20:25:15 +000012 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010017 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000018 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010019 * You should have received a copy of the GNU Affero General Public License
20 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte52b1f982008-12-23 20:25:15 +000021 *
22 */
23
24
25#include <stdio.h>
26#include <stdlib.h>
27#include <string.h>
Maxddee01f2016-05-24 14:23:27 +020028#include <stdbool.h>
Harald Welte52b1f982008-12-23 20:25:15 +000029#include <errno.h>
Harald Weltedb253af2008-12-30 17:56:55 +000030#include <time.h>
Harald Welte4b634542008-12-27 01:55:51 +000031#include <netinet/in.h>
Maxddee01f2016-05-24 14:23:27 +020032#include <sys/types.h>
Harald Welte52b1f982008-12-23 20:25:15 +000033
Neels Hofmeyr4ac80092019-03-04 02:46:37 +010034#include "config.h"
Harald Welte9c3dc902012-04-08 16:59:24 +020035
Neels Hofmeyr90843962017-09-04 15:04:35 +020036#include <osmocom/msc/debug.h>
37#include <osmocom/msc/gsm_data.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020038#include <osmocom/msc/gsm_04_08.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020039#include <osmocom/msc/signal.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020040#include <osmocom/msc/transaction.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020041#include <osmocom/msc/vlr.h>
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010042#include <osmocom/msc/msc_a.h>
Holger Hans Peter Freyther841c2002010-09-30 18:52:23 +080043
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010044#include <osmocom/gsm/gsm48.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010045#include <osmocom/gsm/gsm_utils.h>
Max8db12e42016-04-18 23:11:18 +020046#include <osmocom/gsm/protocol/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010047#include <osmocom/core/msgb.h>
48#include <osmocom/core/talloc.h>
Neels Hofmeyr93bafb62017-01-13 03:12:08 +010049#include <osmocom/core/utils.h>
Philipp Maier621ba032017-11-07 17:19:25 +010050#include <osmocom/core/byteswap.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010051#include <osmocom/gsm/tlv.h>
Neels Hofmeyr84da6b12016-05-20 21:59:55 +020052#include <osmocom/crypt/auth.h>
Harald Welte52b1f982008-12-23 20:25:15 +000053
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010054#include <osmocom/msc/msub.h>
55#include <osmocom/msc/msc_roles.h>
Philipp Maierfbf66102017-04-09 12:32:51 +020056
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +020057#include <assert.h>
58
Neels Hofmeyre2f24d52017-05-08 15:12:20 +020059
Harald Welte (local)d19e58b2009-08-15 02:30:58 +020060void *tall_locop_ctx;
Sylvain Munaut30a15382009-12-24 00:27:26 +010061void *tall_authciphop_ctx;
Harald Welte2cf161b2009-06-20 22:36:41 +020062
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010063static int gsm0408_loc_upd_acc(struct msc_a *msc_a, uint32_t send_tmsi);
Harald Welte65e74cc2008-12-29 01:55:35 +000064
Harald Welte27989d42018-06-21 20:39:20 +020065/*! Send a simple GSM 04.08 message without any payload
Neels Hofmeyrc036b792018-11-29 22:37:51 +010066 * \param conn Active RAN connection
Harald Welte27989d42018-06-21 20:39:20 +020067 * \param[in] pdisc Protocol discriminator
68 * \param[in] msg_type Message type
69 * \return result of \ref gsm48_conn_sendmsg
70 */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010071int gsm48_tx_simple(struct msc_a *msc_a, uint8_t pdisc, uint8_t msg_type)
Harald Welte27989d42018-06-21 20:39:20 +020072{
73 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 TX SIMPLE");
74 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
75
76 gh->proto_discr = pdisc;
77 gh->msg_type = msg_type;
78
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010079 return msc_a_tx_dtap_to_i(msc_a, msg);
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080080}
Sylvain Munaut30a15382009-12-24 00:27:26 +010081
Harald Welte2483f1b2016-06-19 18:06:02 +020082/* clear all transactions globally; used in case of MNCC socket disconnect */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010083void gsm0408_clear_all_trans(struct gsm_network *net, enum trans_type type)
Harald Welte371efe52010-12-22 23:17:50 +010084{
85 struct gsm_trans *trans, *temp;
86
87 LOGP(DCC, LOGL_NOTICE, "Clearing all currently active transactions!!!\n");
88
89 llist_for_each_entry_safe(trans, temp, &net->trans_list, entry) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010090 if (trans->type == type) {
Harald Welteeb76c7a2010-12-23 02:47:53 +010091 trans->callref = 0;
Harald Welte371efe52010-12-22 23:17:50 +010092 trans_free(trans);
Harald Welteeb76c7a2010-12-23 02:47:53 +010093 }
Harald Welte371efe52010-12-22 23:17:50 +010094 }
95}
96
Holger Freyther429e7762008-12-30 13:28:30 +000097/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +010098static int gsm0408_loc_upd_rej(struct msc_a *msc_a, uint8_t cause)
Harald Welte52b1f982008-12-23 20:25:15 +000099{
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800100 struct msgb *msg;
101
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800102 msg = gsm48_create_loc_upd_rej(cause);
103 if (!msg) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100104 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "Failed to create msg for LOCATION UPDATING REJECT.\n");
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800105 return -1;
106 }
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200107
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100108 LOG_MSC_A_CAT(msc_a, DMM, LOGL_INFO, "LOCATION UPDATING REJECT\n");
Harald Welte24ff6ee2009-12-22 00:41:05 +0100109
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100110 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000111}
112
113/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100114static int gsm0408_loc_upd_acc(struct msc_a *msc_a, uint32_t send_tmsi)
Harald Welte52b1f982008-12-23 20:25:15 +0000115{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100116 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 LOC UPD ACC");
Harald Welte52b1f982008-12-23 20:25:15 +0000117 struct gsm48_hdr *gh;
118 struct gsm48_loc_area_id *lai;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200119 uint8_t *mid;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100120 struct gsm_network *net = msc_a_net(msc_a);
121 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100122 struct osmo_location_area_id laid = {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100123 .plmn = net->plmn,
124 .lac = vsub->cgi.lai.lac,
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100125 };
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200126
Harald Welte52b1f982008-12-23 20:25:15 +0000127 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
128 gh->proto_discr = GSM48_PDISC_MM;
129 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
130
131 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100132 gsm48_generate_lai2(lai, &laid);
Harald Welte52b1f982008-12-23 20:25:15 +0000133
Harald Welte2483f1b2016-06-19 18:06:02 +0200134 if (send_tmsi == GSM_RESERVED_TMSI) {
135 /* we did not allocate a TMSI to the MS, so we need to
136 * include the IMSI in order for the MS to delete any
137 * old TMSI that might still be allocated */
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200138 uint8_t mi[10];
139 int len;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100140 len = gsm48_generate_mid_from_imsi(mi, vsub->imsi);
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200141 mid = msgb_put(msg, len);
142 memcpy(mid, mi, len);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200143 DEBUGP(DMM, "-> %s LOCATION UPDATE ACCEPT\n",
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100144 vlr_subscr_name(vsub));
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200145 } else {
Harald Welte2483f1b2016-06-19 18:06:02 +0200146 /* Include the TMSI, which means that the MS will send a
147 * TMSI REALLOCATION COMPLETE, and we should wait for
148 * that until T3250 expiration */
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200149 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
Harald Welte2483f1b2016-06-19 18:06:02 +0200150 gsm48_generate_mid_from_tmsi(mid, send_tmsi);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200151 DEBUGP(DMM, "-> %s LOCATION UPDATE ACCEPT (TMSI = 0x%08x)\n",
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100152 vlr_subscr_name(vsub),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200153 send_tmsi);
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200154 }
Harald Welte2483f1b2016-06-19 18:06:02 +0200155 /* TODO: Follow-on proceed */
156 /* TODO: CTS permission */
157 /* TODO: Equivalent PLMNs */
158 /* TODO: Emergency Number List */
159 /* TODO: Per-MS T3312 */
Harald Welte52b1f982008-12-23 20:25:15 +0000160
Harald Welte52b1f982008-12-23 20:25:15 +0000161
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100162 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000163}
164
Harald Weltebf5e8df2009-02-03 12:59:45 +0000165/* Transmit Chapter 9.2.10 Identity Request */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100166static int mm_tx_identity_req(struct msc_a *msc_a, uint8_t id_type)
Harald Welte231ad4f2008-12-27 11:15:38 +0000167{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100168 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 ID REQ");
Harald Welte231ad4f2008-12-27 11:15:38 +0000169 struct gsm48_hdr *gh;
Harald Weltefc977a82008-12-27 10:19:37 +0000170
Harald Welte231ad4f2008-12-27 11:15:38 +0000171 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
172 gh->proto_discr = GSM48_PDISC_MM;
173 gh->msg_type = GSM48_MT_MM_ID_REQ;
174 gh->data[0] = id_type;
175
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100176 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +0000177}
178
Harald Weltebf5e8df2009-02-03 12:59:45 +0000179/* Parse Chapter 9.2.11 Identity Response */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100180static int mm_rx_id_resp(struct msc_a *msc_a, struct msgb *msg)
Harald Welte231ad4f2008-12-27 11:15:38 +0000181{
182 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyrb62289a2019-01-11 00:04:32 +0100183 uint8_t *mi = gh->data+1;
184 uint8_t mi_len = gh->data[0];
Vadim Yanitskiya79aac02019-12-28 01:19:19 +0100185 uint8_t mi_type;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100186 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
Harald Welte231ad4f2008-12-27 11:15:38 +0000187
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100188 if (!vsub) {
Harald Welte2483f1b2016-06-19 18:06:02 +0200189 LOGP(DMM, LOGL_ERROR,
190 "Rx MM Identity Response: invalid: no subscriber\n");
191 return -EINVAL;
192 }
193
Vadim Yanitskiya79aac02019-12-28 01:19:19 +0100194 /* There muct be at least one octet with MI type */
195 if (!mi_len) {
196 LOGP(DMM, LOGL_NOTICE, "MM Identity Response contains "
197 "malformed Mobile Identity\n");
198 return -EINVAL;
199 }
200
201 /* Make sure we got what we expected */
202 mi_type = mi[0] & GSM_MI_TYPE_MASK;
203 if (mi_type == GSM_MI_TYPE_NONE) {
204 LOGP(DMM, LOGL_NOTICE, "MM Identity Response contains no identity, "
205 "perhaps the MS has no Mobile Identity type %s?\n",
206 gsm48_mi_type_name(msc_a->mm_id_req_type));
207 return -EINVAL;
208 } else if (mi_type != msc_a->mm_id_req_type) {
209 LOGP(DMM, LOGL_NOTICE, "MM Identity Response contains unexpected "
210 "Mobile Identity type %s (extected %s)\n",
211 gsm48_mi_type_name(mi_type),
212 gsm48_mi_type_name(msc_a->mm_id_req_type));
213 return -EINVAL;
214 }
215
Neels Hofmeyrb62289a2019-01-11 00:04:32 +0100216 DEBUGP(DMM, "IDENTITY RESPONSE: MI=%s\n", osmo_mi_name(mi, mi_len));
Harald Welte231ad4f2008-12-27 11:15:38 +0000217
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200218 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
Harald Welte7659de12009-12-13 12:39:18 +0100219
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100220 return vlr_subscr_rx_id_resp(vsub, mi, mi_len);
221}
222
223/* 9.2.5 CM service accept */
224static int msc_gsm48_tx_mm_serv_ack(struct msc_a *msc_a)
225{
226 struct msgb *msg;
227 struct gsm48_hdr *gh;
228
229 msg = gsm48_msgb_alloc_name("GSM 04.08 SERV ACC");
230
231 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
232 gh->proto_discr = GSM48_PDISC_MM;
233 gh->msg_type = GSM48_MT_MM_CM_SERV_ACC;
234
235 return msc_a_tx_dtap_to_i(msc_a, msg);
236}
237
238/* 9.2.6 CM service reject */
239static int msc_gsm48_tx_mm_serv_rej(struct msc_a *msc_a,
240 enum gsm48_reject_value value)
241{
242 struct msgb *msg;
243
244 msg = gsm48_create_mm_serv_rej(value);
245 if (!msg) {
246 LOGP(DMM, LOGL_ERROR, "Failed to allocate CM Service Reject.\n");
247 return -1;
248 }
249
250 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "-> CM SERVICE Reject cause: %d\n", value);
251
252 return msc_a_tx_dtap_to_i(msc_a, msg);
253}
254
255
256/* Extract the R99 flag from various Complete Level 3 messages. Depending on the Message Type, extract R99 from the
257 * Classmark Type 1 or the Classmark Type 2. Return 1 for R99, 0 for pre-R99, negative if not a valid Complete Level 3
258 * message. */
259int compl_l3_msg_is_r99(const struct msgb *msg)
260{
261 const struct gsm48_hdr *gh = msgb_l3(msg);
262 uint8_t pdisc = gsm48_hdr_pdisc(gh);
263 const struct gsm48_loc_upd_req *lu;
264 const struct gsm48_imsi_detach_ind *idi;
265 uint8_t cm2_len;
266 const struct gsm48_classmark2 *cm2;
267
268 switch (pdisc) {
269 case GSM48_PDISC_MM:
270 switch (gsm48_hdr_msg_type(gh)) {
271 case GSM48_MT_MM_LOC_UPD_REQUEST:
272 lu = (const struct gsm48_loc_upd_req *) gh->data;
273 return osmo_gsm48_classmark1_is_r99(&lu->classmark1) ? 1 : 0;
274
275 case GSM48_MT_MM_CM_SERV_REQ:
276 case GSM48_MT_MM_CM_REEST_REQ:
277 break;
278
279 case GSM48_MT_MM_IMSI_DETACH_IND:
280 idi = (const struct gsm48_imsi_detach_ind *) gh->data;
281 return osmo_gsm48_classmark1_is_r99(&idi->classmark1) ? 1 : 0;
282
283 default:
284 return -1;
285 }
286 break;
287
288 case GSM48_PDISC_RR:
289 switch (gsm48_hdr_msg_type(gh)) {
290 case GSM48_MT_RR_PAG_RESP:
291 break;
292
293 default:
294 return -1;
295 }
296 break;
297
298 default:
299 return -1;
300 }
301
302 /* Both CM Service Request and Paging Response have Classmark Type 2 at the same location: */
303 cm2_len = gh->data[1];
304 cm2 = (void*)gh->data+2;
305 return osmo_gsm48_classmark2_is_r99(cm2, cm2_len) ? 1 : 0;
Harald Welte231ad4f2008-12-27 11:15:38 +0000306}
307
Harald Welte2483f1b2016-06-19 18:06:02 +0200308/* Chapter 9.2.15: Receive Location Updating Request.
309 * Keep this function non-static for direct invocation by unit tests. */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100310static int mm_rx_loc_upd_req(struct msc_a *msc_a, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +0000311{
Harald Welte8470bf22008-12-25 23:28:35 +0000312 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000313 struct gsm48_loc_upd_req *lu;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200314 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200315 char mi_string[GSM48_MI_SIZE];
Harald Welte2483f1b2016-06-19 18:06:02 +0200316 enum vlr_lu_type vlr_lu_type = VLR_LU_TYPE_REGULAR;
Harald Welte2483f1b2016-06-19 18:06:02 +0200317 uint32_t tmsi;
318 char *imsi;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100319 struct osmo_location_area_id old_lai;
Harald Welte2483f1b2016-06-19 18:06:02 +0200320 struct osmo_fsm_inst *lu_fsm;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200321 bool is_utran;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100322 struct gsm_network *net = msc_a_net(msc_a);
323 struct vlr_subscr *vsub;
Harald Welte52b1f982008-12-23 20:25:15 +0000324
Harald Welte8470bf22008-12-25 23:28:35 +0000325 lu = (struct gsm48_loc_upd_req *) gh->data;
326
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100327 if (msc_a_is_establishing_auth_ciph(msc_a)) {
328 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR,
329 "Cannot accept another LU, conn already busy establishing authenticity;"
330 " extraneous LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
331 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200332 return -EINVAL;
333 }
334
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100335 if (msc_a_is_accepted(msc_a)) {
336 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR,
337 "Cannot accept another LU, conn already established;"
338 " extraneous LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
339 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200340 return -EINVAL;
341 }
Harald Welte2483f1b2016-06-19 18:06:02 +0200342
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100343 msc_a->complete_layer3_type = COMPLETE_LAYER3_LU;
344 msub_update_id_from_mi(msc_a->c.msub, lu->mi, lu->mi_len);
Neels Hofmeyr16c42b52018-04-02 12:26:16 +0200345
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100346 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
347 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Holger Freyther73487a22008-12-31 18:53:57 +0000348
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200349 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
Harald Welte7659de12009-12-13 12:39:18 +0100350
Harald Welte24ff6ee2009-12-22 00:41:05 +0100351 switch (lu->type) {
352 case GSM48_LUPD_NORMAL:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100353 rate_ctr_inc(&net->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_NORMAL]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200354 vlr_lu_type = VLR_LU_TYPE_REGULAR;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100355 break;
356 case GSM48_LUPD_IMSI_ATT:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100357 rate_ctr_inc(&net->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_ATTACH]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200358 vlr_lu_type = VLR_LU_TYPE_IMSI_ATTACH;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100359 break;
360 case GSM48_LUPD_PERIODIC:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100361 rate_ctr_inc(&net->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_PERIODIC]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200362 vlr_lu_type = VLR_LU_TYPE_PERIODIC;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100363 break;
364 }
365
Harald Welte2483f1b2016-06-19 18:06:02 +0200366 /* TODO: 10.5.1.6 MS Classmark for UMTS / Classmark 2 */
Martin Hauke3f07dac2019-11-14 17:49:08 +0100367 /* TODO: 10.5.3.14 Additional update parameters (CS fallback calls) */
Harald Welte2483f1b2016-06-19 18:06:02 +0200368 /* TODO: 10.5.7.8 Device properties */
369 /* TODO: 10.5.1.15 MS network feature support */
Sylvain Munaut2030a2a2010-06-10 13:36:59 +0200370
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100371 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
372 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Welte52b1f982008-12-23 20:25:15 +0000373 switch (mi_type) {
374 case GSM_MI_TYPE_IMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200375 tmsi = GSM_RESERVED_TMSI;
376 imsi = mi_string;
Harald Welte4b634542008-12-27 01:55:51 +0000377 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000378 case GSM_MI_TYPE_TMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200379 tmsi = tmsi_from_string(mi_string);
380 imsi = NULL;
Harald Welte52b1f982008-12-23 20:25:15 +0000381 break;
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200382 default:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100383 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "unknown mobile identity type\n");
Harald Welte2483f1b2016-06-19 18:06:02 +0200384 tmsi = GSM_RESERVED_TMSI;
385 imsi = NULL;
Harald Welte52b1f982008-12-23 20:25:15 +0000386 break;
387 }
388
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100389 gsm48_decode_lai2(&lu->lai, &old_lai);
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100390 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "USIM: old LAI: %s\n", osmo_lai_name(&old_lai));
Harald Welte24516ea2009-07-04 10:18:00 +0200391
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100392 msc_a_get(msc_a, __func__);
393 msc_a_get(msc_a, MSC_A_USE_LOCATION_UPDATING);
394
395 is_utran = (msc_a->c.ran->type == OSMO_RAT_UTRAN_IU);
396 lu_fsm = vlr_loc_update(msc_a->c.fi,
397 MSC_A_EV_AUTHENTICATED, MSC_A_EV_CN_CLOSE, NULL,
398 net->vlr, msc_a, vlr_lu_type, tmsi, imsi,
399 &old_lai, &msc_a->via_cell.lai,
400 is_utran || net->authentication_required,
Neels Hofmeyr4dfb2ba2019-08-13 16:00:37 +0200401 is_utran ? net->uea_encryption : net->a5_encryption_mask > 0x01,
Sylvain Munautda9f37e2019-03-14 11:02:36 +0100402 lu->key_seq,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100403 osmo_gsm48_classmark1_is_r99(&lu->classmark1),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200404 is_utran,
Harald Welte2483f1b2016-06-19 18:06:02 +0200405 net->vlr->cfg.assign_tmsi);
406 if (!lu_fsm) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100407 LOG_MSC_A(msc_a, LOGL_ERROR, "Can't start LU FSM\n");
408 msc_a_put(msc_a, MSC_A_USE_LOCATION_UPDATING);
409 msc_a_put(msc_a, __func__);
Harald Welte2483f1b2016-06-19 18:06:02 +0200410 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800411 }
412
Harald Welte2483f1b2016-06-19 18:06:02 +0200413 /* From vlr_loc_update() we expect an implicit dispatch of
414 * VLR_ULA_E_UPDATE_LA, and thus we expect msc_vlr_subscr_assoc() to
Thorsten Alteholz3a357de2019-07-16 20:51:16 +0200415 * already have been called and completed. Has an error occurred? */
Harald Welte255539c2008-12-28 02:26:27 +0000416
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100417 vsub = msc_a_vsub(msc_a);
418 if (!vsub) {
419 msc_a_put(msc_a, __func__);
420 return 0;
421 }
422
423 if (vsub->lu_fsm != lu_fsm) {
424 LOG_MSC_A(msc_a, LOGL_ERROR, "Internal Error during Location Updating attempt\n");
425 msc_a_release_cn(msc_a);
426 msc_a_put(msc_a, __func__);
Harald Welte2483f1b2016-06-19 18:06:02 +0200427 return -EIO;
428 }
429
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100430 vsub->classmark.classmark1 = lu->classmark1;
431 vsub->classmark.classmark1_set = true;
432 msc_a_put(msc_a, __func__);
Harald Welte2483f1b2016-06-19 18:06:02 +0200433 return 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000434}
435
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100436/* Turn int into semi-octet representation: 98 => 0x89 */
Harald Welte2483f1b2016-06-19 18:06:02 +0200437/* FIXME: libosmocore/libosmogsm */
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100438static uint8_t bcdify(uint8_t value)
Harald Welte4bfdfe72009-06-10 23:11:52 +0800439{
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100440 uint8_t ret;
441
442 ret = value / 10;
443 ret |= (value % 10) << 4;
444
445 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800446}
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100447
Harald Welte0df904d2018-12-03 11:00:04 +0100448/* Generate a message buffer that contains a valid MM info message,
449 * See also 3GPP TS 24.008, chapter 9.2.15a */
450struct msgb *gsm48_create_mm_info(struct gsm_network *net)
Harald Weltedb253af2008-12-30 17:56:55 +0000451{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100452 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 MM INF");
Harald Weltedb253af2008-12-30 17:56:55 +0000453 struct gsm48_hdr *gh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200454 uint8_t *ptr8;
Daniel Willmanneea93372009-08-13 03:42:07 +0200455 int name_len, name_pad;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100456
Harald Welte4bfdfe72009-06-10 23:11:52 +0800457 time_t cur_t;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100458 struct tm* gmt_time;
459 struct tm* local_time;
460 int tzunits;
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100461 int dst = 0;
Harald Weltedb253af2008-12-30 17:56:55 +0000462
Harald Weltedb253af2008-12-30 17:56:55 +0000463 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
464 gh->proto_discr = GSM48_PDISC_MM;
465 gh->msg_type = GSM48_MT_MM_INFO;
466
467 if (net->name_long) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200468#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000469 name_len = strlen(net->name_long);
470 /* 10.5.3.5a */
471 ptr8 = msgb_put(msg, 3);
472 ptr8[0] = GSM48_IE_NAME_LONG;
473 ptr8[1] = name_len*2 +1;
474 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
475
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200476 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000477 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000478 ptr16[i] = htons(net->name_long[i]);
Harald Weltedb253af2008-12-30 17:56:55 +0000479
480 /* FIXME: Use Cell Broadcast, not UCS-2, since
481 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmanneea93372009-08-13 03:42:07 +0200482#endif
483 name_len = (strlen(net->name_long)*7)/8;
484 name_pad = (8 - strlen(net->name_long)*7)%8;
485 if (name_pad > 0)
486 name_len++;
487 /* 10.5.3.5a */
488 ptr8 = msgb_put(msg, 3);
489 ptr8[0] = GSM48_IE_NAME_LONG;
490 ptr8[1] = name_len +1;
491 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
492
493 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100494 gsm_7bit_encode_n(ptr8, name_len, net->name_long, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200495
Harald Weltedb253af2008-12-30 17:56:55 +0000496 }
497
498 if (net->name_short) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200499#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000500 name_len = strlen(net->name_short);
501 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200502 ptr8 = (uint8_t *) msgb_put(msg, 3);
Harald Welte7543eb72009-07-19 17:51:36 +0200503 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Weltedb253af2008-12-30 17:56:55 +0000504 ptr8[1] = name_len*2 + 1;
505 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
506
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200507 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000508 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000509 ptr16[i] = htons(net->name_short[i]);
Daniel Willmanneea93372009-08-13 03:42:07 +0200510#endif
511 name_len = (strlen(net->name_short)*7)/8;
512 name_pad = (8 - strlen(net->name_short)*7)%8;
513 if (name_pad > 0)
514 name_len++;
515 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200516 ptr8 = (uint8_t *) msgb_put(msg, 3);
Daniel Willmanneea93372009-08-13 03:42:07 +0200517 ptr8[0] = GSM48_IE_NAME_SHORT;
518 ptr8[1] = name_len +1;
519 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
520
521 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100522 gsm_7bit_encode_n(ptr8, name_len, net->name_short, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200523
Harald Weltedb253af2008-12-30 17:56:55 +0000524 }
525
Harald Weltedb253af2008-12-30 17:56:55 +0000526 /* Section 10.5.3.9 */
527 cur_t = time(NULL);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100528 gmt_time = gmtime(&cur_t);
529
Harald Weltedb253af2008-12-30 17:56:55 +0000530 ptr8 = msgb_put(msg, 8);
531 ptr8[0] = GSM48_IE_NET_TIME_TZ;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100532 ptr8[1] = bcdify(gmt_time->tm_year % 100);
533 ptr8[2] = bcdify(gmt_time->tm_mon + 1);
534 ptr8[3] = bcdify(gmt_time->tm_mday);
535 ptr8[4] = bcdify(gmt_time->tm_hour);
536 ptr8[5] = bcdify(gmt_time->tm_min);
537 ptr8[6] = bcdify(gmt_time->tm_sec);
538
Neels Hofmeyr73983952016-05-10 13:29:33 +0200539 if (net->tz.override) {
Harald Welte45f91712012-07-08 16:48:11 +0200540 /* Convert tz.hr and tz.mn to units */
Neels Hofmeyr73983952016-05-10 13:29:33 +0200541 if (net->tz.hr < 0) {
542 tzunits = ((net->tz.hr/-1)*4);
543 tzunits = tzunits + (net->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100544 ptr8[7] = bcdify(tzunits);
545 /* Set negative time */
546 ptr8[7] |= 0x08;
547 }
548 else {
Neels Hofmeyr73983952016-05-10 13:29:33 +0200549 tzunits = net->tz.hr*4;
550 tzunits = tzunits + (net->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100551 ptr8[7] = bcdify(tzunits);
552 }
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100553 /* Convert DST value */
Neels Hofmeyr73983952016-05-10 13:29:33 +0200554 if (net->tz.dst >= 0 && net->tz.dst <= 2)
555 dst = net->tz.dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100556 }
557 else {
558 /* Need to get GSM offset and convert into 15 min units */
559 /* This probably breaks if gmtoff returns a value not evenly divisible by 15? */
Harald Welte9c3dc902012-04-08 16:59:24 +0200560#ifdef HAVE_TM_GMTOFF_IN_TM
Benoit Bolsee38bb3442017-07-05 12:57:16 +0200561 local_time = localtime(&cur_t);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100562 tzunits = (local_time->tm_gmtoff/60)/15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200563#else
Benoit Bolsee38bb3442017-07-05 12:57:16 +0200564 /* find timezone offset */
565 time_t utc;
566 double offsetFromUTC;
567 utc = mktime(gmt_time);
568 local_time = localtime(&cur_t);
569 offsetFromUTC = difftime(cur_t, utc);
570 if (local_time->tm_isdst)
571 offsetFromUTC += 3600.0;
572 tzunits = ((int)offsetFromUTC) / 60 / 15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200573#endif
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100574 if (tzunits < 0) {
575 tzunits = tzunits/-1;
576 ptr8[7] = bcdify(tzunits);
577 /* Flip it to negative */
578 ptr8[7] |= 0x08;
579 }
580 else
581 ptr8[7] = bcdify(tzunits);
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100582
583 /* Does not support DST +2 */
584 if (local_time->tm_isdst)
585 dst = 1;
586 }
587
588 if (dst) {
589 ptr8 = msgb_put(msg, 3);
590 ptr8[0] = GSM48_IE_NET_DST;
591 ptr8[1] = 1;
592 ptr8[2] = dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100593 }
Harald Weltedb253af2008-12-30 17:56:55 +0000594
Harald Welte0df904d2018-12-03 11:00:04 +0100595 return msg;
596}
Daniel Willmanneea93372009-08-13 03:42:07 +0200597
Harald Welte0df904d2018-12-03 11:00:04 +0100598/* Section 9.2.15a */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100599int gsm48_tx_mm_info(struct msc_a *msc_a)
Harald Welte0df904d2018-12-03 11:00:04 +0100600{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100601 struct gsm_network *net = msc_a_net(msc_a);
Harald Welte0df904d2018-12-03 11:00:04 +0100602 struct msgb *msg;
603
604 msg = gsm48_create_mm_info(net);
605
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100606 LOG_MSC_A(msc_a, LOGL_DEBUG, "Tx MM INFO\n");
607 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Weltedb253af2008-12-30 17:56:55 +0000608}
609
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100610/*! Send an Authentication Request to MS on the given RAN connection
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100611 * according to 3GPP/ETSI TS 24.008, Section 9.2.2.
612 * \param[in] conn Subscriber connection to send on.
613 * \param[in] rand Random challenge token to send, must be 16 bytes long.
614 * \param[in] autn r99: In case of UMTS mutual authentication, AUTN token to
615 * send; must be 16 bytes long, or pass NULL for plain GSM auth.
616 * \param[in] key_seq auth tuple's sequence number.
617 */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100618int gsm48_tx_mm_auth_req(struct msc_a *msc_a, uint8_t *rand,
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100619 uint8_t *autn, int key_seq)
Harald Welte7984d5c2009-08-12 22:56:50 +0200620{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100621 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 AUTH REQ");
Harald Welte7984d5c2009-08-12 22:56:50 +0200622 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut849f5542009-09-27 11:10:17 +0200623 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte7984d5c2009-08-12 22:56:50 +0200624
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100625 DEBUGP(DMM, "Tx AUTH REQ (rand = %s)\n", osmo_hexdump_nospc(rand, 16));
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100626 if (autn)
Neels Hofmeyr3355fd62017-02-14 17:42:25 +0100627 DEBUGP(DMM, " AUTH REQ (autn = %s)\n", osmo_hexdump_nospc(autn, 16));
Harald Welte7984d5c2009-08-12 22:56:50 +0200628
Harald Welte7984d5c2009-08-12 22:56:50 +0200629 gh->proto_discr = GSM48_PDISC_MM;
630 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
631
Sylvain Munautbd55a6d2009-12-24 00:23:46 +0100632 ar->key_seq = key_seq;
Sylvain Munaut849f5542009-09-27 11:10:17 +0200633
Harald Welte7984d5c2009-08-12 22:56:50 +0200634 /* 16 bytes RAND parameters */
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100635 osmo_static_assert(sizeof(ar->rand) == 16, sizeof_auth_req_r99_rand);
Harald Welte7984d5c2009-08-12 22:56:50 +0200636 if (rand)
Sylvain Munaut849f5542009-09-27 11:10:17 +0200637 memcpy(ar->rand, rand, 16);
Harald Welte7984d5c2009-08-12 22:56:50 +0200638
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100639
640 /* 16 bytes AUTN */
641 if (autn)
642 msgb_tlv_put(msg, GSM48_IE_AUTN, 16, autn);
643
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100644 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Welte7984d5c2009-08-12 22:56:50 +0200645}
646
647/* Section 9.2.1 */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100648int gsm48_tx_mm_auth_rej(struct msc_a *msc_a)
Harald Welte7984d5c2009-08-12 22:56:50 +0200649{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100650 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "-> AUTH REJECT\n");
651 return gsm48_tx_simple(msc_a, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
Harald Welte7984d5c2009-08-12 22:56:50 +0200652}
653
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100654static int msc_vlr_tx_cm_serv_rej(void *msc_conn_ref, enum osmo_cm_service_type cm_service_type,
655 enum gsm48_reject_value cause);
Harald Welte2483f1b2016-06-19 18:06:02 +0200656
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100657static int cm_serv_reuse_conn(struct msc_a *msc_a, const uint8_t *mi_lv, enum osmo_cm_service_type cm_serv_type)
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100658{
Harald Welte2483f1b2016-06-19 18:06:02 +0200659 uint8_t mi_type;
660 char mi_string[GSM48_MI_SIZE];
661 uint32_t tmsi;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100662 struct gsm_network *net = msc_a_net(msc_a);
663 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100664
Harald Welte2483f1b2016-06-19 18:06:02 +0200665 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi_lv+1, mi_lv[0]);
666 mi_type = mi_lv[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100667
Harald Welte2483f1b2016-06-19 18:06:02 +0200668 switch (mi_type) {
669 case GSM_MI_TYPE_IMSI:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100670 if (vlr_subscr_matches_imsi(vsub, mi_string))
Harald Welte2483f1b2016-06-19 18:06:02 +0200671 goto accept_reuse;
672 break;
673 case GSM_MI_TYPE_TMSI:
674 tmsi = osmo_load32be(mi_lv+2);
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100675 if (vlr_subscr_matches_tmsi(vsub, tmsi))
Harald Welte2483f1b2016-06-19 18:06:02 +0200676 goto accept_reuse;
677 break;
678 case GSM_MI_TYPE_IMEI:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100679 if (vlr_subscr_matches_imei(vsub, mi_string))
Harald Welte2483f1b2016-06-19 18:06:02 +0200680 goto accept_reuse;
681 break;
682 default:
683 break;
684 }
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100685
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100686 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "CM Service Request with mismatching mobile identity: %s %s\n",
687 gsm48_mi_type_name(mi_type), mi_string);
688 msc_vlr_tx_cm_serv_rej(msc_a, cm_serv_type, GSM48_REJECT_ILLEGAL_MS);
Harald Welte2483f1b2016-06-19 18:06:02 +0200689 return -EINVAL;
Sylvain Munautba87f452009-12-24 00:28:46 +0100690
Harald Welte2483f1b2016-06-19 18:06:02 +0200691accept_reuse:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100692 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "re-using already accepted connection\n");
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200693
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100694 msc_a_get(msc_a, msc_a_cm_service_type_to_use(cm_serv_type));
695 msub_update_id(msc_a->c.msub);
696 return net->vlr->ops.tx_cm_serv_acc(msc_a, cm_serv_type);
Sylvain Munautba87f452009-12-24 00:28:46 +0100697}
698
Harald Welte4ed0e922009-01-10 03:17:30 +0000699/*
700 * Handle CM Service Requests
701 * a) Verify that the packet is long enough to contain the information
Martin Hauke3f07dac2019-11-14 17:49:08 +0100702 * we require otherwise reject with INCORRECT_MESSAGE
Harald Welte4ed0e922009-01-10 03:17:30 +0000703 * b) Try to parse the TMSI. If we do not have one reject
704 * c) Check that we know the subscriber with the TMSI otherwise reject
705 * with a HLR cause
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200706 * d) Set the subscriber on the conn and accept
Harald Welte2483f1b2016-06-19 18:06:02 +0200707 *
708 * Keep this function non-static for direct invocation by unit tests.
Harald Welte4ed0e922009-01-10 03:17:30 +0000709 */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100710int gsm48_rx_mm_serv_req(struct msc_a *msc_a, struct msgb *msg)
Harald Welte4b634542008-12-27 01:55:51 +0000711{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100712 struct gsm_network *net = msc_a_net(msc_a);
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700713 struct gsm48_hdr *gh;
714 struct gsm48_service_request *req;
715 struct gsm48_classmark2 *cm2;
716 uint8_t *cm2_buf, cm2_len;
717 uint8_t *mi_buf, mi_len;
718 uint8_t *mi, mi_type;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200719 bool is_utran;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100720 struct vlr_subscr *vsub;
Harald Welteba4cf162009-01-10 01:49:35 +0000721
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700722 /* Make sure that both header and CM Service Request fit into the buffer */
723 if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*req)) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100724 LOG_MSC_A(msc_a, LOGL_ERROR, "Rx CM SERVICE REQUEST: wrong message size (%u < %zu)\n",
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700725 msgb_l3len(msg), sizeof(*gh) + sizeof(*req));
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100726 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000727 }
728
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700729 gh = (struct gsm48_hdr *) msgb_l3(msg);
730 req = (struct gsm48_service_request *) gh->data;
731
732 /* Unfortunately in Phase1 the Classmark2 length is variable, so we cannot
733 * just use gsm48_service_request struct, and need to parse it manually. */
734 cm2_len = gh->data[1];
735 cm2_buf = gh->data + 2;
736 cm2 = (struct gsm48_classmark2 *) cm2_buf;
737
738 /* Prevent buffer overrun: check the length of Classmark2 */
739 if (cm2_buf + cm2_len > msg->tail) {
740 LOG_MSC_A(msc_a, LOGL_ERROR, "Rx CM SERVICE REQUEST: Classmark2 "
741 "length=%u is too big\n", cm2_len);
742 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_INCORRECT_MESSAGE);
743 }
744
745 /* MI (Mobile Identity) LV follows the Classmark2 */
746 mi_buf = cm2_buf + cm2_len;
747 mi_len = mi_buf[0];
748 mi = mi_buf + 1;
749
750 /* Prevent buffer overrun: check the length of MI */
751 if (mi_buf + mi_len > msg->tail) {
752 LOG_MSC_A(msc_a, LOGL_ERROR, "Rx CM SERVICE REQUEST: Mobile Identity "
753 "length=%u is too big\n", cm2_len);
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100754 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000755 }
756
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100757 if (msc_a_is_establishing_auth_ciph(msc_a)) {
758 LOG_MSC_A(msc_a, LOGL_ERROR,
759 "Cannot accept CM Service Request, conn already busy establishing authenticity\n");
760 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_CONGESTION);
Neels Hofmeyr7ce21dc2019-01-04 17:42:05 +0100761 /* or should we accept and note down the service request anyway? */
762 }
763
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100764 msc_a->complete_layer3_type = COMPLETE_LAYER3_CM_SERVICE_REQ;
765 msub_update_id_from_mi(msc_a->c.msub, mi, mi_len);
766 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "Rx CM SERVICE REQUEST cm_service_type=%s\n",
767 osmo_cm_service_type_name(req->cm_service_type));
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100768
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100769 mi_type = (mi && mi_len) ? (mi[0] & GSM_MI_TYPE_MASK) : GSM_MI_TYPE_NONE;
Harald Welte3995d2e2018-01-24 11:23:54 +0100770 switch (mi_type) {
771 case GSM_MI_TYPE_IMSI:
772 case GSM_MI_TYPE_TMSI:
773 /* continue below */
774 break;
775 case GSM_MI_TYPE_IMEI:
776 if (req->cm_service_type == GSM48_CMSERV_EMERGENCY) {
777 /* We don't do emergency calls by IMEI */
Vadim Yanitskiy44560652019-05-09 21:05:41 +0700778 LOG_MSC_A(msc_a, LOGL_NOTICE, "Tx CM SERVICE REQUEST REJECT: "
779 "emergency services by IMEI are not supported\n");
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100780 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_IMEI_NOT_ACCEPTED);
Harald Welte3995d2e2018-01-24 11:23:54 +0100781 }
782 /* fall-through for non-emergency setup */
783 default:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100784 LOG_MSC_A(msc_a, LOGL_ERROR, "MI type is not expected: %s\n", gsm48_mi_type_name(mi_type));
785 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000786 }
787
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100788 if (!msc_a_cm_service_type_to_use(req->cm_service_type))
789 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_SRV_OPT_NOT_SUPPORTED);
Harald Welte37382ec2018-01-24 12:49:34 +0100790
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100791 if (msc_a_is_accepted(msc_a))
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700792 return cm_serv_reuse_conn(msc_a, mi_buf, req->cm_service_type);
Harald Welte2483f1b2016-06-19 18:06:02 +0200793
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700794 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, mi_buf);
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200795
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100796 msc_a_get(msc_a, msc_a_cm_service_type_to_use(req->cm_service_type));
797
798 is_utran = (msc_a->c.ran->type == OSMO_RAT_UTRAN_IU);
799 vlr_proc_acc_req(msc_a->c.fi,
800 MSC_A_EV_AUTHENTICATED, MSC_A_EV_CN_CLOSE, NULL,
801 net->vlr, msc_a,
802 VLR_PR_ARQ_T_CM_SERV_REQ,
803 req->cm_service_type,
804 mi-1, &msc_a->via_cell.lai,
805 is_utran || net->authentication_required,
Neels Hofmeyr4dfb2ba2019-08-13 16:00:37 +0200806 is_utran ? net->uea_encryption : net->a5_encryption_mask > 0x01,
Sylvain Munautda9f37e2019-03-14 11:02:36 +0100807 req->cipher_key_seq,
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700808 osmo_gsm48_classmark2_is_r99(cm2, cm2_len),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200809 is_utran);
Holger Freythereb443982009-06-04 13:58:42 +0000810
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200811 /* From vlr_proc_acc_req() we expect an implicit dispatch of PR_ARQ_E_START we expect
Thorsten Alteholz3a357de2019-07-16 20:51:16 +0200812 * msc_vlr_subscr_assoc() to already have been called and completed. Has an error occurred? */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100813 vsub = msc_a_vsub(msc_a);
814 if (!vsub) {
815 LOG_MSC_A(msc_a, LOGL_ERROR, "subscriber not allowed to do a CM Service Request\n");
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200816 return -EIO;
817 }
818
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100819 vsub->classmark.classmark2 = *cm2;
Vadim Yanitskiyb380a8c2019-05-08 16:11:29 +0700820 vsub->classmark.classmark2_len = cm2_len;
Harald Welte2483f1b2016-06-19 18:06:02 +0200821 return 0;
Harald Welte4b634542008-12-27 01:55:51 +0000822}
823
Harald Welte49f8fcb2018-01-24 21:40:19 +0100824/* Receive a CM Re-establish Request */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100825static int gsm48_rx_cm_reest_req(struct msc_a *msc_a, struct msgb *msg)
Harald Welte49f8fcb2018-01-24 21:40:19 +0100826{
827 uint8_t mi_type;
828 char mi_string[GSM48_MI_SIZE];
829 struct gsm48_hdr *gh = msgb_l3(msg);
830
831 uint8_t classmark2_len = gh->data[1];
832 uint8_t *classmark2 = gh->data+2;
833 uint8_t mi_len = *(classmark2 + classmark2_len);
834 uint8_t *mi = (classmark2 + classmark2_len + 1);
835
836 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
837 mi_type = mi[0] & GSM_MI_TYPE_MASK;
838 DEBUGP(DMM, "<- CM RE-ESTABLISH REQUEST MI(%s)=%s\n", gsm48_mi_type_name(mi_type), mi_string);
839
840 /* we don't support CM call re-establishment */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100841 return msc_gsm48_tx_mm_serv_rej(msc_a, GSM48_REJECT_SRV_OPT_NOT_SUPPORTED);
Harald Welte49f8fcb2018-01-24 21:40:19 +0100842}
843
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100844static int gsm48_rx_mm_imsi_detach_ind(struct msc_a *msc_a, struct msgb *msg)
Harald Welte2a139372009-02-22 21:14:55 +0000845{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100846 struct gsm_network *net = msc_a_net(msc_a);
Harald Welte2a139372009-02-22 21:14:55 +0000847 struct gsm48_hdr *gh = msgb_l3(msg);
848 struct gsm48_imsi_detach_ind *idi =
849 (struct gsm48_imsi_detach_ind *) gh->data;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200850 uint8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200851 char mi_string[GSM48_MI_SIZE];
Harald Welte2483f1b2016-06-19 18:06:02 +0200852 struct vlr_subscr *vsub = NULL;
Harald Welte2a139372009-02-22 21:14:55 +0000853
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200854 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Harald Welte2483f1b2016-06-19 18:06:02 +0200855 DEBUGP(DMM, "IMSI DETACH INDICATION: MI(%s)=%s\n",
856 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000857
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100858 rate_ctr_inc(&net->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_DETACH]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100859
Harald Welte2a139372009-02-22 21:14:55 +0000860 switch (mi_type) {
861 case GSM_MI_TYPE_TMSI:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100862 vsub = vlr_subscr_find_by_tmsi(net->vlr,
Neels Hofmeyr7c5346c2019-02-19 02:36:35 +0100863 tmsi_from_string(mi_string), __func__);
Harald Welte2a139372009-02-22 21:14:55 +0000864 break;
865 case GSM_MI_TYPE_IMSI:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100866 vsub = vlr_subscr_find_by_imsi(net->vlr, mi_string, __func__);
Harald Welte2a139372009-02-22 21:14:55 +0000867 break;
868 case GSM_MI_TYPE_IMEI:
869 case GSM_MI_TYPE_IMEISV:
870 /* no sim card... FIXME: what to do ? */
Harald Welte2483f1b2016-06-19 18:06:02 +0200871 LOGP(DMM, LOGL_ERROR, "MI(%s)=%s: unimplemented mobile identity type\n",
872 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000873 break;
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200874 default:
Harald Welte2483f1b2016-06-19 18:06:02 +0200875 LOGP(DMM, LOGL_ERROR, "MI(%s)=%s: unknown mobile identity type\n",
876 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000877 break;
878 }
879
Harald Welte2483f1b2016-06-19 18:06:02 +0200880 if (!vsub) {
881 LOGP(DMM, LOGL_ERROR, "IMSI DETACH for unknown subscriber MI(%s)=%s\n",
882 gsm48_mi_type_name(mi_type), mi_string);
883 } else {
884 LOGP(DMM, LOGL_INFO, "IMSI DETACH for %s\n", vlr_subscr_name(vsub));
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100885 msub_set_vsub(msc_a->c.msub, vsub);
Neels Hofmeyrfacd57a2017-12-15 03:48:48 +0100886
887 if (vsub->cs.is_paging)
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100888 paging_expired(vsub);
Neels Hofmeyrfacd57a2017-12-15 03:48:48 +0100889
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200890 vsub->classmark.classmark1 = idi->classmark1;
891
Harald Welte2483f1b2016-06-19 18:06:02 +0200892 vlr_subscr_rx_imsi_detach(vsub);
893 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_DETACHED, vsub);
Neels Hofmeyr7c5346c2019-02-19 02:36:35 +0100894 vlr_subscr_put(vsub, __func__);
Harald Welte2483f1b2016-06-19 18:06:02 +0200895 }
Harald Welte2a139372009-02-22 21:14:55 +0000896
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100897 msc_a_release_cn(msc_a);
Harald Welte2a139372009-02-22 21:14:55 +0000898 return 0;
899}
900
Harald Welted2a7f5a2009-06-05 20:08:20 +0000901static int gsm48_rx_mm_status(struct msgb *msg)
902{
903 struct gsm48_hdr *gh = msgb_l3(msg);
904
905 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
906
907 return 0;
908}
909
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100910static int parse_gsm_auth_resp(uint8_t *res, uint8_t *res_len,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100911 struct msc_a *msc_a,
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100912 struct msgb *msg)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100913{
914 struct gsm48_hdr *gh = msgb_l3(msg);
915 struct gsm48_auth_resp *ar = (struct gsm48_auth_resp*) gh->data;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100916
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100917 if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*ar)) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100918 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM AUTHENTICATION RESPONSE: l3 length invalid: %u\n",
919 msgb_l3len(msg));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100920 return -EINVAL;
921 }
922
923 *res_len = sizeof(ar->sres);
924 memcpy(res, ar->sres, sizeof(ar->sres));
925 return 0;
926}
927
928static int parse_umts_auth_resp(uint8_t *res, uint8_t *res_len,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100929 struct msc_a *msc_a,
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100930 struct msgb *msg)
931{
932 struct gsm48_hdr *gh;
933 uint8_t *data;
934 uint8_t iei;
935 uint8_t ie_len;
936 unsigned int data_len;
937
938 /* First parse the GSM part */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100939 if (parse_gsm_auth_resp(res, res_len, msc_a, msg))
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100940 return -EINVAL;
941 OSMO_ASSERT(*res_len == 4);
942
943 /* Then add the extended res part */
944 gh = msgb_l3(msg);
945 data = gh->data + sizeof(struct gsm48_auth_resp);
946 data_len = msgb_l3len(msg) - (data - (uint8_t*)msgb_l3(msg));
947
948 if (data_len < 3) {
Vadim Yanitskiy2fca80e2019-05-08 16:53:23 +0700949 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM AUTHENTICATION RESPONSE: "
950 "message length=%u is too short\n", data_len);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100951 return -EINVAL;
952 }
953
954 iei = data[0];
955 ie_len = data[1];
956 if (iei != GSM48_IE_AUTH_RES_EXT) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100957 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM R99 AUTHENTICATION RESPONSE: expected IEI 0x%02x, got 0x%02x\n",
958 GSM48_IE_AUTH_RES_EXT, iei);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100959 return -EINVAL;
960 }
961
962 if (ie_len > 12) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100963 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR,
964 "MM R99 AUTHENTICATION RESPONSE: extended Auth Resp IE 0x%02x is too large: %u bytes\n",
965 GSM48_IE_AUTH_RES_EXT, ie_len);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100966 return -EINVAL;
967 }
968
969 *res_len += ie_len;
970 memcpy(res + 4, &data[2], ie_len);
971 return 0;
972}
973
974/* Chapter 9.2.3: Authentication Response */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100975static int gsm48_rx_mm_auth_resp(struct msc_a *msc_a, struct msgb *msg)
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100976{
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100977 uint8_t res[16];
978 uint8_t res_len;
979 int rc;
Neels Hofmeyr25f69d52018-03-10 03:44:06 +0100980 bool is_umts;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100981 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100982
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100983 if (!vsub) {
984 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM AUTHENTICATION RESPONSE: invalid: no subscriber\n");
985 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100986 return -EINVAL;
987 }
988
Neels Hofmeyr25f69d52018-03-10 03:44:06 +0100989 is_umts = (msgb_l3len(msg) > sizeof(struct gsm48_hdr) + sizeof(struct gsm48_auth_resp));
990
991 if (is_umts)
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100992 rc = parse_umts_auth_resp(res, &res_len, msc_a, msg);
Neels Hofmeyr25f69d52018-03-10 03:44:06 +0100993 else
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100994 rc = parse_gsm_auth_resp(res, &res_len, msc_a, msg);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100995
996 if (rc) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +0100997 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR,
998 "MM AUTHENTICATION RESPONSE: invalid: parsing %s AKA Auth Response"
999 " failed with rc=%d; dispatching zero length SRES/RES to trigger failure\n",
1000 is_umts ? "UMTS" : "GSM", rc);
Neels Hofmeyr8e0af0b2018-03-10 03:32:18 +01001001 memset(res, 0, sizeof(res));
1002 res_len = 0;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001003 }
1004
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001005 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "MM %s AUTHENTICATION RESPONSE (%s = %s)\n",
1006 is_umts ? "UMTS" : "GSM", is_umts ? "res" : "sres",
1007 osmo_hexdump_nospc(res, res_len));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001008
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001009 return vlr_subscr_rx_auth_resp(vsub, osmo_gsm48_classmark_is_r99(&vsub->classmark),
1010 msc_a->c.ran->type == OSMO_RAT_UTRAN_IU,
Harald Welte2483f1b2016-06-19 18:06:02 +02001011 res, res_len);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001012}
1013
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001014static int gsm48_rx_mm_auth_fail(struct msc_a *msc_a, struct msgb *msg)
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001015{
1016 struct gsm48_hdr *gh = msgb_l3(msg);
1017 uint8_t cause;
1018 uint8_t auts_tag;
1019 uint8_t auts_len;
1020 uint8_t *auts;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001021 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001022
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001023 if (!vsub) {
1024 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM R99 AUTHENTICATION FAILURE: invalid: no subscriber\n");
1025 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001026 return -EINVAL;
1027 }
1028
1029 if (msgb_l3len(msg) < sizeof(*gh) + 1) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001030 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "MM R99 AUTHENTICATION FAILURE: l3 length invalid: %u\n",
1031 msgb_l3len(msg));
1032 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001033 return -EINVAL;
1034 }
1035
1036 cause = gh->data[0];
1037
1038 if (cause != GSM48_REJECT_SYNCH_FAILURE) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001039 LOG_MSC_A_CAT(msc_a, DMM, LOGL_INFO, "MM R99 AUTHENTICATION FAILURE: cause 0x%0x\n", cause);
1040 vlr_subscr_rx_auth_fail(vsub, NULL);
Harald Welte2483f1b2016-06-19 18:06:02 +02001041 return 0;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001042 }
1043
1044 /* This is a Synch Failure procedure, which should pass an AUTS to
1045 * resynchronize the sequence nr with the HLR. Expecting exactly one
1046 * TLV with 14 bytes of AUTS. */
1047
1048 if (msgb_l3len(msg) < sizeof(*gh) + 1 + 2) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001049 LOG_MSC_A_CAT(msc_a, DMM, LOGL_INFO,
1050 "MM R99 AUTHENTICATION FAILURE: invalid Synch Failure: missing AUTS IE\n");
1051 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001052 return -EINVAL;
1053 }
1054
1055 auts_tag = gh->data[1];
1056 auts_len = gh->data[2];
1057 auts = &gh->data[3];
1058
1059 if (auts_tag != GSM48_IE_AUTS
1060 || auts_len != 14) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001061 LOG_MSC_A_CAT(msc_a, DMM, LOGL_INFO,
1062 "MM R99 AUTHENTICATION FAILURE: invalid Synch Failure:"
1063 " expected AUTS IE 0x%02x of 14 bytes,"
1064 " got IE 0x%02x of %u bytes\n",
1065 GSM48_IE_AUTS, auts_tag, auts_len);
1066 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001067 return -EINVAL;
1068 }
1069
1070 if (msgb_l3len(msg) < sizeof(*gh) + 1 + 2 + auts_len) {
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001071 LOG_MSC_A_CAT(msc_a, DMM, LOGL_INFO,
1072 "MM R99 AUTHENTICATION FAILURE: invalid Synch Failure msg: message truncated (%u)\n",
1073 msgb_l3len(msg));
1074 msc_a_release_mo(msc_a, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001075 return -EINVAL;
1076 }
1077
1078 /* We have an AUTS IE with exactly 14 bytes of AUTS and the msgb is
1079 * large enough. */
1080
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001081 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "MM R99 AUTHENTICATION SYNCH (AUTS = %s)\n",
1082 osmo_hexdump_nospc(auts, 14));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001083
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001084 return vlr_subscr_rx_auth_fail(vsub, auts);
Harald Welte2483f1b2016-06-19 18:06:02 +02001085}
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001086
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001087static int gsm48_rx_mm_tmsi_reall_compl(struct msc_a *msc_a)
Harald Welte2483f1b2016-06-19 18:06:02 +02001088{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001089 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
1090 if (!vsub) {
1091 LOG_MSC_A_CAT(msc_a, DMM, LOGL_ERROR, "Rx MM TMSI Reallocation Complete: invalid: no subscriber\n");
Harald Welte2483f1b2016-06-19 18:06:02 +02001092 return -EINVAL;
1093 }
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001094 LOG_MSC_A_CAT(msc_a, DMM, LOGL_DEBUG, "TMSI Reallocation Completed\n");
1095 return vlr_subscr_rx_tmsi_reall_compl(vsub);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001096}
1097
Harald Weltebf5e8df2009-02-03 12:59:45 +00001098/* Receive a GSM 04.08 Mobility Management (MM) message */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001099int gsm0408_rcv_mm(struct msc_a *msc_a, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001100{
1101 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001102 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001103
Neels Hofmeyr531734a2016-03-14 16:13:24 +01001104 switch (gsm48_hdr_msg_type(gh)) {
Harald Welte52b1f982008-12-23 20:25:15 +00001105 case GSM48_MT_MM_LOC_UPD_REQUEST:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001106 rc = mm_rx_loc_upd_req(msc_a, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001107 break;
1108 case GSM48_MT_MM_ID_RESP:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001109 rc = mm_rx_id_resp(msc_a, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001110 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001111 case GSM48_MT_MM_CM_SERV_REQ:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001112 rc = gsm48_rx_mm_serv_req(msc_a, msg);
Harald Welte4b634542008-12-27 01:55:51 +00001113 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001114 case GSM48_MT_MM_STATUS:
Harald Welted2a7f5a2009-06-05 20:08:20 +00001115 rc = gsm48_rx_mm_status(msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001116 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001117 case GSM48_MT_MM_TMSI_REALL_COMPL:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001118 rc = gsm48_rx_mm_tmsi_reall_compl(msc_a);
Harald Welte69b2af22009-01-06 19:47:00 +00001119 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001120 case GSM48_MT_MM_IMSI_DETACH_IND:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001121 rc = gsm48_rx_mm_imsi_detach_ind(msc_a, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001122 break;
1123 case GSM48_MT_MM_CM_REEST_REQ:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001124 rc = gsm48_rx_cm_reest_req(msc_a, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001125 break;
1126 case GSM48_MT_MM_AUTH_RESP:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001127 rc = gsm48_rx_mm_auth_resp(msc_a, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001128 break;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001129 case GSM48_MT_MM_AUTH_FAIL:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001130 rc = gsm48_rx_mm_auth_fail(msc_a, msg);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001131 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001132 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01001133 LOGP(DMM, LOGL_NOTICE, "Unknown GSM 04.08 MM msg type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001134 gh->msg_type);
1135 break;
1136 }
1137
1138 return rc;
1139}
Harald Weltebf5e8df2009-02-03 12:59:45 +00001140
Harald Welte2d35ae62009-02-06 12:02:13 +00001141/* Receive a PAGING RESPONSE message from the MS */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001142static int gsm48_rx_rr_pag_resp(struct msc_a *msc_a, struct msgb *msg)
Harald Welte2d35ae62009-02-06 12:02:13 +00001143{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001144 struct gsm_network *net = msc_a_net(msc_a);
Harald Welte2d35ae62009-02-06 12:02:13 +00001145 struct gsm48_hdr *gh = msgb_l3(msg);
Sylvain Munautda9f37e2019-03-14 11:02:36 +01001146 struct gsm48_pag_resp *pr =
1147 (struct gsm48_pag_resp *)gh->data;
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001148 uint8_t classmark2_len = gh->data[1];
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001149 uint8_t *classmark2_buf = gh->data+2;
1150 struct gsm48_classmark2 *cm2 = (void*)classmark2_buf;
1151 uint8_t *mi_lv = classmark2_buf + classmark2_len;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001152 bool is_utran;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001153 struct vlr_subscr *vsub;
Harald Welte2483f1b2016-06-19 18:06:02 +02001154
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001155 if (msc_a_is_establishing_auth_ciph(msc_a)) {
Vadim Yanitskiy5b19f6e2020-01-25 07:02:47 +07001156 LOG_MSC_A_CAT(msc_a, DRR, LOGL_ERROR,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001157 "Ignoring Paging Response, conn already busy establishing authenticity\n");
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001158 return 0;
1159 }
1160
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001161 if (msc_a_is_accepted(msc_a)) {
Vadim Yanitskiy5b19f6e2020-01-25 07:02:47 +07001162 LOG_MSC_A_CAT(msc_a, DRR, LOGL_ERROR, "Ignoring Paging Response, conn already established\n");
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001163 return 0;
1164 }
1165
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001166 msc_a->complete_layer3_type = COMPLETE_LAYER3_PAGING_RESP;
1167 msub_update_id_from_mi(msc_a->c.msub, mi_lv + 1, *mi_lv);
1168 LOG_MSC_A_CAT(msc_a, DRR, LOGL_DEBUG, "Rx PAGING RESPONSE\n");
Neels Hofmeyr6d804b12017-02-18 22:20:46 +01001169
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001170 msc_a_get(msc_a, MSC_A_USE_PAGING_RESPONSE);
1171
1172 is_utran = (msc_a->c.ran->type == OSMO_RAT_UTRAN_IU);
1173 vlr_proc_acc_req(msc_a->c.fi,
1174 MSC_A_EV_AUTHENTICATED, MSC_A_EV_CN_CLOSE, NULL,
1175 net->vlr, msc_a,
1176 VLR_PR_ARQ_T_PAGING_RESP, 0, mi_lv, &msc_a->via_cell.lai,
1177 is_utran || net->authentication_required,
Neels Hofmeyr4dfb2ba2019-08-13 16:00:37 +02001178 is_utran ? net->uea_encryption : net->a5_encryption_mask > 0x01,
Sylvain Munautda9f37e2019-03-14 11:02:36 +01001179 pr->key_seq,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001180 osmo_gsm48_classmark2_is_r99(cm2, classmark2_len),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001181 is_utran);
Holger Freyther053e09d2009-02-14 22:51:06 +00001182
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001183 /* From vlr_proc_acc_req() we expect an implicit dispatch of PR_ARQ_E_START we expect
Thorsten Alteholz3a357de2019-07-16 20:51:16 +02001184 * msc_vlr_subscr_assoc() to already have been called and completed. Has an error occurred? */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001185 vsub = msc_a_vsub(msc_a);
1186 if (!vsub) {
Vadim Yanitskiy5b19f6e2020-01-25 07:02:47 +07001187 LOG_MSC_A_CAT(msc_a, DRR, LOGL_ERROR, "subscriber not allowed to do a Paging Response\n");
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001188 msc_a_put(msc_a, MSC_A_USE_PAGING_RESPONSE);
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001189 return -EIO;
1190 }
1191
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001192 vsub->classmark.classmark2 = *cm2;
1193 vsub->classmark.classmark2_len = classmark2_len;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001194 return 0;
Harald Welte2d35ae62009-02-06 12:02:13 +00001195}
1196
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001197static int gsm48_rx_rr_ciphering_mode_complete(struct msc_a *msc_a, struct msgb *msg)
1198{
1199 struct vlr_subscr *vsub = msc_a_vsub(msc_a);
1200 struct gsm48_hdr *gh = msgb_l3(msg);
1201 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1202 struct tlv_parsed tp;
1203 struct tlv_p_entry *mi;
1204
1205 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
1206 mi = TLVP_GET(&tp, GSM48_IE_MOBILE_ID);
1207
Vadim Yanitskiya79aac02019-12-28 01:19:19 +01001208 /* IMEI(SV) is optional for this message */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001209 if (!mi)
1210 return 0;
Vadim Yanitskiya79aac02019-12-28 01:19:19 +01001211 if (!mi->len)
1212 return -EINVAL;
1213 if ((mi->val[0] & GSM_MI_TYPE_MASK) != GSM_MI_TYPE_IMEISV) {
1214 LOGP(DMM, LOGL_ERROR, "RR Ciphering Mode Complete contains "
1215 "unexpected Mobile Identity type %s\n",
1216 gsm48_mi_type_name(mi->val[0] & GSM_MI_TYPE_MASK));
1217 return -EINVAL;
1218 }
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001219
Neels Hofmeyr38816da2019-08-29 00:43:18 +02001220 LOG_MSC_A(msc_a, LOGL_DEBUG, "RR Ciphering Mode Complete contains Mobile Identity: %s\n",
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001221 osmo_mi_name(mi->val, mi->len));
1222
1223 if (!vsub)
1224 return 0;
1225
1226 return vlr_subscr_rx_id_resp(vsub, mi->val, mi->len);
1227}
1228
1229static int gsm48_rx_rr_app_info(struct msc_a *msc_a, struct msgb *msg)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001230{
1231 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001232 uint8_t apdu_id_flags;
1233 uint8_t apdu_len;
1234 uint8_t *apdu_data;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001235
1236 apdu_id_flags = gh->data[0];
1237 apdu_len = gh->data[1];
1238 apdu_data = gh->data+2;
Alexander Couzensfbd96f52016-08-29 18:40:02 +02001239
Vadim Yanitskiy6a9a3a72020-01-25 06:53:50 +07001240 LOG_MSC_A_CAT(msc_a, DRR, LOGL_DEBUG, "Rx RR APPLICATION INFO "
1241 "(id/flags=0x%02x apdu_len=%u apdu=%s)\n",
1242 apdu_id_flags, apdu_len, osmo_hexdump(apdu_data, apdu_len));
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001243
Harald Welte2483f1b2016-06-19 18:06:02 +02001244 /* we're not using the app info blob anywhere, so ignore. */
1245#if 0
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001246 return db_apdu_blob_store(conn->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte2483f1b2016-06-19 18:06:02 +02001247#else
1248 return 0;
1249#endif
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001250}
1251
Harald Weltebf5e8df2009-02-03 12:59:45 +00001252/* Receive a GSM 04.08 Radio Resource (RR) message */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001253int gsm0408_rcv_rr(struct msc_a *msc_a, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001254{
1255 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001256 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001257
1258 switch (gh->msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001259 case GSM48_MT_RR_PAG_RESP:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001260 rc = gsm48_rx_rr_pag_resp(msc_a, msg);
1261 break;
1262 case GSM48_MT_RR_CIPH_M_COMPL:
1263 rc = gsm48_rx_rr_ciphering_mode_complete(msc_a, msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001264 break;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001265 case GSM48_MT_RR_APP_INFO:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001266 rc = gsm48_rx_rr_app_info(msc_a, msg);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001267 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001268 default:
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001269 LOG_MSC_A_CAT(msc_a, DRR, LOGL_NOTICE, "MSC: Unimplemented %s GSM 04.08 RR "
1270 "message\n", gsm48_rr_msg_name(gh->msg_type));
Harald Welte52b1f982008-12-23 20:25:15 +00001271 break;
1272 }
1273
Harald Welte2d35ae62009-02-06 12:02:13 +00001274 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001275}
1276
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001277int gsm48_send_rr_app_info(struct msc_a *msc_a, uint8_t apdu_id,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001278 uint8_t apdu_len, const uint8_t *apdu)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001279{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01001280 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 APP INF");
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001281 struct gsm48_hdr *gh;
1282
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001283 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1284 apdu_id, apdu_len);
Alexander Couzensfbd96f52016-08-29 18:40:02 +02001285
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001286 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1287 gh->proto_discr = GSM48_PDISC_RR;
1288 gh->msg_type = GSM48_MT_RR_APP_INFO;
1289 gh->data[0] = apdu_id;
1290 gh->data[1] = apdu_len;
1291 memcpy(gh->data+2, apdu, apdu_len);
1292
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001293 return msc_a_tx_dtap_to_i(msc_a, msg);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001294}
1295
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001296extern int gsm0408_rcv_cc(struct msc_a *msc_a, struct msgb *msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001297
Harald Welte2483f1b2016-06-19 18:06:02 +02001298/***********************************************************************
1299 * VLR integration
1300 ***********************************************************************/
1301
1302/* VLR asks us to send an authentication request */
Neels Hofmeyr8b6e5362018-11-30 02:57:33 +01001303static int msc_vlr_tx_auth_req(void *msc_conn_ref, struct vlr_auth_tuple *at,
Harald Welte2483f1b2016-06-19 18:06:02 +02001304 bool send_autn)
1305{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001306 struct msc_a *msc_a = msc_conn_ref;
1307 return gsm48_tx_mm_auth_req(msc_a, at->vec.rand,
Harald Welte2483f1b2016-06-19 18:06:02 +02001308 send_autn? at->vec.autn : NULL,
1309 at->key_seq);
1310}
1311
1312/* VLR asks us to send an authentication reject */
1313static int msc_vlr_tx_auth_rej(void *msc_conn_ref)
1314{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001315 struct msc_a *msc_a = msc_conn_ref;
1316 return gsm48_tx_mm_auth_rej(msc_a);
Harald Welte2483f1b2016-06-19 18:06:02 +02001317}
1318
1319/* VLR asks us to transmit an Identity Request of given type */
1320static int msc_vlr_tx_id_req(void *msc_conn_ref, uint8_t mi_type)
1321{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001322 struct msc_a *msc_a = msc_conn_ref;
Vadim Yanitskiya79aac02019-12-28 01:19:19 +01001323
1324 /* Store requested MI type, so we can check the response */
1325 msc_a->mm_id_req_type = mi_type;
1326
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001327 return mm_tx_identity_req(msc_a, mi_type);
Harald Welte2483f1b2016-06-19 18:06:02 +02001328}
1329
1330/* VLR asks us to transmit a Location Update Accept */
1331static int msc_vlr_tx_lu_acc(void *msc_conn_ref, uint32_t send_tmsi)
1332{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001333 struct msc_a *msc_a = msc_conn_ref;
1334 return gsm0408_loc_upd_acc(msc_a, send_tmsi);
Harald Welte2483f1b2016-06-19 18:06:02 +02001335}
1336
1337/* VLR asks us to transmit a Location Update Reject */
Neels Hofmeyr15809592018-04-06 02:57:51 +02001338static int msc_vlr_tx_lu_rej(void *msc_conn_ref, enum gsm48_reject_value cause)
Harald Welte2483f1b2016-06-19 18:06:02 +02001339{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001340 struct msc_a *msc_a = msc_conn_ref;
1341 return gsm0408_loc_upd_rej(msc_a, cause);
Harald Welte2483f1b2016-06-19 18:06:02 +02001342}
1343
1344/* VLR asks us to transmit a CM Service Accept */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001345int msc_vlr_tx_cm_serv_acc(void *msc_conn_ref, enum osmo_cm_service_type cm_service_type)
Harald Welte2483f1b2016-06-19 18:06:02 +02001346{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001347 struct msc_a *msc_a = msc_conn_ref;
1348 return msc_gsm48_tx_mm_serv_ack(msc_a);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001349}
1350
1351static int msc_vlr_tx_common_id(void *msc_conn_ref)
1352{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001353 struct msc_a *msc_a = msc_conn_ref;
1354 struct ran_msg msg = {
1355 .msg_type = RAN_MSG_COMMON_ID,
1356 .common_id = {
1357 .imsi = msc_a_vsub(msc_a)->imsi,
1358 },
1359 };
1360 return msc_a_ran_down(msc_a, MSC_ROLE_I, &msg);
Harald Welte2483f1b2016-06-19 18:06:02 +02001361}
1362
Stefan Sperling3a741282018-03-13 21:11:49 +01001363/* VLR asks us to transmit MM info. */
1364static int msc_vlr_tx_mm_info(void *msc_conn_ref)
1365{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001366 struct msc_a *msc_a = msc_conn_ref;
1367 struct gsm_network *net = msc_a_net(msc_a);
1368 if (!net->send_mm_info)
Stefan Sperling3a741282018-03-13 21:11:49 +01001369 return 0;
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001370 return gsm48_tx_mm_info(msc_a);
Stefan Sperling3a741282018-03-13 21:11:49 +01001371}
1372
Harald Welte2483f1b2016-06-19 18:06:02 +02001373/* VLR asks us to transmit a CM Service Reject */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001374static int msc_vlr_tx_cm_serv_rej(void *msc_conn_ref, enum osmo_cm_service_type cm_service_type,
1375 enum gsm48_reject_value cause)
Harald Welte2483f1b2016-06-19 18:06:02 +02001376{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001377 struct msc_a *msc_a = msc_conn_ref;
1378 msc_gsm48_tx_mm_serv_rej(msc_a, cause);
1379 msc_a_put(msc_a, msc_a_cm_service_type_to_use(cm_service_type));
1380 return 0;
Harald Welte2483f1b2016-06-19 18:06:02 +02001381}
1382
1383/* VLR informs us that the subscriber data has somehow been modified */
1384static void msc_vlr_subscr_update(struct vlr_subscr *subscr)
1385{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001386 struct msub *msub = msub_for_vsub(subscr);
1387 LOGVSUBP(LOGL_NOTICE, subscr, "VLR: update for IMSI=%s (MSISDN=%s)%s\n",
1388 subscr->imsi, subscr->msisdn, msub ? "" : " (NO CONN!)");
1389 msub_update_id(msub);
Neels Hofmeyr68cf9572018-09-18 15:52:58 +02001390}
1391
Harald Welte2483f1b2016-06-19 18:06:02 +02001392/* VLR informs us that the subscriber has been associated with a conn */
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001393static int msc_vlr_subscr_assoc(void *msc_conn_ref,
Harald Welte2483f1b2016-06-19 18:06:02 +02001394 struct vlr_subscr *vsub)
1395{
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001396 struct msc_a *msc_a = msc_conn_ref;
1397 struct msub *msub = msc_a->c.msub;
Max48d4ec02018-02-12 16:51:03 +01001398 OSMO_ASSERT(vsub);
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001399
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001400 if (msub_set_vsub(msub, vsub))
1401 return -EINVAL;
1402 vsub->cs.attached_via_ran = msc_a->c.ran->type;
Neels Hofmeyr68cf9572018-09-18 15:52:58 +02001403
1404 /* In case we have already received Classmark Information before the VLR Subscriber was
1405 * associated with the conn: merge the new Classmark into vsub->classmark. Don't overwrite valid
1406 * vsub->classmark with unset classmark, though. */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001407 osmo_gsm48_classmark_update(&vsub->classmark, &msc_a->temporary_classmark);
1408
1409 msub_update_id(msub);
1410
1411 osmo_fsm_inst_dispatch(msc_a->c.fi, MSC_A_EV_COMPLETE_LAYER_3_OK, NULL);
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001412 return 0;
Harald Welte2483f1b2016-06-19 18:06:02 +02001413}
1414
1415/* operations that we need to implement for libvlr */
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001416const struct vlr_ops msc_vlr_ops = {
Harald Welte2483f1b2016-06-19 18:06:02 +02001417 .tx_auth_req = msc_vlr_tx_auth_req,
1418 .tx_auth_rej = msc_vlr_tx_auth_rej,
1419 .tx_id_req = msc_vlr_tx_id_req,
1420 .tx_lu_acc = msc_vlr_tx_lu_acc,
1421 .tx_lu_rej = msc_vlr_tx_lu_rej,
1422 .tx_cm_serv_acc = msc_vlr_tx_cm_serv_acc,
1423 .tx_cm_serv_rej = msc_vlr_tx_cm_serv_rej,
Neels Hofmeyrc4628a32018-12-07 14:47:34 +01001424 .set_ciph_mode = msc_a_vlr_set_cipher_mode,
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001425 .tx_common_id = msc_vlr_tx_common_id,
Stefan Sperling3a741282018-03-13 21:11:49 +01001426 .tx_mm_info = msc_vlr_tx_mm_info,
Harald Welte2483f1b2016-06-19 18:06:02 +02001427 .subscr_update = msc_vlr_subscr_update,
1428 .subscr_assoc = msc_vlr_subscr_assoc,
1429};
1430
Neels Hofmeyr79e580b2018-03-22 16:48:22 +01001431struct msgb *gsm48_create_mm_serv_rej(enum gsm48_reject_value value)
1432{
1433 struct msgb *msg;
1434 struct gsm48_hdr *gh;
1435
1436 msg = gsm48_msgb_alloc_name("GSM 04.08 SERV REJ");
1437 if (!msg)
1438 return NULL;
1439
1440 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
1441 gh->proto_discr = GSM48_PDISC_MM;
1442 gh->msg_type = GSM48_MT_MM_CM_SERV_REJ;
1443 gh->data[0] = value;
1444
1445 return msg;
1446}
1447
1448struct msgb *gsm48_create_loc_upd_rej(uint8_t cause)
1449{
1450 struct gsm48_hdr *gh;
1451 struct msgb *msg;
1452
1453 msg = gsm48_msgb_alloc_name("GSM 04.08 LOC UPD REJ");
1454 if (!msg)
1455 return NULL;
1456
1457 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
1458 gh->proto_discr = GSM48_PDISC_MM;
1459 gh->msg_type = GSM48_MT_MM_LOC_UPD_REJECT;
1460 gh->data[0] = cause;
1461 return msg;
1462}
1463
1464int gsm48_extract_mi(uint8_t *classmark2_lv, int length, char *mi_string, uint8_t *mi_type)
1465{
1466 /* Check the size for the classmark */
1467 if (length < 1 + *classmark2_lv)
1468 return -1;
1469
1470 uint8_t *mi_lv = classmark2_lv + *classmark2_lv + 1;
1471 if (length < 2 + *classmark2_lv + mi_lv[0])
1472 return -2;
1473
1474 *mi_type = mi_lv[1] & GSM_MI_TYPE_MASK;
1475 return gsm48_mi_to_string(mi_string, GSM48_MI_SIZE, mi_lv+1, *mi_lv);
1476}
1477
1478int gsm48_paging_extract_mi(struct gsm48_pag_resp *resp, int length,
1479 char *mi_string, uint8_t *mi_type)
1480{
1481 static const uint32_t classmark_offset =
1482 offsetof(struct gsm48_pag_resp, classmark2);
1483 uint8_t *classmark2_lv = (uint8_t *) &resp->classmark2;
1484 return gsm48_extract_mi(classmark2_lv, length - classmark_offset,
1485 mi_string, mi_type);
1486}