blob: adc946eb94d23e150b1554d25339d1beb357aca5 [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 <regex.h>
33#include <sys/types.h>
Harald Welte52b1f982008-12-23 20:25:15 +000034
Harald Welte9c3dc902012-04-08 16:59:24 +020035#include "bscconfig.h"
36
Neels Hofmeyr90843962017-09-04 15:04:35 +020037#include <osmocom/msc/db.h>
38#include <osmocom/msc/debug.h>
39#include <osmocom/msc/gsm_data.h>
40#include <osmocom/msc/gsm_subscriber.h>
41#include <osmocom/msc/gsm_04_11.h>
42#include <osmocom/msc/gsm_04_08.h>
43#include <osmocom/msc/gsm_04_80.h>
44#include <osmocom/msc/gsm_04_14.h>
Vadim Yanitskiy5b860fa2018-06-12 05:24:52 +070045#include <osmocom/msc/gsm_09_11.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020046#include <osmocom/msc/signal.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020047#include <osmocom/msc/transaction.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020048#include <osmocom/msc/silent_call.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020049#include <osmocom/msc/mncc_int.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020050#include <osmocom/abis/e1_input.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010051#include <osmocom/core/bitvec.h>
Neels Hofmeyr90843962017-09-04 15:04:35 +020052#include <osmocom/msc/vlr.h>
53#include <osmocom/msc/msc_ifaces.h>
Holger Hans Peter Freyther841c2002010-09-30 18:52:23 +080054
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010055#include <osmocom/gsm/gsm48.h>
56#include <osmocom/gsm/gsm0480.h>
57#include <osmocom/gsm/gsm_utils.h>
Max8db12e42016-04-18 23:11:18 +020058#include <osmocom/gsm/protocol/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010059#include <osmocom/core/msgb.h>
60#include <osmocom/core/talloc.h>
Neels Hofmeyr93bafb62017-01-13 03:12:08 +010061#include <osmocom/core/utils.h>
Philipp Maier621ba032017-11-07 17:19:25 +010062#include <osmocom/core/byteswap.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010063#include <osmocom/gsm/tlv.h>
Neels Hofmeyr84da6b12016-05-20 21:59:55 +020064#include <osmocom/crypt/auth.h>
Neels Hofmeyr84da6b12016-05-20 21:59:55 +020065#ifdef BUILD_IU
Neels Hofmeyr00e82d62017-07-05 15:19:52 +020066#include <osmocom/ranap/iu_client.h>
Neels Hofmeyr84da6b12016-05-20 21:59:55 +020067#endif
Harald Welte52b1f982008-12-23 20:25:15 +000068
Neels Hofmeyr90843962017-09-04 15:04:35 +020069#include <osmocom/msc/msc_ifaces.h>
70#include <osmocom/msc/a_iface.h>
Philipp Maier621ba032017-11-07 17:19:25 +010071#include <osmocom/msc/msc_mgcp.h>
Philipp Maierfbf66102017-04-09 12:32:51 +020072
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +020073#include <assert.h>
74
Neels Hofmeyre2f24d52017-05-08 15:12:20 +020075
Harald Welte (local)d19e58b2009-08-15 02:30:58 +020076void *tall_locop_ctx;
Sylvain Munaut30a15382009-12-24 00:27:26 +010077void *tall_authciphop_ctx;
Harald Welte2cf161b2009-06-20 22:36:41 +020078
Neels Hofmeyrc036b792018-11-29 22:37:51 +010079static int gsm0408_loc_upd_acc(struct ran_conn *conn,
Harald Welte2483f1b2016-06-19 18:06:02 +020080 uint32_t send_tmsi);
Harald Welte65e74cc2008-12-29 01:55:35 +000081
Harald Welte27989d42018-06-21 20:39:20 +020082/*! Send a simple GSM 04.08 message without any payload
Neels Hofmeyrc036b792018-11-29 22:37:51 +010083 * \param conn Active RAN connection
Harald Welte27989d42018-06-21 20:39:20 +020084 * \param[in] pdisc Protocol discriminator
85 * \param[in] msg_type Message type
86 * \return result of \ref gsm48_conn_sendmsg
87 */
Neels Hofmeyrc036b792018-11-29 22:37:51 +010088int gsm48_tx_simple(struct ran_conn *conn,
Harald Welte27989d42018-06-21 20:39:20 +020089 uint8_t pdisc, uint8_t msg_type)
90{
91 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 TX SIMPLE");
92 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
93
94 gh->proto_discr = pdisc;
95 gh->msg_type = msg_type;
96
97 return gsm48_conn_sendmsg(msg, conn, NULL);
98}
Harald Welte4bfdfe72009-06-10 23:11:52 +080099
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200100static bool classmark1_is_r99(const struct gsm48_classmark1 *cm1)
101{
102 return cm1->rev_lev >= 2;
103}
104
105static bool classmark2_is_r99(const uint8_t *cm2, uint8_t cm2_len)
106{
107 uint8_t rev_lev;
108 if (!cm2_len)
109 return false;
110 rev_lev = (cm2[0] >> 5) & 0x3;
111 return rev_lev >= 2;
112}
113
Neels Hofmeyr9d744252018-03-22 16:09:50 +0100114static bool classmark_is_r99(struct gsm_classmark *cm)
115{
Neels Hofmeyr9d744252018-03-22 16:09:50 +0100116 if (cm->classmark1_set)
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200117 return classmark1_is_r99(&cm->classmark1);
118 return classmark2_is_r99(cm->classmark2, cm->classmark2_len);
Neels Hofmeyr9d744252018-03-22 16:09:50 +0100119}
120
Neels Hofmeyr5769d362018-12-18 03:13:51 +0100121static const char *classmark_a5_name(const struct gsm_classmark *cm)
122{
123 static char buf[128];
124 char cm1[42];
125 char cm2[42];
126 char cm3[42];
127
128 if (cm->classmark1_set)
129 snprintf(cm1, sizeof(cm1), "cm1{a5/1=%s}",
130 cm->classmark1.a5_1 ? "not-supported":"supported" /* inverted logic */);
131 else
132 snprintf(cm1, sizeof(cm1), "no-cm1");
133
134 if (cm->classmark2_len >= 3)
135 snprintf(cm2, sizeof(cm2), " cm2{0x%x=%s%s}",
136 cm->classmark2[2],
137 cm->classmark2[2] & 0x1 ? " A5/2" : "",
138 cm->classmark2[2] & 0x2 ? " A5/3" : "");
139 else
140 snprintf(cm2, sizeof(cm2), " no-cm2");
141
142 if (cm->classmark3_len >= 1)
143 snprintf(cm3, sizeof(cm3), " cm3{0x%x=%s%s%s%s}",
144 cm->classmark3[0],
145 cm->classmark3[0] & (1 << 0) ? " A5/4" : "",
146 cm->classmark3[0] & (1 << 1) ? " A5/5" : "",
147 cm->classmark3[0] & (1 << 2) ? " A5/6" : "",
148 cm->classmark3[0] & (1 << 3) ? " A5/7" : "");
149 else
150 snprintf(cm3, sizeof(cm3), " no-cm3");
151
152 snprintf(buf, sizeof(buf), "%s%s%s", cm1, cm2, cm3);
153 return buf;
154}
155
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200156/* Determine if the given CLASSMARK (1/2/3) value permits a given A5/n cipher.
157 * Return 1 when the given A5/n is permitted, 0 when not, and negative if the respective MS CLASSMARK is
158 * not known, where the negative number indicates the classmark type: -2 means Classmark 2 is not
159 * available. */
160static int classmark_supports_a5(const struct gsm_classmark *cm, uint8_t a5)
Harald Welte71330722017-12-23 19:59:02 +0100161{
162 switch (a5) {
163 case 0:
164 /* all phones must implement A5/0, see 3GPP TS 43.020 4.9 */
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200165 return 1;
Harald Welte71330722017-12-23 19:59:02 +0100166 case 1:
167 /* 3GPP TS 43.020 4.9 requires A5/1 to be suppored by all phones and actually states:
168 * "The network shall not provide service to an MS which indicates that it does not
169 * support the ciphering algorithm A5/1.". However, let's be more tolerant based
170 * on policy here */
171 /* See 3GPP TS 24.008 10.5.1.7 */
172 if (!cm->classmark1_set) {
173 DEBUGP(DMSC, "CLASSMARK 1 unknown, assuming MS supports A5/1\n");
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200174 return -1;
Harald Welte71330722017-12-23 19:59:02 +0100175 } else {
176 if (cm->classmark1.a5_1)
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200177 return 0; /* Inverted logic for this bit! */
Harald Welte71330722017-12-23 19:59:02 +0100178 else
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200179 return 1;
Harald Welte71330722017-12-23 19:59:02 +0100180 }
181 break;
182 case 2:
183 case 3:
184 /* See 3GPP TS 24.008 10.5.1.6 */
185 if (cm->classmark2_len < 3) {
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200186 return -2;
Harald Welte71330722017-12-23 19:59:02 +0100187 } else {
188 if (cm->classmark2[2] & (1 << (a5-2)))
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200189 return 1;
Harald Welte71330722017-12-23 19:59:02 +0100190 else
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200191 return 0;
Harald Welte71330722017-12-23 19:59:02 +0100192 }
193 break;
194 case 4:
195 case 5:
196 case 6:
197 case 7:
198 /* See 3GPP TS 24.008 10.5.1.7 */
199 if (cm->classmark3_len < 1) {
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200200 return -3;
Harald Welte71330722017-12-23 19:59:02 +0100201 } else {
202 if (cm->classmark3[0] & (1 << (a5-4)))
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200203 return 1;
Harald Welte71330722017-12-23 19:59:02 +0100204 else
Neels Hofmeyr3117b702018-09-13 03:23:07 +0200205 return 0;
Harald Welte71330722017-12-23 19:59:02 +0100206 }
207 break;
208 default:
209 return false;
210 }
211}
212
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100213int gsm48_conn_sendmsg(struct msgb *msg, struct ran_conn *conn, struct gsm_trans *trans)
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800214{
215 struct gsm48_hdr *gh = (struct gsm48_hdr *) msg->data;
216
217 /* if we get passed a transaction reference, do some common
218 * work that the caller no longer has to do */
219 if (trans) {
220 gh->proto_discr = trans->protocol | (trans->transaction_id << 4);
Harald Welte0e2fa5d2018-04-09 16:35:01 +0200221 OMSC_LINKID_CB(msg) = trans->dlci;
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800222 }
223
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200224 return msc_tx_dtap(conn, msg);
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800225}
Sylvain Munaut30a15382009-12-24 00:27:26 +0100226
Harald Welte2483f1b2016-06-19 18:06:02 +0200227/* clear all transactions globally; used in case of MNCC socket disconnect */
Harald Welte371efe52010-12-22 23:17:50 +0100228void gsm0408_clear_all_trans(struct gsm_network *net, int protocol)
229{
230 struct gsm_trans *trans, *temp;
231
232 LOGP(DCC, LOGL_NOTICE, "Clearing all currently active transactions!!!\n");
233
234 llist_for_each_entry_safe(trans, temp, &net->trans_list, entry) {
Harald Welteeb76c7a2010-12-23 02:47:53 +0100235 if (trans->protocol == protocol) {
236 trans->callref = 0;
Harald Welte371efe52010-12-22 23:17:50 +0100237 trans_free(trans);
Harald Welteeb76c7a2010-12-23 02:47:53 +0100238 }
Harald Welte371efe52010-12-22 23:17:50 +0100239 }
240}
241
Holger Freyther429e7762008-12-30 13:28:30 +0000242/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100243static int gsm0408_loc_upd_rej(struct ran_conn *conn, uint8_t cause)
Harald Welte52b1f982008-12-23 20:25:15 +0000244{
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800245 struct msgb *msg;
246
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800247 msg = gsm48_create_loc_upd_rej(cause);
248 if (!msg) {
249 LOGP(DMM, LOGL_ERROR, "Failed to create msg for LOCATION UPDATING REJECT.\n");
250 return -1;
251 }
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200252
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200253 LOGP(DMM, LOGL_INFO, "Subscriber %s: LOCATION UPDATING REJECT\n",
254 vlr_subscr_name(conn->vsub));
Harald Welte24ff6ee2009-12-22 00:41:05 +0100255
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800256 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000257}
258
259/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100260static int gsm0408_loc_upd_acc(struct ran_conn *conn,
Harald Welte2483f1b2016-06-19 18:06:02 +0200261 uint32_t send_tmsi)
Harald Welte52b1f982008-12-23 20:25:15 +0000262{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100263 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 LOC UPD ACC");
Harald Welte52b1f982008-12-23 20:25:15 +0000264 struct gsm48_hdr *gh;
265 struct gsm48_loc_area_id *lai;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200266 uint8_t *mid;
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100267 struct osmo_location_area_id laid = {
268 .plmn = conn->network->plmn,
269 .lac = conn->lac,
270 };
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200271
Harald Welte52b1f982008-12-23 20:25:15 +0000272 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
273 gh->proto_discr = GSM48_PDISC_MM;
274 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
275
276 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100277 gsm48_generate_lai2(lai, &laid);
Harald Welte52b1f982008-12-23 20:25:15 +0000278
Harald Welte2483f1b2016-06-19 18:06:02 +0200279 if (send_tmsi == GSM_RESERVED_TMSI) {
280 /* we did not allocate a TMSI to the MS, so we need to
281 * include the IMSI in order for the MS to delete any
282 * old TMSI that might still be allocated */
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200283 uint8_t mi[10];
284 int len;
Harald Welte2483f1b2016-06-19 18:06:02 +0200285 len = gsm48_generate_mid_from_imsi(mi, conn->vsub->imsi);
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200286 mid = msgb_put(msg, len);
287 memcpy(mid, mi, len);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200288 DEBUGP(DMM, "-> %s LOCATION UPDATE ACCEPT\n",
289 vlr_subscr_name(conn->vsub));
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200290 } else {
Harald Welte2483f1b2016-06-19 18:06:02 +0200291 /* Include the TMSI, which means that the MS will send a
292 * TMSI REALLOCATION COMPLETE, and we should wait for
293 * that until T3250 expiration */
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200294 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
Harald Welte2483f1b2016-06-19 18:06:02 +0200295 gsm48_generate_mid_from_tmsi(mid, send_tmsi);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200296 DEBUGP(DMM, "-> %s LOCATION UPDATE ACCEPT (TMSI = 0x%08x)\n",
297 vlr_subscr_name(conn->vsub),
298 send_tmsi);
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200299 }
Harald Welte2483f1b2016-06-19 18:06:02 +0200300 /* TODO: Follow-on proceed */
301 /* TODO: CTS permission */
302 /* TODO: Equivalent PLMNs */
303 /* TODO: Emergency Number List */
304 /* TODO: Per-MS T3312 */
Harald Welte52b1f982008-12-23 20:25:15 +0000305
Harald Welte52b1f982008-12-23 20:25:15 +0000306
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800307 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000308}
309
Harald Weltebf5e8df2009-02-03 12:59:45 +0000310/* Transmit Chapter 9.2.10 Identity Request */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100311static int mm_tx_identity_req(struct ran_conn *conn, uint8_t id_type)
Harald Welte231ad4f2008-12-27 11:15:38 +0000312{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100313 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 ID REQ");
Harald Welte231ad4f2008-12-27 11:15:38 +0000314 struct gsm48_hdr *gh;
Harald Weltefc977a82008-12-27 10:19:37 +0000315
Harald Welte231ad4f2008-12-27 11:15:38 +0000316 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
317 gh->proto_discr = GSM48_PDISC_MM;
318 gh->msg_type = GSM48_MT_MM_ID_REQ;
319 gh->data[0] = id_type;
320
Holger Hans Peter Freytherd521d972010-06-15 14:11:01 +0800321 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte231ad4f2008-12-27 11:15:38 +0000322}
323
Harald Weltebf5e8df2009-02-03 12:59:45 +0000324/* Parse Chapter 9.2.11 Identity Response */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100325static int mm_rx_id_resp(struct ran_conn *conn, struct msgb *msg)
Harald Welte231ad4f2008-12-27 11:15:38 +0000326{
327 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyrb62289a2019-01-11 00:04:32 +0100328 uint8_t *mi = gh->data+1;
329 uint8_t mi_len = gh->data[0];
Harald Welte231ad4f2008-12-27 11:15:38 +0000330
Harald Welte2483f1b2016-06-19 18:06:02 +0200331 if (!conn->vsub) {
332 LOGP(DMM, LOGL_ERROR,
333 "Rx MM Identity Response: invalid: no subscriber\n");
334 return -EINVAL;
335 }
336
Neels Hofmeyrb62289a2019-01-11 00:04:32 +0100337 DEBUGP(DMM, "IDENTITY RESPONSE: MI=%s\n", osmo_mi_name(mi, mi_len));
Harald Welte231ad4f2008-12-27 11:15:38 +0000338
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200339 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
Harald Welte7659de12009-12-13 12:39:18 +0100340
Neels Hofmeyrb62289a2019-01-11 00:04:32 +0100341 return vlr_subscr_rx_id_resp(conn->vsub, mi, mi_len);
Harald Welte231ad4f2008-12-27 11:15:38 +0000342}
343
Harald Welte2483f1b2016-06-19 18:06:02 +0200344/* Chapter 9.2.15: Receive Location Updating Request.
345 * Keep this function non-static for direct invocation by unit tests. */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100346int mm_rx_loc_upd_req(struct ran_conn *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +0000347{
Harald Welte2483f1b2016-06-19 18:06:02 +0200348 struct gsm_network *net = conn->network;
Harald Welte8470bf22008-12-25 23:28:35 +0000349 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000350 struct gsm48_loc_upd_req *lu;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200351 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200352 char mi_string[GSM48_MI_SIZE];
Harald Welte2483f1b2016-06-19 18:06:02 +0200353 enum vlr_lu_type vlr_lu_type = VLR_LU_TYPE_REGULAR;
Harald Welte2483f1b2016-06-19 18:06:02 +0200354 uint32_t tmsi;
355 char *imsi;
356 struct osmo_location_area_id old_lai, new_lai;
357 struct osmo_fsm_inst *lu_fsm;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200358 bool is_utran;
Harald Welte52b1f982008-12-23 20:25:15 +0000359
Harald Welte8470bf22008-12-25 23:28:35 +0000360 lu = (struct gsm48_loc_upd_req *) gh->data;
361
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100362 if (ran_conn_is_establishing_auth_ciph(conn)) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100363 LOG_RAN_CONN_CAT(conn, DMM, LOGL_ERROR,
364 "Cannot accept another LU, conn already busy establishing authenticity;"
365 " extraneous LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
366 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200367 return -EINVAL;
368 }
369
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100370 if (ran_conn_is_accepted(conn)) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100371 LOG_RAN_CONN_CAT(conn, DMM, LOGL_ERROR,
372 "Cannot accept another LU, conn already established;"
373 " extraneous LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
374 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200375 return -EINVAL;
376 }
Harald Welte2483f1b2016-06-19 18:06:02 +0200377
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100378 conn->complete_layer3_type = COMPLETE_LAYER3_LU;
379 ran_conn_update_id_from_mi(conn, lu->mi, lu->mi_len);
Neels Hofmeyr16c42b52018-04-02 12:26:16 +0200380
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100381 LOG_RAN_CONN_CAT(conn, DMM, LOGL_DEBUG, "LOCATION UPDATING REQUEST: MI=%s LU-type=%s\n",
382 osmo_mi_name(lu->mi, lu->mi_len), osmo_lu_type_name(lu->type));
Holger Freyther73487a22008-12-31 18:53:57 +0000383
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200384 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
Harald Welte7659de12009-12-13 12:39:18 +0100385
Harald Welte24ff6ee2009-12-22 00:41:05 +0100386 switch (lu->type) {
387 case GSM48_LUPD_NORMAL:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200388 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_NORMAL]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200389 vlr_lu_type = VLR_LU_TYPE_REGULAR;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100390 break;
391 case GSM48_LUPD_IMSI_ATT:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200392 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_ATTACH]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200393 vlr_lu_type = VLR_LU_TYPE_IMSI_ATTACH;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100394 break;
395 case GSM48_LUPD_PERIODIC:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200396 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_PERIODIC]);
Harald Welte2483f1b2016-06-19 18:06:02 +0200397 vlr_lu_type = VLR_LU_TYPE_PERIODIC;
Harald Welte24ff6ee2009-12-22 00:41:05 +0100398 break;
399 }
400
Harald Welte2483f1b2016-06-19 18:06:02 +0200401 /* TODO: 10.5.1.6 MS Classmark for UMTS / Classmark 2 */
402 /* TODO: 10.5.3.14 Aditional update parameters (CS fallback calls) */
403 /* TODO: 10.5.7.8 Device properties */
404 /* TODO: 10.5.1.15 MS network feature support */
Sylvain Munaut2030a2a2010-06-10 13:36:59 +0200405
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100406 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
407 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Welte52b1f982008-12-23 20:25:15 +0000408 switch (mi_type) {
409 case GSM_MI_TYPE_IMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200410 tmsi = GSM_RESERVED_TMSI;
411 imsi = mi_string;
Harald Welte4b634542008-12-27 01:55:51 +0000412 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000413 case GSM_MI_TYPE_TMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200414 tmsi = tmsi_from_string(mi_string);
415 imsi = NULL;
Harald Welte52b1f982008-12-23 20:25:15 +0000416 break;
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200417 default:
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100418 LOG_RAN_CONN_CAT(conn, DMM, LOGL_ERROR, "unknown mobile identity type\n");
Harald Welte2483f1b2016-06-19 18:06:02 +0200419 tmsi = GSM_RESERVED_TMSI;
420 imsi = NULL;
Harald Welte52b1f982008-12-23 20:25:15 +0000421 break;
422 }
423
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100424 gsm48_decode_lai2(&lu->lai, &old_lai);
425 new_lai.plmn = conn->network->plmn;
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200426 new_lai.lac = conn->lac;
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100427 LOG_RAN_CONN_CAT(conn, DMM, LOGL_DEBUG, "LU/new-LAC: %u/%u\n", old_lai.lac, new_lai.lac);
Harald Welte24516ea2009-07-04 10:18:00 +0200428
Neels Hofmeyr7814a832018-12-26 00:40:18 +0100429 is_utran = (conn->via_ran == OSMO_RAT_UTRAN_IU);
Neels Hofmeyr4d3a66b2018-03-31 18:45:59 +0200430 lu_fsm = vlr_loc_update(conn->fi,
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100431 RAN_CONN_E_ACCEPTED, RAN_CONN_E_CN_CLOSE, NULL,
Harald Welte2483f1b2016-06-19 18:06:02 +0200432 net->vlr, conn, vlr_lu_type, tmsi, imsi,
433 &old_lai, &new_lai,
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200434 is_utran || conn->network->authentication_required,
Harald Welte7b222aa2017-12-23 19:30:32 +0100435 is_utran || conn->network->a5_encryption_mask > 0x01,
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200436 classmark1_is_r99(&lu->classmark1),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200437 is_utran,
Harald Welte2483f1b2016-06-19 18:06:02 +0200438 net->vlr->cfg.assign_tmsi);
439 if (!lu_fsm) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100440 LOG_RAN_CONN(conn, LOGL_ERROR, "Can't start LU FSM\n");
Harald Welte2483f1b2016-06-19 18:06:02 +0200441 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800442 }
443
Harald Welte2483f1b2016-06-19 18:06:02 +0200444 /* From vlr_loc_update() we expect an implicit dispatch of
445 * VLR_ULA_E_UPDATE_LA, and thus we expect msc_vlr_subscr_assoc() to
446 * already have been called and completed. Has an error occured? */
Harald Welte255539c2008-12-28 02:26:27 +0000447
Harald Welte2483f1b2016-06-19 18:06:02 +0200448 if (!conn->vsub || conn->vsub->lu_fsm != lu_fsm) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100449 LOG_RAN_CONN(conn, LOGL_ERROR, "internal error during Location Updating attempt\n");
Harald Welte2483f1b2016-06-19 18:06:02 +0200450 return -EIO;
451 }
452
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200453 conn->vsub->classmark.classmark1 = lu->classmark1;
454 conn->vsub->classmark.classmark1_set = true;
455
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100456 ran_conn_complete_layer_3(conn);
Harald Welte2483f1b2016-06-19 18:06:02 +0200457 return 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000458}
459
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100460/* Turn int into semi-octet representation: 98 => 0x89 */
Harald Welte2483f1b2016-06-19 18:06:02 +0200461/* FIXME: libosmocore/libosmogsm */
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100462static uint8_t bcdify(uint8_t value)
Harald Welte4bfdfe72009-06-10 23:11:52 +0800463{
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100464 uint8_t ret;
465
466 ret = value / 10;
467 ret |= (value % 10) << 4;
468
469 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800470}
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100471
Harald Welte4bfdfe72009-06-10 23:11:52 +0800472
Harald Weltedb253af2008-12-30 17:56:55 +0000473/* Section 9.2.15a */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100474int gsm48_tx_mm_info(struct ran_conn *conn)
Harald Weltedb253af2008-12-30 17:56:55 +0000475{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100476 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 MM INF");
Harald Weltedb253af2008-12-30 17:56:55 +0000477 struct gsm48_hdr *gh;
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200478 struct gsm_network *net = conn->network;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200479 uint8_t *ptr8;
Daniel Willmanneea93372009-08-13 03:42:07 +0200480 int name_len, name_pad;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100481
Harald Welte4bfdfe72009-06-10 23:11:52 +0800482 time_t cur_t;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100483 struct tm* gmt_time;
484 struct tm* local_time;
485 int tzunits;
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100486 int dst = 0;
Harald Weltedb253af2008-12-30 17:56:55 +0000487
Harald Weltedb253af2008-12-30 17:56:55 +0000488 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
489 gh->proto_discr = GSM48_PDISC_MM;
490 gh->msg_type = GSM48_MT_MM_INFO;
491
492 if (net->name_long) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200493#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000494 name_len = strlen(net->name_long);
495 /* 10.5.3.5a */
496 ptr8 = msgb_put(msg, 3);
497 ptr8[0] = GSM48_IE_NAME_LONG;
498 ptr8[1] = name_len*2 +1;
499 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
500
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200501 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000502 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000503 ptr16[i] = htons(net->name_long[i]);
Harald Weltedb253af2008-12-30 17:56:55 +0000504
505 /* FIXME: Use Cell Broadcast, not UCS-2, since
506 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmanneea93372009-08-13 03:42:07 +0200507#endif
508 name_len = (strlen(net->name_long)*7)/8;
509 name_pad = (8 - strlen(net->name_long)*7)%8;
510 if (name_pad > 0)
511 name_len++;
512 /* 10.5.3.5a */
513 ptr8 = msgb_put(msg, 3);
514 ptr8[0] = GSM48_IE_NAME_LONG;
515 ptr8[1] = name_len +1;
516 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
517
518 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100519 gsm_7bit_encode_n(ptr8, name_len, net->name_long, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200520
Harald Weltedb253af2008-12-30 17:56:55 +0000521 }
522
523 if (net->name_short) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200524#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000525 name_len = strlen(net->name_short);
526 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200527 ptr8 = (uint8_t *) msgb_put(msg, 3);
Harald Welte7543eb72009-07-19 17:51:36 +0200528 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Weltedb253af2008-12-30 17:56:55 +0000529 ptr8[1] = name_len*2 + 1;
530 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
531
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200532 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000533 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000534 ptr16[i] = htons(net->name_short[i]);
Daniel Willmanneea93372009-08-13 03:42:07 +0200535#endif
536 name_len = (strlen(net->name_short)*7)/8;
537 name_pad = (8 - strlen(net->name_short)*7)%8;
538 if (name_pad > 0)
539 name_len++;
540 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200541 ptr8 = (uint8_t *) msgb_put(msg, 3);
Daniel Willmanneea93372009-08-13 03:42:07 +0200542 ptr8[0] = GSM48_IE_NAME_SHORT;
543 ptr8[1] = name_len +1;
544 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
545
546 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100547 gsm_7bit_encode_n(ptr8, name_len, net->name_short, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200548
Harald Weltedb253af2008-12-30 17:56:55 +0000549 }
550
Harald Weltedb253af2008-12-30 17:56:55 +0000551 /* Section 10.5.3.9 */
552 cur_t = time(NULL);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100553 gmt_time = gmtime(&cur_t);
554
Harald Weltedb253af2008-12-30 17:56:55 +0000555 ptr8 = msgb_put(msg, 8);
556 ptr8[0] = GSM48_IE_NET_TIME_TZ;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100557 ptr8[1] = bcdify(gmt_time->tm_year % 100);
558 ptr8[2] = bcdify(gmt_time->tm_mon + 1);
559 ptr8[3] = bcdify(gmt_time->tm_mday);
560 ptr8[4] = bcdify(gmt_time->tm_hour);
561 ptr8[5] = bcdify(gmt_time->tm_min);
562 ptr8[6] = bcdify(gmt_time->tm_sec);
563
Neels Hofmeyr73983952016-05-10 13:29:33 +0200564 if (net->tz.override) {
Harald Welte45f91712012-07-08 16:48:11 +0200565 /* Convert tz.hr and tz.mn to units */
Neels Hofmeyr73983952016-05-10 13:29:33 +0200566 if (net->tz.hr < 0) {
567 tzunits = ((net->tz.hr/-1)*4);
568 tzunits = tzunits + (net->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100569 ptr8[7] = bcdify(tzunits);
570 /* Set negative time */
571 ptr8[7] |= 0x08;
572 }
573 else {
Neels Hofmeyr73983952016-05-10 13:29:33 +0200574 tzunits = net->tz.hr*4;
575 tzunits = tzunits + (net->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100576 ptr8[7] = bcdify(tzunits);
577 }
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100578 /* Convert DST value */
Neels Hofmeyr73983952016-05-10 13:29:33 +0200579 if (net->tz.dst >= 0 && net->tz.dst <= 2)
580 dst = net->tz.dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100581 }
582 else {
583 /* Need to get GSM offset and convert into 15 min units */
584 /* This probably breaks if gmtoff returns a value not evenly divisible by 15? */
Harald Welte9c3dc902012-04-08 16:59:24 +0200585#ifdef HAVE_TM_GMTOFF_IN_TM
Benoit Bolsee38bb3442017-07-05 12:57:16 +0200586 local_time = localtime(&cur_t);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100587 tzunits = (local_time->tm_gmtoff/60)/15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200588#else
Benoit Bolsee38bb3442017-07-05 12:57:16 +0200589 /* find timezone offset */
590 time_t utc;
591 double offsetFromUTC;
592 utc = mktime(gmt_time);
593 local_time = localtime(&cur_t);
594 offsetFromUTC = difftime(cur_t, utc);
595 if (local_time->tm_isdst)
596 offsetFromUTC += 3600.0;
597 tzunits = ((int)offsetFromUTC) / 60 / 15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200598#endif
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100599 if (tzunits < 0) {
600 tzunits = tzunits/-1;
601 ptr8[7] = bcdify(tzunits);
602 /* Flip it to negative */
603 ptr8[7] |= 0x08;
604 }
605 else
606 ptr8[7] = bcdify(tzunits);
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100607
608 /* Does not support DST +2 */
609 if (local_time->tm_isdst)
610 dst = 1;
611 }
612
613 if (dst) {
614 ptr8 = msgb_put(msg, 3);
615 ptr8[0] = GSM48_IE_NET_DST;
616 ptr8[1] = 1;
617 ptr8[2] = dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100618 }
Harald Weltedb253af2008-12-30 17:56:55 +0000619
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100620 LOG_RAN_CONN(conn, LOGL_DEBUG, "Tx MM INFO\n");
Daniel Willmanneea93372009-08-13 03:42:07 +0200621
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800622 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Weltedb253af2008-12-30 17:56:55 +0000623}
624
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100625/*! Send an Authentication Request to MS on the given RAN connection
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100626 * according to 3GPP/ETSI TS 24.008, Section 9.2.2.
627 * \param[in] conn Subscriber connection to send on.
628 * \param[in] rand Random challenge token to send, must be 16 bytes long.
629 * \param[in] autn r99: In case of UMTS mutual authentication, AUTN token to
630 * send; must be 16 bytes long, or pass NULL for plain GSM auth.
631 * \param[in] key_seq auth tuple's sequence number.
632 */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100633int gsm48_tx_mm_auth_req(struct ran_conn *conn, uint8_t *rand,
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100634 uint8_t *autn, int key_seq)
Harald Welte7984d5c2009-08-12 22:56:50 +0200635{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100636 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 AUTH REQ");
Harald Welte7984d5c2009-08-12 22:56:50 +0200637 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut849f5542009-09-27 11:10:17 +0200638 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte7984d5c2009-08-12 22:56:50 +0200639
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100640 DEBUGP(DMM, "Tx AUTH REQ (rand = %s)\n", osmo_hexdump_nospc(rand, 16));
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100641 if (autn)
Neels Hofmeyr3355fd62017-02-14 17:42:25 +0100642 DEBUGP(DMM, " AUTH REQ (autn = %s)\n", osmo_hexdump_nospc(autn, 16));
Harald Welte7984d5c2009-08-12 22:56:50 +0200643
Harald Welte7984d5c2009-08-12 22:56:50 +0200644 gh->proto_discr = GSM48_PDISC_MM;
645 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
646
Sylvain Munautbd55a6d2009-12-24 00:23:46 +0100647 ar->key_seq = key_seq;
Sylvain Munaut849f5542009-09-27 11:10:17 +0200648
Harald Welte7984d5c2009-08-12 22:56:50 +0200649 /* 16 bytes RAND parameters */
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100650 osmo_static_assert(sizeof(ar->rand) == 16, sizeof_auth_req_r99_rand);
Harald Welte7984d5c2009-08-12 22:56:50 +0200651 if (rand)
Sylvain Munaut849f5542009-09-27 11:10:17 +0200652 memcpy(ar->rand, rand, 16);
Harald Welte7984d5c2009-08-12 22:56:50 +0200653
Neels Hofmeyrd6755152017-01-27 00:25:47 +0100654
655 /* 16 bytes AUTN */
656 if (autn)
657 msgb_tlv_put(msg, GSM48_IE_AUTN, 16, autn);
658
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800659 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte7984d5c2009-08-12 22:56:50 +0200660}
661
662/* Section 9.2.1 */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100663int gsm48_tx_mm_auth_rej(struct ran_conn *conn)
Harald Welte7984d5c2009-08-12 22:56:50 +0200664{
665 DEBUGP(DMM, "-> AUTH REJECT\n");
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800666 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
Harald Welte7984d5c2009-08-12 22:56:50 +0200667}
668
Harald Welte2483f1b2016-06-19 18:06:02 +0200669static int msc_vlr_tx_cm_serv_acc(void *msc_conn_ref);
Neels Hofmeyr15809592018-04-06 02:57:51 +0200670static int msc_vlr_tx_cm_serv_rej(void *msc_conn_ref, enum gsm48_reject_value result);
Harald Welte2483f1b2016-06-19 18:06:02 +0200671
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100672static int cm_serv_reuse_conn(struct ran_conn *conn, const uint8_t *mi_lv)
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100673{
Harald Welte2483f1b2016-06-19 18:06:02 +0200674 uint8_t mi_type;
675 char mi_string[GSM48_MI_SIZE];
676 uint32_t tmsi;
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100677
Harald Welte2483f1b2016-06-19 18:06:02 +0200678 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi_lv+1, mi_lv[0]);
679 mi_type = mi_lv[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100680
Harald Welte2483f1b2016-06-19 18:06:02 +0200681 switch (mi_type) {
682 case GSM_MI_TYPE_IMSI:
683 if (vlr_subscr_matches_imsi(conn->vsub, mi_string))
684 goto accept_reuse;
685 break;
686 case GSM_MI_TYPE_TMSI:
687 tmsi = osmo_load32be(mi_lv+2);
688 if (vlr_subscr_matches_tmsi(conn->vsub, tmsi))
689 goto accept_reuse;
690 break;
691 case GSM_MI_TYPE_IMEI:
692 if (vlr_subscr_matches_imei(conn->vsub, mi_string))
693 goto accept_reuse;
694 break;
695 default:
696 break;
697 }
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100698
Harald Welte2483f1b2016-06-19 18:06:02 +0200699 LOGP(DMM, LOGL_ERROR, "%s: CM Service Request with mismatching mobile identity: %s %s\n",
700 vlr_subscr_name(conn->vsub), gsm48_mi_type_name(mi_type), mi_string);
Neels Hofmeyr15809592018-04-06 02:57:51 +0200701 msc_vlr_tx_cm_serv_rej(conn, GSM48_REJECT_ILLEGAL_MS);
Harald Welte2483f1b2016-06-19 18:06:02 +0200702 return -EINVAL;
Sylvain Munautba87f452009-12-24 00:28:46 +0100703
Harald Welte2483f1b2016-06-19 18:06:02 +0200704accept_reuse:
705 DEBUGP(DMM, "%s: re-using already accepted connection\n",
706 vlr_subscr_name(conn->vsub));
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200707
708 if (!conn->received_cm_service_request) {
709 conn->received_cm_service_request = true;
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +0100710 ran_conn_get(conn, RAN_CONN_USE_CM_SERVICE);
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200711 }
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100712 ran_conn_update_id(conn);
Harald Welte2483f1b2016-06-19 18:06:02 +0200713 return conn->network->vlr->ops.tx_cm_serv_acc(conn);
Sylvain Munautba87f452009-12-24 00:28:46 +0100714}
715
Harald Welte4ed0e922009-01-10 03:17:30 +0000716/*
717 * Handle CM Service Requests
718 * a) Verify that the packet is long enough to contain the information
719 * we require otherwsie reject with INCORRECT_MESSAGE
720 * b) Try to parse the TMSI. If we do not have one reject
721 * c) Check that we know the subscriber with the TMSI otherwise reject
722 * with a HLR cause
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200723 * d) Set the subscriber on the conn and accept
Harald Welte2483f1b2016-06-19 18:06:02 +0200724 *
725 * Keep this function non-static for direct invocation by unit tests.
Harald Welte4ed0e922009-01-10 03:17:30 +0000726 */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100727int gsm48_rx_mm_serv_req(struct ran_conn *conn, struct msgb *msg)
Harald Welte4b634542008-12-27 01:55:51 +0000728{
Harald Welte2483f1b2016-06-19 18:06:02 +0200729 struct gsm_network *net = conn->network;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200730 uint8_t mi_type;
Harald Welteba4cf162009-01-10 01:49:35 +0000731 struct gsm48_hdr *gh = msgb_l3(msg);
732 struct gsm48_service_request *req =
733 (struct gsm48_service_request *)gh->data;
Holger Hans Peter Freyther5d658062010-05-14 08:02:08 +0800734 /* unfortunately in Phase1 the classmark2 length is variable */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200735 uint8_t classmark2_len = gh->data[1];
736 uint8_t *classmark2 = gh->data+2;
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200737 uint8_t *mi_p = classmark2 + classmark2_len;
738 uint8_t mi_len = *mi_p;
739 uint8_t *mi = mi_p + 1;
Harald Welte2483f1b2016-06-19 18:06:02 +0200740 struct osmo_location_area_id lai;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200741 bool is_utran;
Harald Welte2483f1b2016-06-19 18:06:02 +0200742
Neels Hofmeyr379d5792018-02-22 04:04:54 +0100743 lai.plmn = conn->network->plmn;
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200744 lai.lac = conn->lac;
Harald Welteba4cf162009-01-10 01:49:35 +0000745
746 if (msg->data_len < sizeof(struct gsm48_service_request*)) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100747 LOG_RAN_CONN(conn, LOGL_ERROR, "Rx CM SERVICE REQUEST: wrong message size (%u < %zu)\n",
748 msg->data_len, sizeof(struct gsm48_service_request*));
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200749 return msc_gsm48_tx_mm_serv_rej(conn,
750 GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000751 }
752
753 if (msg->data_len < req->mi_len + 6) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100754 LOG_RAN_CONN(conn, LOGL_ERROR, "Rx CM SERVICE REQUEST: message does not fit in packet\n");
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200755 return msc_gsm48_tx_mm_serv_rej(conn,
756 GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000757 }
758
Neels Hofmeyr7ce21dc2019-01-04 17:42:05 +0100759 if (ran_conn_is_establishing_auth_ciph(conn)) {
760 LOG_RAN_CONN(conn, LOGL_ERROR,
761 "Cannot accept CM Service Request, conn already busy establishing authenticity\n");
762 msc_vlr_tx_cm_serv_rej(conn, GSM48_REJECT_CONGESTION);
763 return -EINVAL;
764 /* or should we accept and note down the service request anyway? */
765 }
766
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100767 conn->complete_layer3_type = COMPLETE_LAYER3_CM_SERVICE_REQ;
768 ran_conn_update_id_from_mi(conn, mi, mi_len);
769 LOG_RAN_CONN_CAT(conn, DMM, LOGL_DEBUG, "Rx CM SERVICE REQUEST cm_service_type=0x%02x\n",
770 req->cm_service_type);
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100771
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100772 mi_type = (mi && mi_len) ? (mi[0] & GSM_MI_TYPE_MASK) : GSM_MI_TYPE_NONE;
Harald Welte3995d2e2018-01-24 11:23:54 +0100773 switch (mi_type) {
774 case GSM_MI_TYPE_IMSI:
775 case GSM_MI_TYPE_TMSI:
776 /* continue below */
777 break;
778 case GSM_MI_TYPE_IMEI:
779 if (req->cm_service_type == GSM48_CMSERV_EMERGENCY) {
780 /* We don't do emergency calls by IMEI */
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100781 LOG_RAN_CONN(conn, LOGL_NOTICE, "Tx CM SERVICE REQUEST REJECT\n");
Harald Welte3995d2e2018-01-24 11:23:54 +0100782 return msc_gsm48_tx_mm_serv_rej(conn, GSM48_REJECT_IMEI_NOT_ACCEPTED);
783 }
784 /* fall-through for non-emergency setup */
785 default:
Neels Hofmeyr361e5712019-01-03 02:32:14 +0100786 LOG_RAN_CONN(conn, LOGL_ERROR, "MI type is not expected: %s\n", gsm48_mi_type_name(mi_type));
Neels Hofmeyre2f24d52017-05-08 15:12:20 +0200787 return msc_gsm48_tx_mm_serv_rej(conn,
788 GSM48_REJECT_INCORRECT_MESSAGE);
Harald Welteba4cf162009-01-10 01:49:35 +0000789 }
790
Harald Welte37382ec2018-01-24 12:49:34 +0100791 switch (req->cm_service_type) {
792 case GSM48_CMSERV_MO_CALL_PACKET:
793 case GSM48_CMSERV_EMERGENCY:
794 case GSM48_CMSERV_SMS:
795 case GSM48_CMSERV_SUP_SERV:
796 /* continue below */
797 break;
798 default:
799 return msc_gsm48_tx_mm_serv_rej(conn, GSM48_REJECT_SRV_OPT_NOT_SUPPORTED);
800 }
801
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100802 if (ran_conn_is_accepted(conn))
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200803 return cm_serv_reuse_conn(conn, mi_p);
Harald Welte2483f1b2016-06-19 18:06:02 +0200804
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200805 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, mi_p);
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +0200806
Neels Hofmeyr7814a832018-12-26 00:40:18 +0100807 is_utran = (conn->via_ran == OSMO_RAT_UTRAN_IU);
Neels Hofmeyr4d3a66b2018-03-31 18:45:59 +0200808 vlr_proc_acc_req(conn->fi,
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100809 RAN_CONN_E_ACCEPTED, RAN_CONN_E_CN_CLOSE, NULL,
Harald Welte2483f1b2016-06-19 18:06:02 +0200810 net->vlr, conn,
811 VLR_PR_ARQ_T_CM_SERV_REQ, mi-1, &lai,
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200812 is_utran || conn->network->authentication_required,
Harald Welte7b222aa2017-12-23 19:30:32 +0100813 is_utran || conn->network->a5_encryption_mask > 0x01,
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200814 classmark2_is_r99(classmark2, classmark2_len),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +0200815 is_utran);
Holger Freythereb443982009-06-04 13:58:42 +0000816
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200817 /* From vlr_proc_acc_req() we expect an implicit dispatch of PR_ARQ_E_START we expect
818 * msc_vlr_subscr_assoc() to already have been called and completed. Has an error occured? */
819 if (!conn->vsub) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +0100820 LOG_RAN_CONN(conn, LOGL_ERROR, "subscriber not allowed to do a CM Service Request\n");
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200821 return -EIO;
822 }
823
824 memcpy(conn->vsub->classmark.classmark2, classmark2, classmark2_len);
825 conn->vsub->classmark.classmark2_len = classmark2_len;
826
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100827 ran_conn_complete_layer_3(conn);
Harald Welte2483f1b2016-06-19 18:06:02 +0200828 return 0;
Harald Welte4b634542008-12-27 01:55:51 +0000829}
830
Harald Welte49f8fcb2018-01-24 21:40:19 +0100831/* Receive a CM Re-establish Request */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100832static int gsm48_rx_cm_reest_req(struct ran_conn *conn, struct msgb *msg)
Harald Welte49f8fcb2018-01-24 21:40:19 +0100833{
834 uint8_t mi_type;
835 char mi_string[GSM48_MI_SIZE];
836 struct gsm48_hdr *gh = msgb_l3(msg);
837
838 uint8_t classmark2_len = gh->data[1];
839 uint8_t *classmark2 = gh->data+2;
840 uint8_t mi_len = *(classmark2 + classmark2_len);
841 uint8_t *mi = (classmark2 + classmark2_len + 1);
842
843 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
844 mi_type = mi[0] & GSM_MI_TYPE_MASK;
845 DEBUGP(DMM, "<- CM RE-ESTABLISH REQUEST MI(%s)=%s\n", gsm48_mi_type_name(mi_type), mi_string);
846
847 /* we don't support CM call re-establishment */
848 return msc_gsm48_tx_mm_serv_rej(conn, GSM48_REJECT_SRV_OPT_NOT_SUPPORTED);
849}
850
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100851static int gsm48_rx_mm_imsi_detach_ind(struct ran_conn *conn, struct msgb *msg)
Harald Welte2a139372009-02-22 21:14:55 +0000852{
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200853 struct gsm_network *network = conn->network;
Harald Welte2a139372009-02-22 21:14:55 +0000854 struct gsm48_hdr *gh = msgb_l3(msg);
855 struct gsm48_imsi_detach_ind *idi =
856 (struct gsm48_imsi_detach_ind *) gh->data;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200857 uint8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200858 char mi_string[GSM48_MI_SIZE];
Harald Welte2483f1b2016-06-19 18:06:02 +0200859 struct vlr_subscr *vsub = NULL;
Harald Welte2a139372009-02-22 21:14:55 +0000860
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200861 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Harald Welte2483f1b2016-06-19 18:06:02 +0200862 DEBUGP(DMM, "IMSI DETACH INDICATION: MI(%s)=%s\n",
863 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000864
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200865 rate_ctr_inc(&network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_DETACH]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100866
Harald Welte2a139372009-02-22 21:14:55 +0000867 switch (mi_type) {
868 case GSM_MI_TYPE_TMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200869 vsub = vlr_subscr_find_by_tmsi(network->vlr,
870 tmsi_from_string(mi_string));
Harald Welte2a139372009-02-22 21:14:55 +0000871 break;
872 case GSM_MI_TYPE_IMSI:
Harald Welte2483f1b2016-06-19 18:06:02 +0200873 vsub = vlr_subscr_find_by_imsi(network->vlr, mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000874 break;
875 case GSM_MI_TYPE_IMEI:
876 case GSM_MI_TYPE_IMEISV:
877 /* no sim card... FIXME: what to do ? */
Harald Welte2483f1b2016-06-19 18:06:02 +0200878 LOGP(DMM, LOGL_ERROR, "MI(%s)=%s: unimplemented mobile identity type\n",
879 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000880 break;
Alexander Couzensfbd96f52016-08-29 18:40:02 +0200881 default:
Harald Welte2483f1b2016-06-19 18:06:02 +0200882 LOGP(DMM, LOGL_ERROR, "MI(%s)=%s: unknown mobile identity type\n",
883 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000884 break;
885 }
886
Harald Welte2483f1b2016-06-19 18:06:02 +0200887 if (!vsub) {
888 LOGP(DMM, LOGL_ERROR, "IMSI DETACH for unknown subscriber MI(%s)=%s\n",
889 gsm48_mi_type_name(mi_type), mi_string);
890 } else {
891 LOGP(DMM, LOGL_INFO, "IMSI DETACH for %s\n", vlr_subscr_name(vsub));
Neels Hofmeyrfacd57a2017-12-15 03:48:48 +0100892
893 if (vsub->cs.is_paging)
894 subscr_paging_cancel(vsub, GSM_PAGING_EXPIRED);
895
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +0200896 /* We already got Classmark 1 during Location Updating ... but well, ok */
897 vsub->classmark.classmark1 = idi->classmark1;
898
Harald Welte2483f1b2016-06-19 18:06:02 +0200899 vlr_subscr_rx_imsi_detach(vsub);
900 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_DETACHED, vsub);
901 vlr_subscr_put(vsub);
902 }
Harald Welte2a139372009-02-22 21:14:55 +0000903
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100904 ran_conn_close(conn, 0);
Harald Welte2a139372009-02-22 21:14:55 +0000905 return 0;
906}
907
Harald Welted2a7f5a2009-06-05 20:08:20 +0000908static int gsm48_rx_mm_status(struct msgb *msg)
909{
910 struct gsm48_hdr *gh = msgb_l3(msg);
911
912 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
913
914 return 0;
915}
916
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100917static int parse_gsm_auth_resp(uint8_t *res, uint8_t *res_len,
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100918 struct ran_conn *conn,
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100919 struct msgb *msg)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100920{
921 struct gsm48_hdr *gh = msgb_l3(msg);
922 struct gsm48_auth_resp *ar = (struct gsm48_auth_resp*) gh->data;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100923
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100924 if (msgb_l3len(msg) < sizeof(*gh) + sizeof(*ar)) {
925 LOGP(DMM, LOGL_ERROR,
926 "%s: MM AUTHENTICATION RESPONSE:"
927 " l3 length invalid: %u\n",
Harald Welte2483f1b2016-06-19 18:06:02 +0200928 vlr_subscr_name(conn->vsub), msgb_l3len(msg));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100929 return -EINVAL;
930 }
931
932 *res_len = sizeof(ar->sres);
933 memcpy(res, ar->sres, sizeof(ar->sres));
934 return 0;
935}
936
937static int parse_umts_auth_resp(uint8_t *res, uint8_t *res_len,
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100938 struct ran_conn *conn,
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100939 struct msgb *msg)
940{
941 struct gsm48_hdr *gh;
942 uint8_t *data;
943 uint8_t iei;
944 uint8_t ie_len;
945 unsigned int data_len;
946
947 /* First parse the GSM part */
948 if (parse_gsm_auth_resp(res, res_len, conn, msg))
949 return -EINVAL;
950 OSMO_ASSERT(*res_len == 4);
951
952 /* Then add the extended res part */
953 gh = msgb_l3(msg);
954 data = gh->data + sizeof(struct gsm48_auth_resp);
955 data_len = msgb_l3len(msg) - (data - (uint8_t*)msgb_l3(msg));
956
957 if (data_len < 3) {
958 LOGP(DMM, LOGL_ERROR,
959 "%s: MM AUTHENTICATION RESPONSE:"
960 " l3 length invalid: %u\n",
Harald Welte2483f1b2016-06-19 18:06:02 +0200961 vlr_subscr_name(conn->vsub), msgb_l3len(msg));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100962 return -EINVAL;
963 }
964
965 iei = data[0];
966 ie_len = data[1];
967 if (iei != GSM48_IE_AUTH_RES_EXT) {
968 LOGP(DMM, LOGL_ERROR,
969 "%s: MM R99 AUTHENTICATION RESPONSE:"
970 " expected IEI 0x%02x, got 0x%02x\n",
Harald Welte2483f1b2016-06-19 18:06:02 +0200971 vlr_subscr_name(conn->vsub),
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100972 GSM48_IE_AUTH_RES_EXT, iei);
973 return -EINVAL;
974 }
975
976 if (ie_len > 12) {
977 LOGP(DMM, LOGL_ERROR,
978 "%s: MM R99 AUTHENTICATION RESPONSE:"
979 " extended Auth Resp IE 0x%02x is too large: %u bytes\n",
Harald Welte2483f1b2016-06-19 18:06:02 +0200980 vlr_subscr_name(conn->vsub), GSM48_IE_AUTH_RES_EXT, ie_len);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100981 return -EINVAL;
982 }
983
984 *res_len += ie_len;
985 memcpy(res + 4, &data[2], ie_len);
986 return 0;
987}
988
989/* Chapter 9.2.3: Authentication Response */
Neels Hofmeyrc036b792018-11-29 22:37:51 +0100990static int gsm48_rx_mm_auth_resp(struct ran_conn *conn, struct msgb *msg)
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100991{
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100992 uint8_t res[16];
993 uint8_t res_len;
994 int rc;
Neels Hofmeyr25f69d52018-03-10 03:44:06 +0100995 bool is_umts;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100996
Harald Welte2483f1b2016-06-19 18:06:02 +0200997 if (!conn->vsub) {
Neels Hofmeyr22a735b2017-02-03 01:22:40 +0100998 LOGP(DMM, LOGL_ERROR,
999 "MM AUTHENTICATION RESPONSE: invalid: no subscriber\n");
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001000 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001001 return -EINVAL;
1002 }
1003
Neels Hofmeyr25f69d52018-03-10 03:44:06 +01001004 is_umts = (msgb_l3len(msg) > sizeof(struct gsm48_hdr) + sizeof(struct gsm48_auth_resp));
1005
1006 if (is_umts)
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001007 rc = parse_umts_auth_resp(res, &res_len, conn, msg);
Neels Hofmeyr25f69d52018-03-10 03:44:06 +01001008 else
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001009 rc = parse_gsm_auth_resp(res, &res_len, conn, msg);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001010
1011 if (rc) {
Neels Hofmeyr8e0af0b2018-03-10 03:32:18 +01001012 LOGP(DMM, LOGL_ERROR,
1013 "%s: MM AUTHENTICATION RESPONSE: invalid: parsing %s AKA Auth Response"
1014 " failed with rc=%d; dispatching zero length SRES/RES to trigger failure\n",
Neels Hofmeyr25f69d52018-03-10 03:44:06 +01001015 vlr_subscr_name(conn->vsub), is_umts ? "UMTS" : "GSM", rc);
Neels Hofmeyr8e0af0b2018-03-10 03:32:18 +01001016 memset(res, 0, sizeof(res));
1017 res_len = 0;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001018 }
1019
1020 DEBUGP(DMM, "%s: MM %s AUTHENTICATION RESPONSE (%s = %s)\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001021 vlr_subscr_name(conn->vsub),
Neels Hofmeyrd97821f2018-03-10 04:51:39 +01001022 is_umts ? "UMTS" : "GSM", is_umts ? "res" : "sres",
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001023 osmo_hexdump_nospc(res, res_len));
1024
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001025 return vlr_subscr_rx_auth_resp(conn->vsub, classmark_is_r99(&conn->vsub->classmark),
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001026 conn->via_ran == OSMO_RAT_UTRAN_IU,
Harald Welte2483f1b2016-06-19 18:06:02 +02001027 res, res_len);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001028}
1029
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001030static int gsm48_rx_mm_auth_fail(struct ran_conn *conn, struct msgb *msg)
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001031{
1032 struct gsm48_hdr *gh = msgb_l3(msg);
1033 uint8_t cause;
1034 uint8_t auts_tag;
1035 uint8_t auts_len;
1036 uint8_t *auts;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001037
Harald Welte2483f1b2016-06-19 18:06:02 +02001038 if (!conn->vsub) {
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001039 LOGP(DMM, LOGL_ERROR,
1040 "MM R99 AUTHENTICATION FAILURE: invalid: no subscriber\n");
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001041 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001042 return -EINVAL;
1043 }
1044
1045 if (msgb_l3len(msg) < sizeof(*gh) + 1) {
1046 LOGP(DMM, LOGL_ERROR,
1047 "%s: MM R99 AUTHENTICATION FAILURE:"
1048 " l3 length invalid: %u\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001049 vlr_subscr_name(conn->vsub), msgb_l3len(msg));
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001050 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001051 return -EINVAL;
1052 }
1053
1054 cause = gh->data[0];
1055
1056 if (cause != GSM48_REJECT_SYNCH_FAILURE) {
1057 LOGP(DMM, LOGL_INFO,
1058 "%s: MM R99 AUTHENTICATION FAILURE: cause 0x%0x\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001059 vlr_subscr_name(conn->vsub), cause);
1060 vlr_subscr_rx_auth_fail(conn->vsub, NULL);
1061 return 0;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001062 }
1063
1064 /* This is a Synch Failure procedure, which should pass an AUTS to
1065 * resynchronize the sequence nr with the HLR. Expecting exactly one
1066 * TLV with 14 bytes of AUTS. */
1067
1068 if (msgb_l3len(msg) < sizeof(*gh) + 1 + 2) {
1069 LOGP(DMM, LOGL_INFO,
1070 "%s: MM R99 AUTHENTICATION FAILURE:"
1071 " invalid Synch Failure: missing AUTS IE\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001072 vlr_subscr_name(conn->vsub));
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001073 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001074 return -EINVAL;
1075 }
1076
1077 auts_tag = gh->data[1];
1078 auts_len = gh->data[2];
1079 auts = &gh->data[3];
1080
1081 if (auts_tag != GSM48_IE_AUTS
1082 || auts_len != 14) {
1083 LOGP(DMM, LOGL_INFO,
1084 "%s: MM R99 AUTHENTICATION FAILURE:"
1085 " invalid Synch Failure:"
1086 " expected AUTS IE 0x%02x of 14 bytes,"
1087 " got IE 0x%02x of %u bytes\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001088 vlr_subscr_name(conn->vsub),
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001089 GSM48_IE_AUTS, auts_tag, auts_len);
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001090 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001091 return -EINVAL;
1092 }
1093
1094 if (msgb_l3len(msg) < sizeof(*gh) + 1 + 2 + auts_len) {
1095 LOGP(DMM, LOGL_INFO,
1096 "%s: MM R99 AUTHENTICATION FAILURE:"
1097 " invalid Synch Failure msg: message truncated (%u)\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001098 vlr_subscr_name(conn->vsub), msgb_l3len(msg));
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001099 ran_conn_close(conn, GSM_CAUSE_AUTH_FAILED);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001100 return -EINVAL;
1101 }
1102
1103 /* We have an AUTS IE with exactly 14 bytes of AUTS and the msgb is
1104 * large enough. */
1105
1106 DEBUGP(DMM, "%s: MM R99 AUTHENTICATION SYNCH (AUTS = %s)\n",
Harald Welte2483f1b2016-06-19 18:06:02 +02001107 vlr_subscr_name(conn->vsub), osmo_hexdump_nospc(auts, 14));
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001108
Harald Welte2483f1b2016-06-19 18:06:02 +02001109 return vlr_subscr_rx_auth_fail(conn->vsub, auts);
1110}
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001111
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001112static int gsm48_rx_mm_tmsi_reall_compl(struct ran_conn *conn)
Harald Welte2483f1b2016-06-19 18:06:02 +02001113{
1114 DEBUGP(DMM, "TMSI Reallocation Completed. Subscriber: %s\n",
1115 vlr_subscr_name(conn->vsub));
1116 if (!conn->vsub) {
1117 LOGP(DMM, LOGL_ERROR,
1118 "Rx MM TMSI Reallocation Complete: invalid: no subscriber\n");
1119 return -EINVAL;
1120 }
1121 return vlr_subscr_rx_tmsi_reall_compl(conn->vsub);
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001122}
1123
Harald Weltebf5e8df2009-02-03 12:59:45 +00001124/* Receive a GSM 04.08 Mobility Management (MM) message */
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001125static int gsm0408_rcv_mm(struct ran_conn *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001126{
1127 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001128 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001129
Neels Hofmeyr531734a2016-03-14 16:13:24 +01001130 switch (gsm48_hdr_msg_type(gh)) {
Harald Welte52b1f982008-12-23 20:25:15 +00001131 case GSM48_MT_MM_LOC_UPD_REQUEST:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001132 rc = mm_rx_loc_upd_req(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001133 break;
1134 case GSM48_MT_MM_ID_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001135 rc = mm_rx_id_resp(conn, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001136 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001137 case GSM48_MT_MM_CM_SERV_REQ:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001138 rc = gsm48_rx_mm_serv_req(conn, msg);
Harald Welte4b634542008-12-27 01:55:51 +00001139 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001140 case GSM48_MT_MM_STATUS:
Harald Welted2a7f5a2009-06-05 20:08:20 +00001141 rc = gsm48_rx_mm_status(msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001142 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001143 case GSM48_MT_MM_TMSI_REALL_COMPL:
Harald Welte2483f1b2016-06-19 18:06:02 +02001144 rc = gsm48_rx_mm_tmsi_reall_compl(conn);
Harald Welte69b2af22009-01-06 19:47:00 +00001145 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001146 case GSM48_MT_MM_IMSI_DETACH_IND:
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +02001147 rc = gsm48_rx_mm_imsi_detach_ind(conn, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001148 break;
1149 case GSM48_MT_MM_CM_REEST_REQ:
Harald Welte49f8fcb2018-01-24 21:40:19 +01001150 rc = gsm48_rx_cm_reest_req(conn, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001151 break;
1152 case GSM48_MT_MM_AUTH_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001153 rc = gsm48_rx_mm_auth_resp(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001154 break;
Neels Hofmeyr22a735b2017-02-03 01:22:40 +01001155 case GSM48_MT_MM_AUTH_FAIL:
1156 rc = gsm48_rx_mm_auth_fail(conn, msg);
1157 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001158 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01001159 LOGP(DMM, LOGL_NOTICE, "Unknown GSM 04.08 MM msg type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001160 gh->msg_type);
1161 break;
1162 }
1163
1164 return rc;
1165}
Harald Weltebf5e8df2009-02-03 12:59:45 +00001166
Harald Welte2d35ae62009-02-06 12:02:13 +00001167/* Receive a PAGING RESPONSE message from the MS */
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001168static int gsm48_rx_rr_pag_resp(struct ran_conn *conn, struct msgb *msg)
Harald Welte2d35ae62009-02-06 12:02:13 +00001169{
Harald Welte2483f1b2016-06-19 18:06:02 +02001170 struct gsm_network *net = conn->network;
Harald Welte2d35ae62009-02-06 12:02:13 +00001171 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001172 uint8_t classmark2_len = gh->data[1];
1173 uint8_t *classmark2 = gh->data+2;
1174 uint8_t *mi_lv = classmark2 + classmark2_len;
Harald Welte2483f1b2016-06-19 18:06:02 +02001175 struct osmo_location_area_id lai;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001176 bool is_utran;
Harald Welte2483f1b2016-06-19 18:06:02 +02001177
Neels Hofmeyr379d5792018-02-22 04:04:54 +01001178 lai.plmn = conn->network->plmn;
Neels Hofmeyre2f24d52017-05-08 15:12:20 +02001179 lai.lac = conn->lac;
Harald Welte2d35ae62009-02-06 12:02:13 +00001180
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001181 if (ran_conn_is_establishing_auth_ciph(conn)) {
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001182 LOGP(DMM, LOGL_ERROR,
1183 "Ignoring Paging Response, conn already busy establishing authenticity\n");
1184 return 0;
1185 }
1186
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001187 if (ran_conn_is_accepted(conn)) {
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001188 LOGP(DMM, LOGL_ERROR, "Ignoring Paging Response, conn already established\n");
1189 return 0;
1190 }
1191
Neels Hofmeyr361e5712019-01-03 02:32:14 +01001192 conn->complete_layer3_type = COMPLETE_LAYER3_PAGING_RESP;
1193 ran_conn_update_id_from_mi(conn, mi_lv + 1, *mi_lv);
1194 LOG_RAN_CONN_CAT(conn, DRR, LOGL_DEBUG, "PAGING RESPONSE\n");
Neels Hofmeyr6d804b12017-02-18 22:20:46 +01001195
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001196 is_utran = (conn->via_ran == OSMO_RAT_UTRAN_IU);
Neels Hofmeyr4d3a66b2018-03-31 18:45:59 +02001197 vlr_proc_acc_req(conn->fi,
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001198 RAN_CONN_E_ACCEPTED, RAN_CONN_E_CN_CLOSE, NULL,
Harald Welte2483f1b2016-06-19 18:06:02 +02001199 net->vlr, conn,
1200 VLR_PR_ARQ_T_PAGING_RESP, mi_lv, &lai,
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001201 is_utran || conn->network->authentication_required,
Harald Welte7b222aa2017-12-23 19:30:32 +01001202 is_utran || conn->network->a5_encryption_mask > 0x01,
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001203 classmark2_is_r99(classmark2, classmark2_len),
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001204 is_utran);
Holger Freyther053e09d2009-02-14 22:51:06 +00001205
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001206 /* From vlr_proc_acc_req() we expect an implicit dispatch of PR_ARQ_E_START we expect
1207 * msc_vlr_subscr_assoc() to already have been called and completed. Has an error occured? */
1208 if (!conn->vsub) {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +01001209 LOG_RAN_CONN(conn, LOGL_ERROR, "subscriber not allowed to do a Paging Response\n");
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001210 return -EIO;
1211 }
1212
1213 memcpy(conn->vsub->classmark.classmark2, classmark2, classmark2_len);
1214 conn->vsub->classmark.classmark2_len = classmark2_len;
1215
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001216 ran_conn_complete_layer_3(conn);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001217 return 0;
Harald Welte2d35ae62009-02-06 12:02:13 +00001218}
1219
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001220static int gsm48_rx_rr_app_info(struct ran_conn *conn, struct msgb *msg)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001221{
1222 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001223 uint8_t apdu_id_flags;
1224 uint8_t apdu_len;
1225 uint8_t *apdu_data;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001226
1227 apdu_id_flags = gh->data[0];
1228 apdu_len = gh->data[1];
1229 apdu_data = gh->data+2;
Alexander Couzensfbd96f52016-08-29 18:40:02 +02001230
Max8dc8f232017-02-09 19:13:02 +01001231 DEBUGP(DRR, "RX APPLICATION INFO id/flags=0x%02x apdu_len=%u apdu=%s\n",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001232 apdu_id_flags, apdu_len, osmo_hexdump(apdu_data, apdu_len));
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001233
Harald Welte2483f1b2016-06-19 18:06:02 +02001234 /* we're not using the app info blob anywhere, so ignore. */
1235#if 0
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001236 return db_apdu_blob_store(conn->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte2483f1b2016-06-19 18:06:02 +02001237#else
1238 return 0;
1239#endif
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001240}
1241
Harald Weltebf5e8df2009-02-03 12:59:45 +00001242/* Receive a GSM 04.08 Radio Resource (RR) message */
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001243static int gsm0408_rcv_rr(struct ran_conn *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001244{
1245 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001246 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001247
1248 switch (gh->msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001249 case GSM48_MT_RR_PAG_RESP:
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001250 rc = gsm48_rx_rr_pag_resp(conn, msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001251 break;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001252 case GSM48_MT_RR_APP_INFO:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001253 rc = gsm48_rx_rr_app_info(conn, msg);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001254 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001255 default:
Philippd37981e2016-10-10 15:11:41 +02001256 LOGP(DRR, LOGL_NOTICE, "MSC: Unimplemented %s GSM 04.08 RR "
1257 "message\n", gsm48_rr_msg_name(gh->msg_type));
Harald Welte52b1f982008-12-23 20:25:15 +00001258 break;
1259 }
1260
Harald Welte2d35ae62009-02-06 12:02:13 +00001261 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001262}
1263
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001264int gsm48_send_rr_app_info(struct ran_conn *conn, uint8_t apdu_id,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001265 uint8_t apdu_len, const uint8_t *apdu)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001266{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01001267 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 APP INF");
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001268 struct gsm48_hdr *gh;
1269
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001270 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1271 apdu_id, apdu_len);
Alexander Couzensfbd96f52016-08-29 18:40:02 +02001272
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001273 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1274 gh->proto_discr = GSM48_PDISC_RR;
1275 gh->msg_type = GSM48_MT_RR_APP_INFO;
1276 gh->data[0] = apdu_id;
1277 gh->data[1] = apdu_len;
1278 memcpy(gh->data+2, apdu, apdu_len);
1279
Holger Hans Peter Freyther9ce1b272010-06-16 13:52:55 +08001280 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001281}
1282
Harald Welte2483f1b2016-06-19 18:06:02 +02001283static bool msg_is_initially_permitted(const struct gsm48_hdr *hdr)
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08001284{
Harald Welte2483f1b2016-06-19 18:06:02 +02001285 uint8_t pdisc = gsm48_hdr_pdisc(hdr);
1286 uint8_t msg_type = gsm48_hdr_msg_type(hdr);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08001287
Harald Welte2483f1b2016-06-19 18:06:02 +02001288 switch (pdisc) {
1289 case GSM48_PDISC_MM:
1290 switch (msg_type) {
1291 case GSM48_MT_MM_LOC_UPD_REQUEST:
1292 case GSM48_MT_MM_CM_SERV_REQ:
Harald Welte49f8fcb2018-01-24 21:40:19 +01001293 case GSM48_MT_MM_CM_REEST_REQ:
Harald Welte2483f1b2016-06-19 18:06:02 +02001294 case GSM48_MT_MM_AUTH_RESP:
1295 case GSM48_MT_MM_AUTH_FAIL:
1296 case GSM48_MT_MM_ID_RESP:
1297 case GSM48_MT_MM_TMSI_REALL_COMPL:
1298 case GSM48_MT_MM_IMSI_DETACH_IND:
1299 return true;
1300 default:
1301 break;
1302 }
1303 break;
1304 case GSM48_PDISC_RR:
1305 switch (msg_type) {
Neels Hofmeyr325f1062018-12-07 16:39:52 +01001306 /* GSM48_MT_RR_CIPH_M_COMPL is actually handled in bssmap_rx_ciph_compl() and gets redirected in the
1307 * BSSAP layer to ran_conn_cipher_mode_compl() (before this here is reached) */
Harald Welte2483f1b2016-06-19 18:06:02 +02001308 case GSM48_MT_RR_PAG_RESP:
1309 return true;
1310 default:
1311 break;
1312 }
1313 break;
1314 default:
1315 break;
Neels Hofmeyr42eb0142016-05-20 17:15:44 +02001316 }
1317
Harald Welte2483f1b2016-06-19 18:06:02 +02001318 return false;
Neels Hofmeyr42eb0142016-05-20 17:15:44 +02001319}
1320
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001321void cm_service_request_concludes(struct ran_conn *conn,
Harald Welte2483f1b2016-06-19 18:06:02 +02001322 struct msgb *msg)
1323{
1324
1325 /* If a CM Service Request was received before, this is the request the
1326 * conn was opened for. No need to wait for further messages. */
1327
1328 if (!conn->received_cm_service_request)
1329 return;
1330
1331 if (log_check_level(DMM, LOGL_DEBUG)) {
1332 struct gsm48_hdr *gh = msgb_l3(msg);
1333 uint8_t pdisc = gsm48_hdr_pdisc(gh);
1334 uint8_t msg_type = gsm48_hdr_msg_type(gh);
1335
Neels Hofmeyr78ada642017-03-10 02:15:20 +01001336 DEBUGP(DMM, "%s: rx msg %s:"
Harald Welte2483f1b2016-06-19 18:06:02 +02001337 " received_cm_service_request changes to false\n",
1338 vlr_subscr_name(conn->vsub),
Neels Hofmeyr78ada642017-03-10 02:15:20 +01001339 gsm48_pdisc_msgtype_name(pdisc, msg_type));
Harald Welte2483f1b2016-06-19 18:06:02 +02001340 }
1341 conn->received_cm_service_request = false;
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001342 ran_conn_put(conn, RAN_CONN_USE_CM_SERVICE);
Harald Welte2483f1b2016-06-19 18:06:02 +02001343}
1344
Harald Weltec2007852018-02-03 21:08:26 +01001345/* TS 24.007 11.2.3.2.3 Message Type Octet / Duplicate Detection */
1346int gsm0407_pdisc_ctr_bin(uint8_t pdisc)
1347{
1348 switch (pdisc) {
1349 case GSM48_PDISC_MM:
1350 case GSM48_PDISC_CC:
1351 case GSM48_PDISC_NC_SS:
1352 return 0;
1353 case GSM48_PDISC_GROUP_CC:
1354 return 1;
1355 case GSM48_PDISC_BCAST_CC:
1356 return 2;
1357 case GSM48_PDISC_LOC:
1358 return 3;
1359 default:
1360 return -1;
1361 }
1362}
1363
1364/* extract the N(SD) and return the modulo value for a R98 message */
1365static uint8_t gsm0407_determine_nsd_ret_modulo_r99(uint8_t pdisc, uint8_t msg_type, uint8_t *n_sd)
1366{
1367 switch (pdisc) {
1368 case GSM48_PDISC_MM:
1369 case GSM48_PDISC_CC:
1370 case GSM48_PDISC_NC_SS:
1371 *n_sd = (msg_type >> 6) & 0x3;
1372 return 4;
1373 case GSM48_PDISC_GROUP_CC:
1374 case GSM48_PDISC_BCAST_CC:
1375 case GSM48_PDISC_LOC:
1376 *n_sd = (msg_type >> 6) & 0x1;
1377 return 2;
1378 default:
1379 /* no sequence number, we cannot detect dups */
1380 return 0;
1381 }
1382}
1383
1384/* extract the N(SD) and return the modulo value for a R99 message */
1385static uint8_t gsm0407_determine_nsd_ret_modulo_r98(uint8_t pdisc, uint8_t msg_type, uint8_t *n_sd)
1386{
1387 switch (pdisc) {
1388 case GSM48_PDISC_MM:
1389 case GSM48_PDISC_CC:
1390 case GSM48_PDISC_NC_SS:
1391 case GSM48_PDISC_GROUP_CC:
1392 case GSM48_PDISC_BCAST_CC:
1393 case GSM48_PDISC_LOC:
1394 *n_sd = (msg_type >> 6) & 0x1;
1395 return 2;
1396 default:
1397 /* no sequence number, we cannot detect dups */
1398 return 0;
1399 }
1400}
1401
1402/* TS 24.007 11.2.3.2 Message Type Octet / Duplicate Detection */
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001403static bool gsm0407_is_duplicate(struct ran_conn *conn, struct msgb *msg)
Harald Weltec2007852018-02-03 21:08:26 +01001404{
1405 struct gsm48_hdr *gh;
1406 uint8_t pdisc;
Harald Weltef6400732018-10-21 12:55:11 +02001407 uint8_t n_sd, modulo;
1408 int bin;
Harald Weltec2007852018-02-03 21:08:26 +01001409
1410 gh = msgb_l3(msg);
1411 pdisc = gsm48_hdr_pdisc(gh);
1412
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001413 if (conn->vsub && classmark_is_r99(&conn->vsub->classmark)) {
Harald Weltec2007852018-02-03 21:08:26 +01001414 modulo = gsm0407_determine_nsd_ret_modulo_r99(pdisc, gh->msg_type, &n_sd);
Neels Hofmeyr986fe7e2018-09-13 03:05:52 +02001415 } else { /* pre R99 */
1416 modulo = gsm0407_determine_nsd_ret_modulo_r98(pdisc, gh->msg_type, &n_sd);
Harald Weltec2007852018-02-03 21:08:26 +01001417 }
1418 if (modulo == 0)
1419 return false;
1420 bin = gsm0407_pdisc_ctr_bin(pdisc);
1421 if (bin < 0)
1422 return false;
1423
1424 OSMO_ASSERT(bin < ARRAY_SIZE(conn->n_sd_next));
1425 if (n_sd != conn->n_sd_next[bin]) {
1426 /* not what we expected: duplicate */
1427 return true;
1428 } else {
1429 /* as expected: no dup; update expected counter for next message */
1430 conn->n_sd_next[bin] = (n_sd + 1) % modulo;
1431 return false;
1432 }
1433}
Harald Welte2483f1b2016-06-19 18:06:02 +02001434
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001435extern int gsm0408_rcv_cc(struct ran_conn *conn, struct msgb *msg);
Harald Welte27989d42018-06-21 20:39:20 +02001436
Neels Hofmeyr378a4922016-05-09 21:07:43 +02001437/* Main entry point for GSM 04.08/44.008 Layer 3 data (e.g. from the BSC). */
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001438int gsm0408_dispatch(struct ran_conn *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001439{
Philipp Maier91f10c72017-04-20 18:40:37 +02001440 struct gsm48_hdr *gh;
1441 uint8_t pdisc;
Harald Welte8470bf22008-12-25 23:28:35 +00001442 int rc = 0;
Harald Welte51008772009-12-29 11:49:12 +01001443
Neels Hofmeyr0906a392017-09-19 14:36:06 +02001444 OSMO_ASSERT(msg->l3h);
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02001445 OSMO_ASSERT(conn);
1446 OSMO_ASSERT(msg);
1447
Philipp Maier91f10c72017-04-20 18:40:37 +02001448 gh = msgb_l3(msg);
1449 pdisc = gsm48_hdr_pdisc(gh);
1450
Harald Weltec2007852018-02-03 21:08:26 +01001451 if (gsm0407_is_duplicate(conn, msg)) {
1452 LOGP(DRLL, LOGL_NOTICE, "%s: Discarding duplicate L3 message\n",
1453 (conn && conn->vsub) ? vlr_subscr_name(conn->vsub) : "UNKNOWN");
1454 return 0;
1455 }
1456
Neels Hofmeyr78ada642017-03-10 02:15:20 +01001457 LOGP(DRLL, LOGL_DEBUG, "Dispatching 04.08 message %s (0x%x:0x%x)\n",
1458 gsm48_pdisc_msgtype_name(pdisc, gsm48_hdr_msg_type(gh)),
1459 pdisc, gsm48_hdr_msg_type(gh));
Harald Welte2483f1b2016-06-19 18:06:02 +02001460
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001461 if (!ran_conn_is_accepted(conn)
Harald Welte2483f1b2016-06-19 18:06:02 +02001462 && !msg_is_initially_permitted(gh)) {
1463 LOGP(DRLL, LOGL_ERROR,
Neels Hofmeyr78ada642017-03-10 02:15:20 +01001464 "subscr %s: Message not permitted for initial conn: %s\n",
1465 vlr_subscr_name(conn->vsub),
1466 gsm48_pdisc_msgtype_name(pdisc, gsm48_hdr_msg_type(gh)));
Harald Welte2483f1b2016-06-19 18:06:02 +02001467 return -EACCES;
1468 }
1469
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001470 if (conn->vsub && conn->vsub->cs.attached_via_ran != conn->via_ran) {
1471 LOGP(DMM, LOGL_ERROR,
1472 "%s: Illegal situation: RAN type mismatch:"
1473 " attached via %s, received message via %s\n",
1474 vlr_subscr_name(conn->vsub),
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001475 osmo_rat_type_name(conn->vsub->cs.attached_via_ran),
1476 osmo_rat_type_name(conn->via_ran));
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001477 return -EACCES;
1478 }
1479
Philipp Maiere0d5caa2017-02-27 16:56:59 +01001480#if 0
Holger Hans Peter Freyther758f4df2010-06-21 10:34:03 +08001481 if (silent_call_reroute(conn, msg))
1482 return silent_call_rx(conn, msg);
Philipp Maiere0d5caa2017-02-27 16:56:59 +01001483#endif
Alexander Couzensfbd96f52016-08-29 18:40:02 +02001484
Harald Welte52b1f982008-12-23 20:25:15 +00001485 switch (pdisc) {
1486 case GSM48_PDISC_CC:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001487 rc = gsm0408_rcv_cc(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001488 break;
1489 case GSM48_PDISC_MM:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001490 rc = gsm0408_rcv_mm(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001491 break;
1492 case GSM48_PDISC_RR:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001493 rc = gsm0408_rcv_rr(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001494 break;
Harald Weltebcae43f2008-12-27 21:45:37 +00001495 case GSM48_PDISC_SMS:
Holger Hans Peter Freyther97643312010-06-17 16:41:25 +08001496 rc = gsm0411_rcv_sms(conn, msg);
Harald Weltebcae43f2008-12-27 21:45:37 +00001497 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001498 case GSM48_PDISC_MM_GPRS:
Harald Weltebcae43f2008-12-27 21:45:37 +00001499 case GSM48_PDISC_SM_GPRS:
Harald Welte5d24ba12009-12-24 12:13:17 +01001500 LOGP(DRLL, LOGL_NOTICE, "Unimplemented "
1501 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02001502 rc = -ENOTSUP;
Harald Welte52b1f982008-12-23 20:25:15 +00001503 break;
Harald Welte6eafe912009-10-16 08:32:58 +02001504 case GSM48_PDISC_NC_SS:
Vadim Yanitskiy5b860fa2018-06-12 05:24:52 +07001505 rc = gsm0911_rcv_nc_ss(conn, msg);
Harald Welte6eafe912009-10-16 08:32:58 +02001506 break;
Harald Welteeac38c32017-05-29 18:02:53 +02001507 case GSM48_PDISC_TEST:
1508 rc = gsm0414_rcv_test(conn, msg);
1509 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001510 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01001511 LOGP(DRLL, LOGL_NOTICE, "Unknown "
1512 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02001513 rc = -EINVAL;
Harald Welte52b1f982008-12-23 20:25:15 +00001514 break;
1515 }
1516
1517 return rc;
1518}
Harald Welte8470bf22008-12-25 23:28:35 +00001519
Harald Welte2483f1b2016-06-19 18:06:02 +02001520/***********************************************************************
1521 * VLR integration
1522 ***********************************************************************/
1523
1524/* VLR asks us to send an authentication request */
Neels Hofmeyr8b6e5362018-11-30 02:57:33 +01001525static int msc_vlr_tx_auth_req(void *msc_conn_ref, struct vlr_auth_tuple *at,
Harald Welte2483f1b2016-06-19 18:06:02 +02001526 bool send_autn)
1527{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001528 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001529 return gsm48_tx_mm_auth_req(conn, at->vec.rand,
1530 send_autn? at->vec.autn : NULL,
1531 at->key_seq);
1532}
1533
1534/* VLR asks us to send an authentication reject */
1535static int msc_vlr_tx_auth_rej(void *msc_conn_ref)
1536{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001537 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001538 return gsm48_tx_mm_auth_rej(conn);
1539}
1540
1541/* VLR asks us to transmit an Identity Request of given type */
1542static int msc_vlr_tx_id_req(void *msc_conn_ref, uint8_t mi_type)
1543{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001544 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001545 return mm_tx_identity_req(conn, mi_type);
1546}
1547
1548/* VLR asks us to transmit a Location Update Accept */
1549static int msc_vlr_tx_lu_acc(void *msc_conn_ref, uint32_t send_tmsi)
1550{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001551 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001552 return gsm0408_loc_upd_acc(conn, send_tmsi);
1553}
1554
1555/* VLR asks us to transmit a Location Update Reject */
Neels Hofmeyr15809592018-04-06 02:57:51 +02001556static int msc_vlr_tx_lu_rej(void *msc_conn_ref, enum gsm48_reject_value cause)
Harald Welte2483f1b2016-06-19 18:06:02 +02001557{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001558 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001559 return gsm0408_loc_upd_rej(conn, cause);
1560}
1561
1562/* VLR asks us to transmit a CM Service Accept */
1563static int msc_vlr_tx_cm_serv_acc(void *msc_conn_ref)
1564{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001565 struct ran_conn *conn = msc_conn_ref;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001566 return msc_gsm48_tx_mm_serv_ack(conn);
1567}
1568
1569static int msc_vlr_tx_common_id(void *msc_conn_ref)
1570{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001571 struct ran_conn *conn = msc_conn_ref;
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001572 return msc_tx_common_id(conn);
Harald Welte2483f1b2016-06-19 18:06:02 +02001573}
1574
Stefan Sperling3a741282018-03-13 21:11:49 +01001575/* VLR asks us to transmit MM info. */
1576static int msc_vlr_tx_mm_info(void *msc_conn_ref)
1577{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001578 struct ran_conn *conn = msc_conn_ref;
Stefan Sperling3a741282018-03-13 21:11:49 +01001579 if (!conn->network->send_mm_info)
1580 return 0;
1581 return gsm48_tx_mm_info(conn);
1582}
1583
Harald Welte2483f1b2016-06-19 18:06:02 +02001584/* VLR asks us to transmit a CM Service Reject */
Neels Hofmeyr15809592018-04-06 02:57:51 +02001585static int msc_vlr_tx_cm_serv_rej(void *msc_conn_ref, enum gsm48_reject_value cause)
Harald Welte2483f1b2016-06-19 18:06:02 +02001586{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001587 struct ran_conn *conn = msc_conn_ref;
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001588 int rc;
Harald Welte2483f1b2016-06-19 18:06:02 +02001589
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001590 rc = msc_gsm48_tx_mm_serv_rej(conn, cause);
1591
1592 if (conn->received_cm_service_request) {
1593 conn->received_cm_service_request = false;
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001594 ran_conn_put(conn, RAN_CONN_USE_CM_SERVICE);
Neels Hofmeyre3d3dc62018-03-31 00:02:14 +02001595 }
1596
1597 return rc;
Harald Welte2483f1b2016-06-19 18:06:02 +02001598}
1599
Neels Hofmeyr703638e2017-12-14 05:30:16 +01001600/* For msc_vlr_set_ciph_mode() */
1601osmo_static_assert(sizeof(((struct gsm0808_encrypt_info*)0)->key) >= sizeof(((struct osmo_auth_vector*)0)->kc),
1602 gsm0808_encrypt_info_key_fits_osmo_auth_vec_kc);
1603
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001604int ran_conn_geran_set_cipher_mode(struct ran_conn *conn, bool umts_aka, bool retrieve_imeisv)
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001605{
Philipp Maierec5901c2019-01-08 12:29:49 +01001606 struct gsm_network *net;
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001607 struct gsm0808_encrypt_info ei;
1608 int i, j = 0;
1609 int request_classmark = 0;
1610 int request_classmark_for_a5_n = 0;
Philipp Maierec5901c2019-01-08 12:29:49 +01001611 struct vlr_auth_tuple *tuple;
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001612
1613 if (!conn || !conn->vsub || !conn->vsub->last_tuple) {
1614 /* This should really never happen, because we checked this in msc_vlr_set_ciph_mode()
1615 * already. */
1616 LOGP(DMM, LOGL_ERROR, "Internal error: missing state during Ciphering Mode Command\n");
1617 return -EINVAL;
1618 }
1619
Philipp Maierec5901c2019-01-08 12:29:49 +01001620 net = conn->network;
1621 tuple = conn->vsub->last_tuple;
1622
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001623 for (i = 0; i < 8; i++) {
1624 int supported;
1625
1626 /* A5/n permitted by osmo-msc.cfg? */
1627 if (!(net->a5_encryption_mask & (1 << i)))
1628 continue;
1629
1630 /* A5/n supported by MS? */
1631 supported = classmark_supports_a5(&conn->vsub->classmark, i);
1632 if (supported == 1) {
1633 ei.perm_algo[j++] = vlr_ciph_to_gsm0808_alg_id(i);
1634 /* A higher A5/n is supported, so no need to request a Classmark
1635 * for support of a lesser A5/n. */
1636 request_classmark = 0;
1637 } else if (supported < 0) {
1638 request_classmark = -supported;
1639 request_classmark_for_a5_n = i;
1640 }
1641 }
1642 ei.perm_algo_len = j;
1643
1644 if (request_classmark) {
1645 /* The highest A5/n as from osmo-msc.cfg might be available, but we are
1646 * still missing the Classmark information for that from the MS. First
1647 * ask for that. */
1648 LOGP(DMM, LOGL_DEBUG, "%s: to determine whether A5/%d is supported,"
1649 " first ask for a Classmark Update to obtain Classmark %d\n",
1650 vlr_subscr_name(conn->vsub), request_classmark_for_a5_n,
1651 request_classmark);
1652
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001653 return ran_conn_classmark_request_then_cipher_mode_cmd(conn, umts_aka, retrieve_imeisv);
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001654 }
1655
1656 if (ei.perm_algo_len == 0) {
1657 LOGP(DMM, LOGL_ERROR, "%s: cannot start ciphering, no intersection "
Neels Hofmeyr5769d362018-12-18 03:13:51 +01001658 "between MSC-configured and MS-supported A5 algorithms. MSC: %x MS: %s\n",
1659 vlr_subscr_name(conn->vsub), net->a5_encryption_mask,
1660 classmark_a5_name(&conn->vsub->classmark));
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001661 return -ENOTSUP;
1662 }
1663
1664 DEBUGP(DMM, "-> CIPHER MODE COMMAND %s\n", vlr_subscr_name(conn->vsub));
1665
1666 tuple = conn->vsub->last_tuple;
1667
1668 /* In case of UMTS AKA, the Kc for ciphering must be derived from the 3G auth
1669 * tokens. tuple->vec.kc was calculated from the GSM algorithm and is not
1670 * necessarily a match for the UMTS AKA tokens. */
1671 if (umts_aka)
1672 osmo_auth_c3(ei.key, tuple->vec.ck, tuple->vec.ik);
1673 else
1674 memcpy(ei.key, tuple->vec.kc, sizeof(tuple->vec.kc));
1675 ei.key_len = sizeof(tuple->vec.kc);
1676
Neels Hofmeyrf41658d2018-11-30 04:35:50 +01001677 conn->geran_encr = (struct geran_encr){};
1678 if (ei.key_len <= sizeof(conn->geran_encr.key)) {
1679 memcpy(conn->geran_encr.key, ei.key, ei.key_len);
1680 conn->geran_encr.key_len = ei.key_len;
Neels Hofmeyrb0779bb2018-11-29 23:37:19 +01001681 }
Neels Hofmeyrf41658d2018-11-30 04:35:50 +01001682 /* conn->geran_encr.alg_id remains unknown until we receive a Cipher Mode Complete from the BSC */
Neels Hofmeyrb0779bb2018-11-29 23:37:19 +01001683
Neels Hofmeyr3117b702018-09-13 03:23:07 +02001684 return a_iface_tx_cipher_mode(conn, &ei, retrieve_imeisv);
1685}
1686
Neels Hofmeyrda21a522018-03-02 01:50:09 +01001687/* VLR asks us to start using ciphering.
1688 * (Keep non-static to allow regression testing on this function.) */
1689int msc_vlr_set_ciph_mode(void *msc_conn_ref,
1690 bool umts_aka,
1691 bool retrieve_imeisv)
Harald Welte2483f1b2016-06-19 18:06:02 +02001692{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001693 struct ran_conn *conn = msc_conn_ref;
Harald Welte2483f1b2016-06-19 18:06:02 +02001694 struct vlr_subscr *vsub;
Neels Hofmeyr8b6e5362018-11-30 02:57:33 +01001695 struct vlr_auth_tuple *tuple;
Harald Welte2483f1b2016-06-19 18:06:02 +02001696
1697 if (!conn || !conn->vsub) {
1698 LOGP(DMM, LOGL_ERROR, "Cannot send Ciphering Mode Command to"
1699 " NULL conn/subscriber");
1700 return -EINVAL;
1701 }
1702
1703 vsub = conn->vsub;
1704 tuple = vsub->last_tuple;
1705
1706 if (!tuple) {
1707 LOGP(DMM, LOGL_ERROR, "subscr %s: Cannot send Ciphering Mode"
1708 " Command: no auth tuple available\n",
1709 vlr_subscr_name(vsub));
1710 return -EINVAL;
1711 }
1712
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001713 switch (conn->via_ran) {
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001714 case OSMO_RAT_GERAN_A:
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001715 return ran_conn_geran_set_cipher_mode(conn, umts_aka, retrieve_imeisv);
Neels Hofmeyr703638e2017-12-14 05:30:16 +01001716
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001717 case OSMO_RAT_UTRAN_IU:
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001718#ifdef BUILD_IU
1719 DEBUGP(DMM, "-> SECURITY MODE CONTROL %s\n",
1720 vlr_subscr_name(conn->vsub));
Neels Hofmeyr00e82d62017-07-05 15:19:52 +02001721 return ranap_iu_tx_sec_mode_cmd(conn->iu.ue_ctx, &tuple->vec, 0, 1);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001722#else
Neels Hofmeyr7814a832018-12-26 00:40:18 +01001723 LOGP(DMM, LOGL_ERROR, "Cannot send Security Mode Control over OSMO_RAT_UTRAN_IU,"
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001724 " built without Iu support\n");
1725 return -ENOTSUP;
1726#endif
1727
1728 default:
1729 break;
1730 }
1731 LOGP(DMM, LOGL_ERROR,
1732 "%s: cannot start ciphering, unknown RAN type %d\n",
1733 vlr_subscr_name(conn->vsub), conn->via_ran);
1734 return -ENOTSUP;
1735}
1736
Neels Hofmeyr3c20a5e2018-11-30 01:08:36 +01001737void ran_conn_rx_sec_mode_compl(struct ran_conn *conn)
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001738{
1739 struct vlr_ciph_result vlr_res = {};
1740
1741 if (!conn || !conn->vsub) {
1742 LOGP(DMM, LOGL_ERROR,
1743 "Rx Security Mode Complete for invalid conn\n");
1744 return;
1745 }
1746
1747 DEBUGP(DMM, "<- SECURITY MODE COMPLETE %s\n",
1748 vlr_subscr_name(conn->vsub));
1749
1750 vlr_res.cause = VLR_CIPH_COMPL;
1751 vlr_subscr_rx_ciph_res(conn->vsub, &vlr_res);
Harald Welte2483f1b2016-06-19 18:06:02 +02001752}
1753
1754/* VLR informs us that the subscriber data has somehow been modified */
1755static void msc_vlr_subscr_update(struct vlr_subscr *subscr)
1756{
Maxa263bb22017-12-27 13:23:44 +01001757 LOGVSUBP(LOGL_NOTICE, subscr, "VLR: update for IMSI=%s (MSISDN=%s, used=%d)\n",
1758 subscr->imsi, subscr->msisdn, subscr->use_count);
Neels Hofmeyr361e5712019-01-03 02:32:14 +01001759 ran_conn_update_id_for_vsub(subscr);
Harald Welte2483f1b2016-06-19 18:06:02 +02001760}
1761
Neels Hofmeyr68cf9572018-09-18 15:52:58 +02001762static void update_classmark(const struct gsm_classmark *src, struct gsm_classmark *dst)
1763{
1764 if (src->classmark1_set) {
1765 dst->classmark1 = src->classmark1;
1766 dst->classmark1_set = true;
1767 }
1768 if (src->classmark2_len) {
1769 dst->classmark2_len = src->classmark2_len;
1770 memcpy(dst->classmark2, src->classmark2, sizeof(dst->classmark2));
1771 }
1772 if (src->classmark3_len) {
1773 dst->classmark3_len = src->classmark3_len;
1774 memcpy(dst->classmark3, src->classmark3, sizeof(dst->classmark3));
1775 }
1776}
1777
Harald Welte2483f1b2016-06-19 18:06:02 +02001778/* VLR informs us that the subscriber has been associated with a conn */
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001779static int msc_vlr_subscr_assoc(void *msc_conn_ref,
Harald Welte2483f1b2016-06-19 18:06:02 +02001780 struct vlr_subscr *vsub)
1781{
Neels Hofmeyrc036b792018-11-29 22:37:51 +01001782 struct ran_conn *conn = msc_conn_ref;
Max48d4ec02018-02-12 16:51:03 +01001783 OSMO_ASSERT(vsub);
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001784 if (conn->vsub) {
1785 if (conn->vsub == vsub)
Neels Hofmeyr46c06e22019-01-04 17:42:05 +01001786 LOG_RAN_CONN(conn, LOGL_NOTICE, "msc_vlr_subscr_assoc(): conn already associated with %s\n",
1787 vlr_subscr_name(vsub));
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001788 else {
Neels Hofmeyr46c06e22019-01-04 17:42:05 +01001789 LOG_RAN_CONN(conn, LOGL_ERROR, "msc_vlr_subscr_assoc(): conn already associated with a subscriber,"
1790 " cannot associate with %s\n", vlr_subscr_name(vsub));
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001791 return -EINVAL;
1792 }
1793 }
1794
Harald Welte2483f1b2016-06-19 18:06:02 +02001795 conn->vsub = vlr_subscr_get(vsub);
Max48d4ec02018-02-12 16:51:03 +01001796 OSMO_ASSERT(conn->vsub);
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001797 conn->vsub->cs.attached_via_ran = conn->via_ran;
Neels Hofmeyr68cf9572018-09-18 15:52:58 +02001798
1799 /* In case we have already received Classmark Information before the VLR Subscriber was
1800 * associated with the conn: merge the new Classmark into vsub->classmark. Don't overwrite valid
1801 * vsub->classmark with unset classmark, though. */
1802 update_classmark(&conn->temporary_classmark, &conn->vsub->classmark);
Neels Hofmeyr361e5712019-01-03 02:32:14 +01001803 ran_conn_update_id(conn);
Neels Hofmeyr1035d902018-12-28 21:22:32 +01001804 return 0;
Harald Welte2483f1b2016-06-19 18:06:02 +02001805}
1806
Vadim Yanitskiy8a0e2582018-06-14 03:54:33 +07001807static int msc_vlr_route_gsup_msg(struct vlr_subscr *vsub,
1808 struct osmo_gsup_message *gsup_msg)
1809{
1810 switch (gsup_msg->message_type) {
Vadim Yanitskiy8a6ef552018-06-12 08:21:20 +07001811 /* GSM 09.11 code implementing SS/USSD */
1812 case OSMO_GSUP_MSGT_PROC_SS_REQUEST:
1813 case OSMO_GSUP_MSGT_PROC_SS_RESULT:
1814 case OSMO_GSUP_MSGT_PROC_SS_ERROR:
1815 DEBUGP(DMSC, "Routed to GSM 09.11 SS/USSD handler\n");
1816 return gsm0911_gsup_handler(vsub, gsup_msg);
1817
Vadim Yanitskiy76ef72d2018-11-07 05:08:18 +07001818 /* GSM 04.11 code implementing MO SMS */
1819 case OSMO_GSUP_MSGT_MO_FORWARD_SM_ERROR:
1820 case OSMO_GSUP_MSGT_MO_FORWARD_SM_RESULT:
1821 case OSMO_GSUP_MSGT_READY_FOR_SM_ERROR:
1822 case OSMO_GSUP_MSGT_READY_FOR_SM_RESULT:
1823 DEBUGP(DMSC, "Routed to GSM 04.11 MO handler\n");
1824 return gsm411_gsup_mo_handler(vsub, gsup_msg);
1825
Vadim Yanitskiy82cc8a52018-11-15 01:05:53 +07001826 /* GSM 04.11 code implementing MT SMS */
1827 case OSMO_GSUP_MSGT_MT_FORWARD_SM_REQUEST:
1828 DEBUGP(DMSC, "Routed to GSM 04.11 MT handler\n");
1829 return gsm411_gsup_mt_handler(vsub, gsup_msg);
1830
Vadim Yanitskiy8a0e2582018-06-14 03:54:33 +07001831 default:
1832 LOGP(DMM, LOGL_ERROR, "No handler found for %s, dropping message...\n",
1833 osmo_gsup_message_type_name(gsup_msg->message_type));
1834 return -GMM_CAUSE_MSGT_NOTEXIST_NOTIMPL;
1835 }
1836}
1837
Harald Welte2483f1b2016-06-19 18:06:02 +02001838/* operations that we need to implement for libvlr */
1839static const struct vlr_ops msc_vlr_ops = {
1840 .tx_auth_req = msc_vlr_tx_auth_req,
1841 .tx_auth_rej = msc_vlr_tx_auth_rej,
1842 .tx_id_req = msc_vlr_tx_id_req,
1843 .tx_lu_acc = msc_vlr_tx_lu_acc,
1844 .tx_lu_rej = msc_vlr_tx_lu_rej,
1845 .tx_cm_serv_acc = msc_vlr_tx_cm_serv_acc,
1846 .tx_cm_serv_rej = msc_vlr_tx_cm_serv_rej,
1847 .set_ciph_mode = msc_vlr_set_ciph_mode,
Neels Hofmeyr84da6b12016-05-20 21:59:55 +02001848 .tx_common_id = msc_vlr_tx_common_id,
Stefan Sperling3a741282018-03-13 21:11:49 +01001849 .tx_mm_info = msc_vlr_tx_mm_info,
Harald Welte2483f1b2016-06-19 18:06:02 +02001850 .subscr_update = msc_vlr_subscr_update,
1851 .subscr_assoc = msc_vlr_subscr_assoc,
Vadim Yanitskiy8a0e2582018-06-14 03:54:33 +07001852 .forward_gsup_msg = msc_vlr_route_gsup_msg,
Harald Welte2483f1b2016-06-19 18:06:02 +02001853};
1854
1855/* Allocate net->vlr so that the VTY may configure the VLR's data structures */
1856int msc_vlr_alloc(struct gsm_network *net)
1857{
1858 net->vlr = vlr_alloc(net, &msc_vlr_ops);
1859 if (!net->vlr)
1860 return -ENOMEM;
1861 net->vlr->user_ctx = net;
1862 return 0;
1863}
1864
1865/* Launch the VLR, i.e. its GSUP connection */
1866int msc_vlr_start(struct gsm_network *net)
1867{
Stefan Sperlingafa030d2018-12-06 12:06:59 +01001868 struct ipaccess_unit *ipa_dev;
1869
Harald Welte2483f1b2016-06-19 18:06:02 +02001870 OSMO_ASSERT(net->vlr);
Stefan Sperlingafa030d2018-12-06 12:06:59 +01001871
1872 ipa_dev = talloc_zero(net->vlr, struct ipaccess_unit);
1873 ipa_dev->unit_name = "MSC";
1874 ipa_dev->serno = net->msc_ipa_name; /* NULL unless configured via VTY */
Stefan Sperling36dedee2018-12-06 13:16:24 +01001875 ipa_dev->swversion = PACKAGE_NAME "-" PACKAGE_VERSION;
Stefan Sperlingafa030d2018-12-06 12:06:59 +01001876
1877 return vlr_start(ipa_dev, net->vlr, net->gsup_server_addr_str, net->gsup_server_port);
Harald Welte2483f1b2016-06-19 18:06:02 +02001878}
Neels Hofmeyr79e580b2018-03-22 16:48:22 +01001879
1880struct msgb *gsm48_create_mm_serv_rej(enum gsm48_reject_value value)
1881{
1882 struct msgb *msg;
1883 struct gsm48_hdr *gh;
1884
1885 msg = gsm48_msgb_alloc_name("GSM 04.08 SERV REJ");
1886 if (!msg)
1887 return NULL;
1888
1889 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
1890 gh->proto_discr = GSM48_PDISC_MM;
1891 gh->msg_type = GSM48_MT_MM_CM_SERV_REJ;
1892 gh->data[0] = value;
1893
1894 return msg;
1895}
1896
1897struct msgb *gsm48_create_loc_upd_rej(uint8_t cause)
1898{
1899 struct gsm48_hdr *gh;
1900 struct msgb *msg;
1901
1902 msg = gsm48_msgb_alloc_name("GSM 04.08 LOC UPD REJ");
1903 if (!msg)
1904 return NULL;
1905
1906 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
1907 gh->proto_discr = GSM48_PDISC_MM;
1908 gh->msg_type = GSM48_MT_MM_LOC_UPD_REJECT;
1909 gh->data[0] = cause;
1910 return msg;
1911}
1912
1913int gsm48_extract_mi(uint8_t *classmark2_lv, int length, char *mi_string, uint8_t *mi_type)
1914{
1915 /* Check the size for the classmark */
1916 if (length < 1 + *classmark2_lv)
1917 return -1;
1918
1919 uint8_t *mi_lv = classmark2_lv + *classmark2_lv + 1;
1920 if (length < 2 + *classmark2_lv + mi_lv[0])
1921 return -2;
1922
1923 *mi_type = mi_lv[1] & GSM_MI_TYPE_MASK;
1924 return gsm48_mi_to_string(mi_string, GSM48_MI_SIZE, mi_lv+1, *mi_lv);
1925}
1926
1927int gsm48_paging_extract_mi(struct gsm48_pag_resp *resp, int length,
1928 char *mi_string, uint8_t *mi_type)
1929{
1930 static const uint32_t classmark_offset =
1931 offsetof(struct gsm48_pag_resp, classmark2);
1932 uint8_t *classmark2_lv = (uint8_t *) &resp->classmark2;
1933 return gsm48_extract_mi(classmark2_lv, length - classmark_offset,
1934 mi_string, mi_type);
1935}