blob: aa3d78a9bc827ffd1addd9bdb290384da15ba3b5 [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 Weltebf5e8df2009-02-03 12:59:45 +00004/* (C) 2008-2009 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
Sylvain Munaut30a15382009-12-24 00:27:26 +010037#include <openbsc/auth.h>
Harald Welte75a983f2008-12-27 21:34:06 +000038#include <openbsc/db.h>
Harald Welte8470bf22008-12-25 23:28:35 +000039#include <openbsc/debug.h>
40#include <openbsc/gsm_data.h>
41#include <openbsc/gsm_subscriber.h>
Daniel Willmann8b3390e2008-12-28 00:31:09 +000042#include <openbsc/gsm_04_11.h>
Harald Welte8470bf22008-12-25 23:28:35 +000043#include <openbsc/gsm_04_08.h>
Holger Hans Peter Freythere0009f12010-08-12 01:41:57 +080044#include <openbsc/gsm_04_80.h>
Harald Welte8470bf22008-12-25 23:28:35 +000045#include <openbsc/abis_rsl.h>
Holger Freytherca362a62009-01-04 21:05:01 +000046#include <openbsc/chan_alloc.h>
Harald Welte0b4c34e2009-02-09 17:54:43 +000047#include <openbsc/paging.h>
Holger Freyther053e09d2009-02-14 22:51:06 +000048#include <openbsc/signal.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020049#include <osmocom/abis/trau_frame.h>
Harald Welte11fa29c2009-02-19 17:24:39 +000050#include <openbsc/trau_mux.h>
Harald Welte805f6442009-07-28 18:25:29 +020051#include <openbsc/rtp_proxy.h>
Harald Weltedcaf5652009-07-23 18:56:43 +020052#include <openbsc/transaction.h>
Harald Welte6eafe912009-10-16 08:32:58 +020053#include <openbsc/ussd.h>
Harald Welte51008772009-12-29 11:49:12 +010054#include <openbsc/silent_call.h>
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080055#include <openbsc/bsc_api.h>
Holger Hans Peter Freyther88519ea2010-06-30 12:44:07 +080056#include <openbsc/osmo_msc.h>
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +010057#include <openbsc/handover.h>
Holger Hans Peter Freyther53122b02015-08-20 19:10:58 +020058#include <openbsc/mncc_int.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020059#include <osmocom/abis/e1_input.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010060#include <osmocom/core/bitvec.h>
Holger Hans Peter Freyther841c2002010-09-30 18:52:23 +080061
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010062#include <osmocom/gsm/gsm48.h>
63#include <osmocom/gsm/gsm0480.h>
64#include <osmocom/gsm/gsm_utils.h>
Max8db12e42016-04-18 23:11:18 +020065#include <osmocom/gsm/protocol/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010066#include <osmocom/core/msgb.h>
67#include <osmocom/core/talloc.h>
68#include <osmocom/gsm/tlv.h>
Harald Welte52b1f982008-12-23 20:25:15 +000069
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +020070#include <assert.h>
71
Harald Welte (local)d19e58b2009-08-15 02:30:58 +020072void *tall_locop_ctx;
Sylvain Munaut30a15382009-12-24 00:27:26 +010073void *tall_authciphop_ctx;
Harald Welte2cf161b2009-06-20 22:36:41 +020074
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +020075static int tch_rtp_signal(struct gsm_lchan *lchan, int signal);
76
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +020077static int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn);
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +080078static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020079 uint8_t pdisc, uint8_t msg_type);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +010080static void schedule_reject(struct gsm_subscriber_connection *conn);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +080081static void release_anchor(struct gsm_subscriber_connection *conn);
Harald Welte65e74cc2008-12-29 01:55:35 +000082
Harald Welte52b1f982008-12-23 20:25:15 +000083struct gsm_lai {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020084 uint16_t mcc;
85 uint16_t mnc;
86 uint16_t lac;
Harald Welte52b1f982008-12-23 20:25:15 +000087};
88
Andreas Eversberga83d5112013-12-07 18:32:28 +010089static int apply_codec_restrictions(struct gsm_bts *bts,
90 struct gsm_mncc_bearer_cap *bcap)
91{
92 int i, j;
93
94 /* remove unsupported speech versions from list */
95 for (i = 0, j = 0; bcap->speech_ver[i] >= 0; i++) {
96 if (bcap->speech_ver[i] == GSM48_BCAP_SV_FR)
97 bcap->speech_ver[j++] = GSM48_BCAP_SV_FR;
98 if (bcap->speech_ver[i] == GSM48_BCAP_SV_EFR && bts->codec.efr)
99 bcap->speech_ver[j++] = GSM48_BCAP_SV_EFR;
100 if (bcap->speech_ver[i] == GSM48_BCAP_SV_AMR_F && bts->codec.amr)
101 bcap->speech_ver[j++] = GSM48_BCAP_SV_AMR_F;
102 if (bcap->speech_ver[i] == GSM48_BCAP_SV_HR && bts->codec.hr)
103 bcap->speech_ver[j++] = GSM48_BCAP_SV_HR;
104 if (bcap->speech_ver[i] == GSM48_BCAP_SV_AMR_H && bts->codec.amr)
105 bcap->speech_ver[j++] = GSM48_BCAP_SV_AMR_H;
106 }
107 bcap->speech_ver[j] = -1;
108
109 return 0;
110}
111
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200112static uint32_t new_callref = 0x80000001;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800113
Harald Welte31c00f72011-03-03 23:29:05 +0100114void cc_tx_to_mncc(struct gsm_network *net, struct msgb *msg)
115{
116 net->mncc_recv(net, msg);
117}
118
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800119static int gsm48_conn_sendmsg(struct msgb *msg, struct gsm_subscriber_connection *conn,
120 struct gsm_trans *trans)
121{
122 struct gsm48_hdr *gh = (struct gsm48_hdr *) msg->data;
123
124 /* if we get passed a transaction reference, do some common
125 * work that the caller no longer has to do */
126 if (trans) {
127 gh->proto_discr = trans->protocol | (trans->transaction_id << 4);
128 msg->lchan = trans->conn->lchan;
129 }
130
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800131 if (msg->lchan) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200132 struct e1inp_sign_link *sign_link =
133 msg->lchan->ts->trx->rsl_link;
134
135 msg->dst = sign_link;
Neels Hofmeyr531734a2016-03-14 16:13:24 +0100136 if (gsm48_hdr_pdisc(gh) == GSM48_PDISC_CC)
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800137 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x) "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200138 "Sending '%s' to MS.\n",
139 sign_link->trx->bts->nr,
140 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800141 gh->proto_discr & 0xf0,
142 gsm48_cc_msg_name(gh->msg_type));
143 else
144 DEBUGP(DCC, "(bts %d trx %d ts %d pd %02x) "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200145 "Sending 0x%02x to MS.\n",
146 sign_link->trx->bts->nr,
147 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800148 gh->proto_discr, gh->msg_type);
149 }
150
Holger Hans Peter Freyther8d380dc2010-11-10 10:16:02 +0100151 return gsm0808_submit_dtap(conn, msg, 0, 0);
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800152}
Sylvain Munaut30a15382009-12-24 00:27:26 +0100153
Holger Hans Peter Freythere0009f12010-08-12 01:41:57 +0800154int gsm48_cc_tx_notify_ss(struct gsm_trans *trans, const char *message)
155{
156 struct gsm48_hdr *gh;
157 struct msgb *ss_notify;
158
159 ss_notify = gsm0480_create_notifySS(message);
160 if (!ss_notify)
161 return -1;
162
163 gsm0480_wrap_invoke(ss_notify, GSM0480_OP_CODE_NOTIFY_SS, 0);
164 uint8_t *data = msgb_push(ss_notify, 1);
165 data[0] = ss_notify->len - 1;
166 gh = (struct gsm48_hdr *) msgb_push(ss_notify, sizeof(*gh));
167 gh->msg_type = GSM48_MT_CC_FACILITY;
168 return gsm48_conn_sendmsg(ss_notify, trans->conn, trans);
169}
170
Harald Weltecf149ee2012-01-23 16:40:24 +0100171void release_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100172{
173 if (!conn->sec_operation)
174 return;
175
176 talloc_free(conn->sec_operation);
177 conn->sec_operation = NULL;
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800178 msc_release_connection(conn);
Sylvain Munaut30a15382009-12-24 00:27:26 +0100179}
180
Harald Weltecf149ee2012-01-23 16:40:24 +0100181void allocate_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100182{
Sylvain Munaut30a15382009-12-24 00:27:26 +0100183 conn->sec_operation = talloc_zero(tall_authciphop_ctx,
184 struct gsm_security_operation);
185}
186
Sylvain Munaut0fbfd1b2010-12-01 22:37:05 +0100187int gsm48_secure_channel(struct gsm_subscriber_connection *conn, int key_seq,
188 gsm_cbfn *cb, void *cb_data)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100189{
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200190 struct gsm_network *net = conn->network;
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800191 struct gsm_subscriber *subscr = conn->subscr;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100192 struct gsm_security_operation *op;
193 struct gsm_auth_tuple atuple;
194 int status = -1, rc;
195
196 /* Check if we _can_ enable encryption. Cases where we can't:
197 * - Encryption disabled in config
198 * - Channel already secured (nothing to do)
199 * - Subscriber equipment doesn't support configured encryption
200 */
201 if (!net->a5_encryption) {
202 status = GSM_SECURITY_NOAVAIL;
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800203 } else if (conn->lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100204 DEBUGP(DMM, "Requesting to secure an already secure channel");
Andreas Eversberg641475c2013-07-10 08:58:03 +0200205 status = GSM_SECURITY_ALREADY;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100206 } else if (!ms_cm2_a5n_support(subscr->equipment.classmark2,
207 net->a5_encryption)) {
208 DEBUGP(DMM, "Subscriber equipment doesn't support requested encryption");
209 status = GSM_SECURITY_NOAVAIL;
210 }
211
212 /* If not done yet, try to get info for this user */
213 if (status < 0) {
214 rc = auth_get_tuple_for_subscr(&atuple, subscr, key_seq);
215 if (rc <= 0)
216 status = GSM_SECURITY_NOAVAIL;
217 }
218
219 /* Are we done yet ? */
220 if (status >= 0)
221 return cb ?
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800222 cb(GSM_HOOK_RR_SECURITY, status, NULL, conn, cb_data) :
Sylvain Munaut30a15382009-12-24 00:27:26 +0100223 0;
224
225 /* Start an operation (can't have more than one pending !!!) */
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800226 if (conn->sec_operation)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100227 return -EBUSY;
228
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800229 allocate_security_operation(conn);
230 op = conn->sec_operation;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100231 op->cb = cb;
232 op->cb_data = cb_data;
233 memcpy(&op->atuple, &atuple, sizeof(struct gsm_auth_tuple));
234
235 /* FIXME: Should start a timer for completion ... */
236
237 /* Then do whatever is needed ... */
Neels Hofmeyrd2fa7a52016-03-10 23:30:37 +0100238 if (rc == AUTH_DO_AUTH_THEN_CIPH) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100239 /* Start authentication */
Harald Welte121e9a42016-04-20 13:13:19 +0200240 return gsm48_tx_mm_auth_req(conn, op->atuple.vec.rand, op->atuple.key_seq);
Harald Welte86dda082010-12-23 18:07:49 +0100241 } else if (rc == AUTH_DO_CIPH) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100242 /* Start ciphering directly */
Sylvain Munaut67706df2010-11-29 08:19:04 +0100243 return gsm0808_cipher_mode(conn, net->a5_encryption,
Harald Welte121e9a42016-04-20 13:13:19 +0200244 op->atuple.vec.kc, 8, 0);
Sylvain Munaut30a15382009-12-24 00:27:26 +0100245 }
246
247 return -EINVAL; /* not reached */
248}
249
Maxddee01f2016-05-24 14:23:27 +0200250static bool subscr_regexp_check(const struct gsm_network *net, const char *imsi)
251{
252 if (!net->authorized_reg_str)
253 return false;
254
255 if (regexec(&net->authorized_regexp, imsi, 0, NULL, 0) != REG_NOMATCH)
256 return true;
257
258 return false;
259}
260
Holger Freyther73487a22008-12-31 18:53:57 +0000261static int authorize_subscriber(struct gsm_loc_updating_operation *loc,
262 struct gsm_subscriber *subscriber)
Holger Freyther89824fc2008-12-30 16:18:18 +0000263{
264 if (!subscriber)
265 return 0;
266
Holger Freyther73487a22008-12-31 18:53:57 +0000267 /*
268 * Do not send accept yet as more information should arrive. Some
269 * phones will not send us the information and we will have to check
270 * what we want to do with that.
271 */
272 if (loc && (loc->waiting_for_imsi || loc->waiting_for_imei))
273 return 0;
274
Jacob Erlbeck1e30a282014-12-03 09:28:24 +0100275 switch (subscriber->group->net->auth_policy) {
Jan Luebbe06513f22009-08-12 12:48:00 +0200276 case GSM_AUTH_POLICY_CLOSED:
277 return subscriber->authorized;
Maxddee01f2016-05-24 14:23:27 +0200278 case GSM_AUTH_POLICY_REGEXP:
279 if (subscriber->authorized)
280 return 1;
281 if (subscr_regexp_check(subscriber->group->net,
282 subscriber->imsi))
283 subscriber->authorized = 1;
284 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200285 case GSM_AUTH_POLICY_TOKEN:
Harald Welte (local)ee9afe32009-08-13 20:44:23 +0200286 if (subscriber->authorized)
287 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200288 return (subscriber->flags & GSM_SUBSCRIBER_FIRST_CONTACT);
Jan Luebbe06513f22009-08-12 12:48:00 +0200289 case GSM_AUTH_POLICY_ACCEPT_ALL:
Holger Freyther89824fc2008-12-30 16:18:18 +0000290 return 1;
Jan Luebbe06513f22009-08-12 12:48:00 +0200291 default:
292 return 0;
293 }
Holger Freyther89824fc2008-12-30 16:18:18 +0000294}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000295
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100296static void release_loc_updating_req(struct gsm_subscriber_connection *conn, int release)
Holger Freyther73487a22008-12-31 18:53:57 +0000297{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100298 if (!conn->loc_operation)
Holger Freyther73487a22008-12-31 18:53:57 +0000299 return;
300
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +0800301 /* No need to keep the connection up */
302 release_anchor(conn);
303
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200304 osmo_timer_del(&conn->loc_operation->updating_timer);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100305 talloc_free(conn->loc_operation);
Holger Hans Peter Freytherf93e8fa2010-12-22 08:53:28 +0100306 conn->loc_operation = NULL;
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100307 if (release)
308 msc_release_connection(conn);
Holger Freyther73487a22008-12-31 18:53:57 +0000309}
310
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100311static void allocate_loc_updating_req(struct gsm_subscriber_connection *conn)
Holger Freyther73487a22008-12-31 18:53:57 +0000312{
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800313 if (conn->loc_operation)
314 LOGP(DMM, LOGL_ERROR, "Connection already had operation.\n");
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100315 release_loc_updating_req(conn, 0);
Holger Freyther73487a22008-12-31 18:53:57 +0000316
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100317 conn->loc_operation = talloc_zero(tall_locop_ctx,
Harald Welte470ec292009-06-26 20:25:23 +0200318 struct gsm_loc_updating_operation);
Holger Freyther73487a22008-12-31 18:53:57 +0000319}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000320
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200321static int finish_lu(struct gsm_subscriber_connection *conn)
322{
323 int rc = 0;
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200324 int avoid_tmsi = conn->network->avoid_tmsi;
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200325
326 /* We're all good */
327 if (avoid_tmsi) {
328 conn->subscr->tmsi = GSM_RESERVED_TMSI;
329 db_sync_subscriber(conn->subscr);
330 } else {
331 db_subscriber_alloc_tmsi(conn->subscr);
332 }
333
334 rc = gsm0408_loc_upd_acc(conn);
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200335 if (conn->network->send_mm_info) {
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200336 /* send MM INFO with network name */
337 rc = gsm48_tx_mm_info(conn);
338 }
339
340 /* call subscr_update after putting the loc_upd_acc
341 * in the transmit queue, since S_SUBSCR_ATTACHED might
342 * trigger further action like SMS delivery */
343 subscr_update(conn->subscr, conn->bts,
344 GSM_SUBSCRIBER_UPDATE_ATTACHED);
345
346 /*
347 * The gsm0408_loc_upd_acc sends a MI with the TMSI. The
348 * MS needs to respond with a TMSI REALLOCATION COMPLETE
349 * (even if the TMSI is the same).
350 */
351 if (avoid_tmsi)
352 release_loc_updating_req(conn, 1);
353
354 return rc;
355}
356
Sylvain Munaut267fba02009-12-24 00:28:01 +0100357static int _gsm0408_authorize_sec_cb(unsigned int hooknum, unsigned int event,
358 struct msgb *msg, void *data, void *param)
359{
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800360 struct gsm_subscriber_connection *conn = data;
Sylvain Munaut267fba02009-12-24 00:28:01 +0100361 int rc = 0;
362
363 switch (event) {
364 case GSM_SECURITY_AUTH_FAILED:
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100365 release_loc_updating_req(conn, 1);
Sylvain Munaut267fba02009-12-24 00:28:01 +0100366 break;
367
Andreas Eversberga874b8d2013-07-10 08:58:03 +0200368 case GSM_SECURITY_ALREADY:
369 LOGP(DMM, LOGL_ERROR, "We don't expect LOCATION "
370 "UPDATING after CM SERVICE REQUEST\n");
371 /* fall through */
372
Sylvain Munaut267fba02009-12-24 00:28:01 +0100373 case GSM_SECURITY_NOAVAIL:
374 case GSM_SECURITY_SUCCEEDED:
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200375 rc = finish_lu(conn);
Sylvain Munaut267fba02009-12-24 00:28:01 +0100376 break;
377
378 default:
379 rc = -EINVAL;
380 };
381
382 return rc;
383}
384
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100385static int gsm0408_authorize(struct gsm_subscriber_connection *conn, struct msgb *msg)
Holger Freytherd51524f2009-06-09 08:27:07 +0000386{
Holger Hans Peter Freyther1a345ca2013-12-27 17:37:27 +0100387 if (!conn->loc_operation)
388 return 0;
389
Sylvain Munaut267fba02009-12-24 00:28:01 +0100390 if (authorize_subscriber(conn->loc_operation, conn->subscr))
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800391 return gsm48_secure_channel(conn,
Sylvain Munaut267fba02009-12-24 00:28:01 +0100392 conn->loc_operation->key_seq,
393 _gsm0408_authorize_sec_cb, NULL);
Holger Freytherd51524f2009-06-09 08:27:07 +0000394 return 0;
395}
396
Holger Hans Peter Freytheradb6e1c2010-09-18 06:44:24 +0800397void gsm0408_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause)
Holger Freyther7c19f742009-06-06 13:54:35 +0000398{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800399 struct gsm_trans *trans, *temp;
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800400
401 /* avoid someone issuing a clear */
402 conn->in_release = 1;
403
Holger Freyther7c19f742009-06-06 13:54:35 +0000404 /*
405 * Cancel any outstanding location updating request
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800406 * operation taking place on the subscriber connection.
Holger Freyther7c19f742009-06-06 13:54:35 +0000407 */
Neels Hofmeyraea28ce2016-05-04 15:30:30 +0200408 release_loc_updating_req(conn, 0);
Holger Hans Peter Freytherc29043e2010-12-28 14:57:20 +0100409
410 /* We might need to cancel the paging response or such. */
411 if (conn->sec_operation && conn->sec_operation->cb) {
412 conn->sec_operation->cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
413 NULL, conn, conn->sec_operation->cb_data);
414 }
415
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800416 release_security_operation(conn);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +0800417 release_anchor(conn);
Holger Freyther7c19f742009-06-06 13:54:35 +0000418
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100419 /*
420 * Free all transactions that are associated with the released
421 * connection. The transaction code will inform the CC or SMS
422 * facilities that will send the release indications. As part of
423 * the CC REL_IND the remote leg might be released and this will
424 * trigger the call to trans_free. This is something the llist
425 * macro can not handle and we will need to re-iterate the list.
426 *
427 * TODO: Move the trans_list into the subscriber connection and
428 * create a pending list for MT transactions. These exist before
429 * we have a subscriber connection.
430 */
431restart:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200432 llist_for_each_entry_safe(trans, temp, &conn->network->trans_list, entry) {
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100433 if (trans->conn == conn) {
Harald Weltedcaf5652009-07-23 18:56:43 +0200434 trans_free(trans);
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100435 goto restart;
436 }
Harald Welte4bfdfe72009-06-10 23:11:52 +0800437 }
Holger Freyther7c19f742009-06-06 13:54:35 +0000438}
439
Harald Welte371efe52010-12-22 23:17:50 +0100440void gsm0408_clear_all_trans(struct gsm_network *net, int protocol)
441{
442 struct gsm_trans *trans, *temp;
443
444 LOGP(DCC, LOGL_NOTICE, "Clearing all currently active transactions!!!\n");
445
446 llist_for_each_entry_safe(trans, temp, &net->trans_list, entry) {
Harald Welteeb76c7a2010-12-23 02:47:53 +0100447 if (trans->protocol == protocol) {
448 trans->callref = 0;
Harald Welte371efe52010-12-22 23:17:50 +0100449 trans_free(trans);
Harald Welteeb76c7a2010-12-23 02:47:53 +0100450 }
Harald Welte371efe52010-12-22 23:17:50 +0100451 }
452}
453
Holger Freyther429e7762008-12-30 13:28:30 +0000454/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200455int gsm0408_loc_upd_rej(struct gsm_subscriber_connection *conn, uint8_t cause)
Harald Welte52b1f982008-12-23 20:25:15 +0000456{
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800457 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800458 struct msgb *msg;
459
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200460 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_RESP_REJECT]);
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800461
462 msg = gsm48_create_loc_upd_rej(cause);
463 if (!msg) {
464 LOGP(DMM, LOGL_ERROR, "Failed to create msg for LOCATION UPDATING REJECT.\n");
465 return -1;
466 }
Harald Welte52b1f982008-12-23 20:25:15 +0000467
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800468 msg->lchan = conn->lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000469
Harald Welte (local)198d5ad2009-12-26 22:15:28 +0100470 LOGP(DMM, LOGL_INFO, "Subscriber %s: LOCATION UPDATING REJECT "
Harald Welte7184bd02015-12-28 14:04:36 +0100471 "LAC=%u BTS=%u\n", subscr_name(conn->subscr),
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800472 bts->location_area_code, bts->nr);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100473
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800474 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000475}
476
477/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200478static int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn)
Harald Welte52b1f982008-12-23 20:25:15 +0000479{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100480 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 LOC UPD ACC");
Harald Welte52b1f982008-12-23 20:25:15 +0000481 struct gsm48_hdr *gh;
482 struct gsm48_loc_area_id *lai;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200483 uint8_t *mid;
Harald Welte52b1f982008-12-23 20:25:15 +0000484
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800485 msg->lchan = conn->lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000486
487 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
488 gh->proto_discr = GSM48_PDISC_MM;
489 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
490
491 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200492 gsm48_generate_lai(lai, conn->network->country_code,
493 conn->network->network_code,
494 conn->bts->location_area_code);
Harald Welte52b1f982008-12-23 20:25:15 +0000495
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200496 if (conn->subscr->tmsi == GSM_RESERVED_TMSI) {
497 uint8_t mi[10];
498 int len;
499 len = gsm48_generate_mid_from_imsi(mi, conn->subscr->imsi);
500 mid = msgb_put(msg, len);
501 memcpy(mid, mi, len);
502 } else {
503 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
504 gsm48_generate_mid_from_tmsi(mid, conn->subscr->tmsi);
505 }
Harald Welte52b1f982008-12-23 20:25:15 +0000506
507 DEBUGP(DMM, "-> LOCATION UPDATE ACCEPT\n");
508
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200509 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_RESP_ACCEPT]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100510
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800511 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000512}
513
Harald Weltebf5e8df2009-02-03 12:59:45 +0000514/* Transmit Chapter 9.2.10 Identity Request */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200515static int mm_tx_identity_req(struct gsm_subscriber_connection *conn, uint8_t id_type)
Harald Welte231ad4f2008-12-27 11:15:38 +0000516{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100517 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 ID REQ");
Harald Welte231ad4f2008-12-27 11:15:38 +0000518 struct gsm48_hdr *gh;
Harald Weltefc977a82008-12-27 10:19:37 +0000519
Holger Hans Peter Freytherd521d972010-06-15 14:11:01 +0800520 msg->lchan = conn->lchan;
Harald Welte231ad4f2008-12-27 11:15:38 +0000521
522 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
523 gh->proto_discr = GSM48_PDISC_MM;
524 gh->msg_type = GSM48_MT_MM_ID_REQ;
525 gh->data[0] = id_type;
526
Holger Hans Peter Freytherd521d972010-06-15 14:11:01 +0800527 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte231ad4f2008-12-27 11:15:38 +0000528}
529
Maxe21cf382016-05-11 11:01:06 +0200530static struct gsm_subscriber *subscr_create(const struct gsm_network *net,
531 const char *imsi)
532{
Maxe6052c42016-06-30 10:25:49 +0200533 if (!net->auto_create_subscr)
Maxddee01f2016-05-24 14:23:27 +0200534 return NULL;
Maxe21cf382016-05-11 11:01:06 +0200535
Maxe6052c42016-06-30 10:25:49 +0200536 if (!subscr_regexp_check(net, imsi))
537 return NULL;
Maxddee01f2016-05-24 14:23:27 +0200538
Maxe6052c42016-06-30 10:25:49 +0200539 return subscr_create_subscriber(net->subscr_group, imsi);
Maxe21cf382016-05-11 11:01:06 +0200540}
Harald Welte231ad4f2008-12-27 11:15:38 +0000541
Harald Weltebf5e8df2009-02-03 12:59:45 +0000542/* Parse Chapter 9.2.11 Identity Response */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800543static int mm_rx_id_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte231ad4f2008-12-27 11:15:38 +0000544{
545 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200546 struct gsm_network *net = conn->network;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200547 uint8_t mi_type = gh->data[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200548 char mi_string[GSM48_MI_SIZE];
Harald Welte231ad4f2008-12-27 11:15:38 +0000549
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200550 gsm48_mi_to_string(mi_string, sizeof(mi_string), &gh->data[1], gh->data[0]);
Harald Welteb9845f92015-08-16 18:07:48 +0200551 DEBUGP(DMM, "IDENTITY RESPONSE: MI(%s)=%s\n",
552 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte231ad4f2008-12-27 11:15:38 +0000553
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200554 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
Harald Welte7659de12009-12-13 12:39:18 +0100555
Harald Welte75a983f2008-12-27 21:34:06 +0000556 switch (mi_type) {
557 case GSM_MI_TYPE_IMSI:
Jan Luebbe370b41d2009-08-12 10:19:34 +0200558 /* look up subscriber based on IMSI, create if not found */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100559 if (!conn->subscr) {
Jacob Erlbeck1e30a282014-12-03 09:28:24 +0100560 conn->subscr = subscr_get_by_imsi(net->subscr_group,
561 mi_string);
Maxe21cf382016-05-11 11:01:06 +0200562 if (!conn->subscr)
563 conn->subscr = subscr_create(net, mi_string);
Jan Luebbeb0dfc312009-08-12 10:12:52 +0200564 }
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100565 if (!conn->subscr && conn->loc_operation) {
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200566 gsm0408_loc_upd_rej(conn, net->reject_cause);
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100567 release_loc_updating_req(conn, 1);
568 return 0;
569 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100570 if (conn->loc_operation)
571 conn->loc_operation->waiting_for_imsi = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000572 break;
573 case GSM_MI_TYPE_IMEI:
Harald Welte255539c2008-12-28 02:26:27 +0000574 case GSM_MI_TYPE_IMEISV:
Harald Welte75a983f2008-12-27 21:34:06 +0000575 /* update subscribe <-> IMEI mapping */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100576 if (conn->subscr) {
577 db_subscriber_assoc_imei(conn->subscr, mi_string);
578 db_sync_equipment(&conn->subscr->equipment);
Harald Welte (local)ee4410a2009-08-17 09:39:55 +0200579 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100580 if (conn->loc_operation)
581 conn->loc_operation->waiting_for_imei = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000582 break;
583 }
Holger Freyther73487a22008-12-31 18:53:57 +0000584
585 /* Check if we can let the mobile station enter */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100586 return gsm0408_authorize(conn, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +0000587}
588
Harald Welte255539c2008-12-28 02:26:27 +0000589
590static void loc_upd_rej_cb(void *data)
591{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100592 struct gsm_subscriber_connection *conn = data;
Harald Welte255539c2008-12-28 02:26:27 +0000593
Holger Hans Peter Freyther2692e3b2011-11-07 12:26:29 +0100594 LOGP(DMM, LOGL_DEBUG, "Location Updating Request procedure timedout.\n");
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200595 gsm0408_loc_upd_rej(conn, conn->network->reject_cause);
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100596 release_loc_updating_req(conn, 1);
Harald Welte255539c2008-12-28 02:26:27 +0000597}
598
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100599static void schedule_reject(struct gsm_subscriber_connection *conn)
Holger Freytherb7193e42008-12-29 17:44:08 +0000600{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100601 conn->loc_operation->updating_timer.cb = loc_upd_rej_cb;
602 conn->loc_operation->updating_timer.data = conn;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200603 osmo_timer_schedule(&conn->loc_operation->updating_timer, 5, 0);
Holger Freytherb7193e42008-12-29 17:44:08 +0000604}
605
Harald Welteb9845f92015-08-16 18:07:48 +0200606static const struct value_string lupd_names[] = {
607 { GSM48_LUPD_NORMAL, "NORMAL" },
608 { GSM48_LUPD_PERIODIC, "PERIODIC" },
609 { GSM48_LUPD_IMSI_ATT, "IMSI ATTACH" },
610 { 0, NULL }
611};
Harald Welte2a139372009-02-22 21:14:55 +0000612
Harald Weltebf5e8df2009-02-03 12:59:45 +0000613/* Chapter 9.2.15: Receive Location Updating Request */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800614static int mm_rx_loc_upd_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +0000615{
Harald Welte8470bf22008-12-25 23:28:35 +0000616 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000617 struct gsm48_loc_upd_req *lu;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800618 struct gsm_subscriber *subscr = NULL;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200619 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200620 char mi_string[GSM48_MI_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000621
Harald Welte8470bf22008-12-25 23:28:35 +0000622 lu = (struct gsm48_loc_upd_req *) gh->data;
623
624 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
Harald Welte52b1f982008-12-23 20:25:15 +0000625
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200626 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Weltefc977a82008-12-27 10:19:37 +0000627
Harald Welteb9845f92015-08-16 18:07:48 +0200628 DEBUGPC(DMM, "MI(%s)=%s type=%s ", gsm48_mi_type_name(mi_type),
629 mi_string, get_value_string(lupd_names, lu->type));
Holger Freyther73487a22008-12-31 18:53:57 +0000630
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200631 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
Harald Welte7659de12009-12-13 12:39:18 +0100632
Harald Welte24ff6ee2009-12-22 00:41:05 +0100633 switch (lu->type) {
634 case GSM48_LUPD_NORMAL:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200635 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_NORMAL]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100636 break;
637 case GSM48_LUPD_IMSI_ATT:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200638 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_ATTACH]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100639 break;
640 case GSM48_LUPD_PERIODIC:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200641 rate_ctr_inc(&conn->network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_PERIODIC]);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100642 break;
643 }
644
Holger Freythereaf04692009-06-06 13:54:44 +0000645 /*
646 * Pseudo Spoof detection: Just drop a second/concurrent
647 * location updating request.
648 */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100649 if (conn->loc_operation) {
Harald Weltea0368542009-06-27 02:58:43 +0200650 DEBUGPC(DMM, "ignoring request due an existing one: %p.\n",
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100651 conn->loc_operation);
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800652 gsm0408_loc_upd_rej(conn, GSM48_REJECT_PROTOCOL_ERROR);
Holger Freythereaf04692009-06-06 13:54:44 +0000653 return 0;
654 }
655
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800656 allocate_loc_updating_req(conn);
Holger Freyther73487a22008-12-31 18:53:57 +0000657
Sylvain Munaut2030a2a2010-06-10 13:36:59 +0200658 conn->loc_operation->key_seq = lu->key_seq;
659
Harald Welte52b1f982008-12-23 20:25:15 +0000660 switch (mi_type) {
661 case GSM_MI_TYPE_IMSI:
Harald Weltea0368542009-06-27 02:58:43 +0200662 DEBUGPC(DMM, "\n");
Harald Welte231ad4f2008-12-27 11:15:38 +0000663 /* we always want the IMEI, too */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200664 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100665 conn->loc_operation->waiting_for_imei = 1;
Holger Freytherc6ea9db2008-12-30 19:18:21 +0000666
Jan Luebbe370b41d2009-08-12 10:19:34 +0200667 /* look up subscriber based on IMSI, create if not found */
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200668 subscr = subscr_get_by_imsi(conn->network->subscr_group, mi_string);
Maxe21cf382016-05-11 11:01:06 +0200669 if (!subscr)
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200670 subscr = subscr_create(conn->network, mi_string);
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100671 if (!subscr) {
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200672 gsm0408_loc_upd_rej(conn, conn->network->reject_cause);
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +0100673 release_loc_updating_req(conn, 0);
674 return 0;
675 }
Harald Welte4b634542008-12-27 01:55:51 +0000676 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000677 case GSM_MI_TYPE_TMSI:
Harald Weltea0368542009-06-27 02:58:43 +0200678 DEBUGPC(DMM, "\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000679 /* look up the subscriber based on TMSI, request IMSI if it fails */
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200680 subscr = subscr_get_by_tmsi(conn->network->subscr_group,
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +0200681 tmsi_from_string(mi_string));
Harald Welte52b1f982008-12-23 20:25:15 +0000682 if (!subscr) {
Harald Welte231ad4f2008-12-27 11:15:38 +0000683 /* send IDENTITY REQUEST message to get IMSI */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200684 mm_tx_identity_req(conn, GSM_MI_TYPE_IMSI);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100685 conn->loc_operation->waiting_for_imsi = 1;
Harald Welte52b1f982008-12-23 20:25:15 +0000686 }
Harald Weltef5f512c2010-06-07 17:56:32 +0200687 /* we always want the IMEI, too */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200688 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Harald Weltef5f512c2010-06-07 17:56:32 +0200689 conn->loc_operation->waiting_for_imei = 1;
Harald Welte52b1f982008-12-23 20:25:15 +0000690 break;
691 case GSM_MI_TYPE_IMEI:
692 case GSM_MI_TYPE_IMEISV:
693 /* no sim card... FIXME: what to do ? */
Harald Weltea0368542009-06-27 02:58:43 +0200694 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000695 break;
696 default:
Harald Weltea0368542009-06-27 02:58:43 +0200697 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000698 break;
699 }
700
Harald Welte24516ea2009-07-04 10:18:00 +0200701 /* schedule the reject timer */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100702 schedule_reject(conn);
Harald Welte24516ea2009-07-04 10:18:00 +0200703
Harald Welte4bfdfe72009-06-10 23:11:52 +0800704 if (!subscr) {
Harald Weltea0368542009-06-27 02:58:43 +0200705 DEBUGPC(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte4bfdfe72009-06-10 23:11:52 +0800706 /* FIXME: request id? close channel? */
707 return -EINVAL;
708 }
709
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100710 conn->subscr = subscr;
711 conn->subscr->equipment.classmark1 = lu->classmark1;
Harald Welte255539c2008-12-28 02:26:27 +0000712
Harald Welte24516ea2009-07-04 10:18:00 +0200713 /* check if we can let the subscriber into our network immediately
714 * or if we need to wait for identity responses. */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100715 return gsm0408_authorize(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000716}
717
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100718/* Turn int into semi-octet representation: 98 => 0x89 */
719static uint8_t bcdify(uint8_t value)
Harald Welte4bfdfe72009-06-10 23:11:52 +0800720{
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100721 uint8_t ret;
722
723 ret = value / 10;
724 ret |= (value % 10) << 4;
725
726 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800727}
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100728
Harald Welte4bfdfe72009-06-10 23:11:52 +0800729
Harald Weltedb253af2008-12-30 17:56:55 +0000730/* Section 9.2.15a */
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800731int gsm48_tx_mm_info(struct gsm_subscriber_connection *conn)
Harald Weltedb253af2008-12-30 17:56:55 +0000732{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100733 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 MM INF");
Harald Weltedb253af2008-12-30 17:56:55 +0000734 struct gsm48_hdr *gh;
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200735 struct gsm_network *net = conn->network;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100736 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200737 uint8_t *ptr8;
Daniel Willmanneea93372009-08-13 03:42:07 +0200738 int name_len, name_pad;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100739
Harald Welte4bfdfe72009-06-10 23:11:52 +0800740 time_t cur_t;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100741 struct tm* gmt_time;
742 struct tm* local_time;
743 int tzunits;
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100744 int dst = 0;
Harald Weltedb253af2008-12-30 17:56:55 +0000745
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800746 msg->lchan = conn->lchan;
Harald Weltedb253af2008-12-30 17:56:55 +0000747
748 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
749 gh->proto_discr = GSM48_PDISC_MM;
750 gh->msg_type = GSM48_MT_MM_INFO;
751
752 if (net->name_long) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200753#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000754 name_len = strlen(net->name_long);
755 /* 10.5.3.5a */
756 ptr8 = msgb_put(msg, 3);
757 ptr8[0] = GSM48_IE_NAME_LONG;
758 ptr8[1] = name_len*2 +1;
759 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
760
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200761 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000762 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000763 ptr16[i] = htons(net->name_long[i]);
Harald Weltedb253af2008-12-30 17:56:55 +0000764
765 /* FIXME: Use Cell Broadcast, not UCS-2, since
766 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmanneea93372009-08-13 03:42:07 +0200767#endif
768 name_len = (strlen(net->name_long)*7)/8;
769 name_pad = (8 - strlen(net->name_long)*7)%8;
770 if (name_pad > 0)
771 name_len++;
772 /* 10.5.3.5a */
773 ptr8 = msgb_put(msg, 3);
774 ptr8[0] = GSM48_IE_NAME_LONG;
775 ptr8[1] = name_len +1;
776 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
777
778 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100779 gsm_7bit_encode_n(ptr8, name_len, net->name_long, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200780
Harald Weltedb253af2008-12-30 17:56:55 +0000781 }
782
783 if (net->name_short) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200784#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000785 name_len = strlen(net->name_short);
786 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200787 ptr8 = (uint8_t *) msgb_put(msg, 3);
Harald Welte7543eb72009-07-19 17:51:36 +0200788 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Weltedb253af2008-12-30 17:56:55 +0000789 ptr8[1] = name_len*2 + 1;
790 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
791
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200792 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000793 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000794 ptr16[i] = htons(net->name_short[i]);
Daniel Willmanneea93372009-08-13 03:42:07 +0200795#endif
796 name_len = (strlen(net->name_short)*7)/8;
797 name_pad = (8 - strlen(net->name_short)*7)%8;
798 if (name_pad > 0)
799 name_len++;
800 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200801 ptr8 = (uint8_t *) msgb_put(msg, 3);
Daniel Willmanneea93372009-08-13 03:42:07 +0200802 ptr8[0] = GSM48_IE_NAME_SHORT;
803 ptr8[1] = name_len +1;
804 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
805
806 ptr8 = msgb_put(msg, name_len);
Harald Welte5468f762015-01-01 12:41:17 +0100807 gsm_7bit_encode_n(ptr8, name_len, net->name_short, NULL);
Daniel Willmanneea93372009-08-13 03:42:07 +0200808
Harald Weltedb253af2008-12-30 17:56:55 +0000809 }
810
Harald Weltedb253af2008-12-30 17:56:55 +0000811 /* Section 10.5.3.9 */
812 cur_t = time(NULL);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100813 gmt_time = gmtime(&cur_t);
814
Harald Weltedb253af2008-12-30 17:56:55 +0000815 ptr8 = msgb_put(msg, 8);
816 ptr8[0] = GSM48_IE_NET_TIME_TZ;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100817 ptr8[1] = bcdify(gmt_time->tm_year % 100);
818 ptr8[2] = bcdify(gmt_time->tm_mon + 1);
819 ptr8[3] = bcdify(gmt_time->tm_mday);
820 ptr8[4] = bcdify(gmt_time->tm_hour);
821 ptr8[5] = bcdify(gmt_time->tm_min);
822 ptr8[6] = bcdify(gmt_time->tm_sec);
823
Harald Welte45f91712012-07-08 16:48:11 +0200824 if (bts->tz.override) {
825 /* Convert tz.hr and tz.mn to units */
826 if (bts->tz.hr < 0) {
827 tzunits = ((bts->tz.hr/-1)*4);
828 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100829 ptr8[7] = bcdify(tzunits);
830 /* Set negative time */
831 ptr8[7] |= 0x08;
832 }
833 else {
Harald Welte45f91712012-07-08 16:48:11 +0200834 tzunits = bts->tz.hr*4;
835 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100836 ptr8[7] = bcdify(tzunits);
837 }
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100838 /* Convert DST value */
839 if (bts->tz.dst >= 0 && bts->tz.dst <= 2)
840 dst = bts->tz.dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100841 }
842 else {
843 /* Need to get GSM offset and convert into 15 min units */
844 /* This probably breaks if gmtoff returns a value not evenly divisible by 15? */
845 local_time = localtime(&cur_t);
Harald Welte9c3dc902012-04-08 16:59:24 +0200846#ifdef HAVE_TM_GMTOFF_IN_TM
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100847 tzunits = (local_time->tm_gmtoff/60)/15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200848#else
849#warning find a portable way to obtain the timezone offset
850 tzunits = 0;
851#endif
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100852 if (tzunits < 0) {
853 tzunits = tzunits/-1;
854 ptr8[7] = bcdify(tzunits);
855 /* Flip it to negative */
856 ptr8[7] |= 0x08;
857 }
858 else
859 ptr8[7] = bcdify(tzunits);
Jacob Erlbeckf46e2262014-01-07 15:05:16 +0100860
861 /* Does not support DST +2 */
862 if (local_time->tm_isdst)
863 dst = 1;
864 }
865
866 if (dst) {
867 ptr8 = msgb_put(msg, 3);
868 ptr8[0] = GSM48_IE_NET_DST;
869 ptr8[1] = 1;
870 ptr8[2] = dst;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100871 }
Harald Weltedb253af2008-12-30 17:56:55 +0000872
Daniel Willmanneea93372009-08-13 03:42:07 +0200873 DEBUGP(DMM, "-> MM INFO\n");
874
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800875 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Weltedb253af2008-12-30 17:56:55 +0000876}
877
Harald Welte7984d5c2009-08-12 22:56:50 +0200878/* Section 9.2.2 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200879int gsm48_tx_mm_auth_req(struct gsm_subscriber_connection *conn, uint8_t *rand, int key_seq)
Harald Welte7984d5c2009-08-12 22:56:50 +0200880{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100881 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 AUTH REQ");
Harald Welte7984d5c2009-08-12 22:56:50 +0200882 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut849f5542009-09-27 11:10:17 +0200883 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte7984d5c2009-08-12 22:56:50 +0200884
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +0200885 DEBUGP(DMM, "-> AUTH REQ (rand = %s)\n", osmo_hexdump(rand, 16));
Harald Welte7984d5c2009-08-12 22:56:50 +0200886
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800887 msg->lchan = conn->lchan;
Harald Welte7984d5c2009-08-12 22:56:50 +0200888 gh->proto_discr = GSM48_PDISC_MM;
889 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
890
Sylvain Munautbd55a6d2009-12-24 00:23:46 +0100891 ar->key_seq = key_seq;
Sylvain Munaut849f5542009-09-27 11:10:17 +0200892
Harald Welte7984d5c2009-08-12 22:56:50 +0200893 /* 16 bytes RAND parameters */
Harald Welte7984d5c2009-08-12 22:56:50 +0200894 if (rand)
Sylvain Munaut849f5542009-09-27 11:10:17 +0200895 memcpy(ar->rand, rand, 16);
Harald Welte7984d5c2009-08-12 22:56:50 +0200896
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800897 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte7984d5c2009-08-12 22:56:50 +0200898}
899
900/* Section 9.2.1 */
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800901int gsm48_tx_mm_auth_rej(struct gsm_subscriber_connection *conn)
Harald Welte7984d5c2009-08-12 22:56:50 +0200902{
903 DEBUGP(DMM, "-> AUTH REJECT\n");
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800904 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
Harald Welte7984d5c2009-08-12 22:56:50 +0200905}
906
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100907/*
908 * At the 30C3 phones miss their periodic update
909 * interval a lot and then remain unreachable. In case
910 * we still know the TMSI we can just attach it again.
911 */
912static void implit_attach(struct gsm_subscriber_connection *conn)
913{
914 if (conn->subscr->lac != GSM_LAC_RESERVED_DETACHED)
915 return;
916
917 subscr_update(conn->subscr, conn->bts,
918 GSM_SUBSCRIBER_UPDATE_ATTACHED);
919}
920
921
Sylvain Munautba87f452009-12-24 00:28:46 +0100922static int _gsm48_rx_mm_serv_req_sec_cb(
923 unsigned int hooknum, unsigned int event,
924 struct msgb *msg, void *data, void *param)
925{
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800926 struct gsm_subscriber_connection *conn = data;
Sylvain Munautba87f452009-12-24 00:28:46 +0100927 int rc = 0;
928
Holger Hans Peter Freythere7bd8632013-06-30 15:30:47 +0200929 /* auth failed or succeeded, the timer was stopped */
930 conn->expire_timer_stopped = 1;
931
Sylvain Munautba87f452009-12-24 00:28:46 +0100932 switch (event) {
933 case GSM_SECURITY_AUTH_FAILED:
934 /* Nothing to do */
935 break;
936
937 case GSM_SECURITY_NOAVAIL:
Andreas Eversberg641475c2013-07-10 08:58:03 +0200938 case GSM_SECURITY_ALREADY:
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800939 rc = gsm48_tx_mm_serv_ack(conn);
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100940 implit_attach(conn);
Sylvain Munautba87f452009-12-24 00:28:46 +0100941 break;
942
943 case GSM_SECURITY_SUCCEEDED:
944 /* nothing to do. CIPHER MODE COMMAND is
945 * implicit CM SERV ACK */
Holger Hans Peter Freyther2147bc42013-12-27 17:19:19 +0100946 implit_attach(conn);
Sylvain Munautba87f452009-12-24 00:28:46 +0100947 break;
948
949 default:
950 rc = -EINVAL;
951 };
952
953 return rc;
954}
955
Harald Welte4ed0e922009-01-10 03:17:30 +0000956/*
957 * Handle CM Service Requests
958 * a) Verify that the packet is long enough to contain the information
959 * we require otherwsie reject with INCORRECT_MESSAGE
960 * b) Try to parse the TMSI. If we do not have one reject
961 * c) Check that we know the subscriber with the TMSI otherwise reject
962 * with a HLR cause
963 * d) Set the subscriber on the gsm_lchan and accept
964 */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800965static int gsm48_rx_mm_serv_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte4b634542008-12-27 01:55:51 +0000966{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200967 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200968 char mi_string[GSM48_MI_SIZE];
Harald Welte4b634542008-12-27 01:55:51 +0000969
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +0200970 struct gsm_network *network = conn->network;
Harald Welteba4cf162009-01-10 01:49:35 +0000971 struct gsm_subscriber *subscr;
972 struct gsm48_hdr *gh = msgb_l3(msg);
973 struct gsm48_service_request *req =
974 (struct gsm48_service_request *)gh->data;
Holger Hans Peter Freyther5d658062010-05-14 08:02:08 +0800975 /* unfortunately in Phase1 the classmark2 length is variable */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200976 uint8_t classmark2_len = gh->data[1];
977 uint8_t *classmark2 = gh->data+2;
978 uint8_t mi_len = *(classmark2 + classmark2_len);
979 uint8_t *mi = (classmark2 + classmark2_len + 1);
Harald Welteba4cf162009-01-10 01:49:35 +0000980
Harald Weltec9e02182009-05-01 19:07:53 +0000981 DEBUGP(DMM, "<- CM SERVICE REQUEST ");
Harald Welteba4cf162009-01-10 01:49:35 +0000982 if (msg->data_len < sizeof(struct gsm48_service_request*)) {
Harald Weltec9e02182009-05-01 19:07:53 +0000983 DEBUGPC(DMM, "wrong sized message\n");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800984 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000985 GSM48_REJECT_INCORRECT_MESSAGE);
986 }
987
988 if (msg->data_len < req->mi_len + 6) {
Harald Weltec9e02182009-05-01 19:07:53 +0000989 DEBUGPC(DMM, "does not fit in packet\n");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800990 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000991 GSM48_REJECT_INCORRECT_MESSAGE);
992 }
993
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200994 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
Harald Weltec9e02182009-05-01 19:07:53 +0000995 mi_type = mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +0200996
997 if (mi_type == GSM_MI_TYPE_IMSI) {
Harald Welteb9845f92015-08-16 18:07:48 +0200998 DEBUGPC(DMM, "serv_type=0x%02x MI(%s)=%s\n",
999 req->cm_service_type, gsm48_mi_type_name(mi_type),
1000 mi_string);
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001001 subscr = subscr_get_by_imsi(network->subscr_group,
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +02001002 mi_string);
1003 } else if (mi_type == GSM_MI_TYPE_TMSI) {
Harald Welteb9845f92015-08-16 18:07:48 +02001004 DEBUGPC(DMM, "serv_type=0x%02x MI(%s)=%s\n",
1005 req->cm_service_type, gsm48_mi_type_name(mi_type),
1006 mi_string);
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001007 subscr = subscr_get_by_tmsi(network->subscr_group,
Holger Hans Peter Freyther666e36a2015-07-13 20:33:08 +02001008 tmsi_from_string(mi_string));
1009 } else {
1010 DEBUGPC(DMM, "mi_type is not expected: %d\n", mi_type);
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001011 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +00001012 GSM48_REJECT_INCORRECT_MESSAGE);
1013 }
1014
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001015 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, (classmark2 + classmark2_len));
Harald Welte7659de12009-12-13 12:39:18 +01001016
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001017 if (is_siemens_bts(conn->bts))
Harald Welte3ac7f102009-08-10 10:12:45 +02001018 send_siemens_mrpci(msg->lchan, classmark2-1);
1019
Holger Freythereb443982009-06-04 13:58:42 +00001020
Harald Welte2a139372009-02-22 21:14:55 +00001021 /* FIXME: if we don't know the TMSI, inquire abit IMSI and allocate new TMSI */
Harald Welte4ed0e922009-01-10 03:17:30 +00001022 if (!subscr)
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001023 return gsm48_tx_mm_serv_rej(conn,
Holger Hans Peter Freyther5f8a0c52015-07-13 14:28:29 +02001024 GSM48_REJECT_IMSI_UNKNOWN_IN_VLR);
Harald Welte4ed0e922009-01-10 03:17:30 +00001025
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001026 if (!conn->subscr)
1027 conn->subscr = subscr;
1028 else if (conn->subscr == subscr)
Sylvain Munautea3f6742009-12-18 18:28:10 +01001029 subscr_put(subscr); /* lchan already has a ref, don't need another one */
1030 else {
Harald Welte9bb7c702009-01-10 03:21:41 +00001031 DEBUGP(DMM, "<- CM Channel already owned by someone else?\n");
1032 subscr_put(subscr);
1033 }
1034
Harald Weltec2e302d2009-07-05 14:08:13 +02001035 subscr->equipment.classmark2_len = classmark2_len;
1036 memcpy(subscr->equipment.classmark2, classmark2, classmark2_len);
1037 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001038
Holger Hans Peter Freythere7bd8632013-06-30 15:30:47 +02001039 /* we will send a MM message soon */
1040 conn->expire_timer_stopped = 1;
1041
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001042 return gsm48_secure_channel(conn, req->cipher_key_seq,
Sylvain Munautba87f452009-12-24 00:28:46 +01001043 _gsm48_rx_mm_serv_req_sec_cb, NULL);
Harald Welte4b634542008-12-27 01:55:51 +00001044}
1045
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +02001046static int gsm48_rx_mm_imsi_detach_ind(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte2a139372009-02-22 21:14:55 +00001047{
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001048 struct gsm_network *network = conn->network;
Harald Welte2a139372009-02-22 21:14:55 +00001049 struct gsm48_hdr *gh = msgb_l3(msg);
1050 struct gsm48_imsi_detach_ind *idi =
1051 (struct gsm48_imsi_detach_ind *) gh->data;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001052 uint8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001053 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +08001054 struct gsm_subscriber *subscr = NULL;
Harald Welte2a139372009-02-22 21:14:55 +00001055
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001056 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Harald Welteb9845f92015-08-16 18:07:48 +02001057 DEBUGP(DMM, "IMSI DETACH INDICATION: MI(%s)=%s",
1058 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte2a139372009-02-22 21:14:55 +00001059
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001060 rate_ctr_inc(&network->msc_ctrs->ctr[MSC_CTR_LOC_UPDATE_TYPE_DETACH]);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001061
Harald Welte2a139372009-02-22 21:14:55 +00001062 switch (mi_type) {
1063 case GSM_MI_TYPE_TMSI:
Daniel Willmann977cd132012-12-28 19:29:44 +01001064 DEBUGPC(DMM, "\n");
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001065 subscr = subscr_get_by_tmsi(network->subscr_group,
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001066 tmsi_from_string(mi_string));
Harald Welte2a139372009-02-22 21:14:55 +00001067 break;
1068 case GSM_MI_TYPE_IMSI:
Daniel Willmann977cd132012-12-28 19:29:44 +01001069 DEBUGPC(DMM, "\n");
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001070 subscr = subscr_get_by_imsi(network->subscr_group,
Jacob Erlbeck1e30a282014-12-03 09:28:24 +01001071 mi_string);
Harald Welte2a139372009-02-22 21:14:55 +00001072 break;
1073 case GSM_MI_TYPE_IMEI:
1074 case GSM_MI_TYPE_IMEISV:
1075 /* no sim card... FIXME: what to do ? */
Daniel Willmann977cd132012-12-28 19:29:44 +01001076 DEBUGPC(DMM, ": unimplemented mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +00001077 break;
1078 default:
Daniel Willmann977cd132012-12-28 19:29:44 +01001079 DEBUGPC(DMM, ": unknown mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +00001080 break;
1081 }
1082
Holger Freyther4a49e772009-04-12 05:37:29 +00001083 if (subscr) {
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001084 subscr_update(subscr, conn->bts,
Neels Hofmeyr378a4922016-05-09 21:07:43 +02001085 GSM_SUBSCRIBER_UPDATE_DETACHED);
Harald Welte2e6d4682009-12-24 14:50:24 +01001086 DEBUGP(DMM, "Subscriber: %s\n", subscr_name(subscr));
Harald Welte (local)ee4410a2009-08-17 09:39:55 +02001087
1088 subscr->equipment.classmark1 = idi->classmark1;
1089 db_sync_equipment(&subscr->equipment);
1090
Holger Freytherc21cfbc2009-06-02 02:54:57 +00001091 subscr_put(subscr);
Holger Freyther4a49e772009-04-12 05:37:29 +00001092 } else
Harald Welte2a139372009-02-22 21:14:55 +00001093 DEBUGP(DMM, "Unknown Subscriber ?!?\n");
1094
Harald Welte31981a02009-12-20 09:58:40 +01001095 /* FIXME: iterate over all transactions and release them,
1096 * imagine an IMSI DETACH happening during an active call! */
1097
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +02001098 release_anchor(conn);
Harald Welte2a139372009-02-22 21:14:55 +00001099 return 0;
1100}
1101
Harald Welted2a7f5a2009-06-05 20:08:20 +00001102static int gsm48_rx_mm_status(struct msgb *msg)
1103{
1104 struct gsm48_hdr *gh = msgb_l3(msg);
1105
1106 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
1107
1108 return 0;
1109}
1110
Sylvain Munaut30a15382009-12-24 00:27:26 +01001111/* Chapter 9.2.3: Authentication Response */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001112static int gsm48_rx_mm_auth_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Sylvain Munaut30a15382009-12-24 00:27:26 +01001113{
1114 struct gsm48_hdr *gh = msgb_l3(msg);
1115 struct gsm48_auth_resp *ar = (struct gsm48_auth_resp*) gh->data;
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001116 struct gsm_network *net = conn->network;
Sylvain Munaut30a15382009-12-24 00:27:26 +01001117
Sylvain Munautc593cf12010-06-10 23:51:41 +02001118 DEBUGP(DMM, "MM AUTHENTICATION RESPONSE (sres = %s): ",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001119 osmo_hexdump(ar->sres, 4));
Sylvain Munaut30a15382009-12-24 00:27:26 +01001120
1121 /* Safety check */
1122 if (!conn->sec_operation) {
1123 DEBUGP(DMM, "No authentication/cipher operation in progress !!!\n");
1124 return -EIO;
1125 }
1126
1127 /* Validate SRES */
Harald Welte121e9a42016-04-20 13:13:19 +02001128 if (memcmp(conn->sec_operation->atuple.vec.sres, ar->sres,4)) {
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001129 int rc;
Sylvain Munaut30a15382009-12-24 00:27:26 +01001130 gsm_cbfn *cb = conn->sec_operation->cb;
Sylvain Munautc593cf12010-06-10 23:51:41 +02001131
1132 DEBUGPC(DMM, "Invalid (expected %s)\n",
Harald Welte121e9a42016-04-20 13:13:19 +02001133 osmo_hexdump(conn->sec_operation->atuple.vec.sres, 4));
Sylvain Munautc593cf12010-06-10 23:51:41 +02001134
Sylvain Munaut30a15382009-12-24 00:27:26 +01001135 if (cb)
1136 cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +08001137 NULL, conn, conn->sec_operation->cb_data);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001138
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001139 rc = gsm48_tx_mm_auth_rej(conn);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001140 release_security_operation(conn);
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001141 return rc;
Sylvain Munaut30a15382009-12-24 00:27:26 +01001142 }
1143
Sylvain Munautc593cf12010-06-10 23:51:41 +02001144 DEBUGPC(DMM, "OK\n");
1145
Sylvain Munaut30a15382009-12-24 00:27:26 +01001146 /* Start ciphering */
Sylvain Munaut67706df2010-11-29 08:19:04 +01001147 return gsm0808_cipher_mode(conn, net->a5_encryption,
Harald Welte121e9a42016-04-20 13:13:19 +02001148 conn->sec_operation->atuple.vec.kc, 8, 0);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001149}
1150
Harald Weltebf5e8df2009-02-03 12:59:45 +00001151/* Receive a GSM 04.08 Mobility Management (MM) message */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001152static int gsm0408_rcv_mm(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001153{
1154 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001155 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001156
Neels Hofmeyr531734a2016-03-14 16:13:24 +01001157 switch (gsm48_hdr_msg_type(gh)) {
Harald Welte52b1f982008-12-23 20:25:15 +00001158 case GSM48_MT_MM_LOC_UPD_REQUEST:
Harald Weltea0368542009-06-27 02:58:43 +02001159 DEBUGP(DMM, "LOCATION UPDATING REQUEST: ");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001160 rc = mm_rx_loc_upd_req(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001161 break;
1162 case GSM48_MT_MM_ID_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001163 rc = mm_rx_id_resp(conn, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001164 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001165 case GSM48_MT_MM_CM_SERV_REQ:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001166 rc = gsm48_rx_mm_serv_req(conn, msg);
Harald Welte4b634542008-12-27 01:55:51 +00001167 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001168 case GSM48_MT_MM_STATUS:
Harald Welted2a7f5a2009-06-05 20:08:20 +00001169 rc = gsm48_rx_mm_status(msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001170 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001171 case GSM48_MT_MM_TMSI_REALL_COMPL:
Harald Welte69b2af22009-01-06 19:47:00 +00001172 DEBUGP(DMM, "TMSI Reallocation Completed. Subscriber: %s\n",
Harald Welte7184bd02015-12-28 14:04:36 +01001173 subscr_name(conn->subscr));
Holger Hans Peter Freyther1ba07302015-01-27 10:27:53 +01001174 release_loc_updating_req(conn, 1);
Harald Welte69b2af22009-01-06 19:47:00 +00001175 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001176 case GSM48_MT_MM_IMSI_DETACH_IND:
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +02001177 rc = gsm48_rx_mm_imsi_detach_ind(conn, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001178 break;
1179 case GSM48_MT_MM_CM_REEST_REQ:
1180 DEBUGP(DMM, "CM REESTABLISH REQUEST: Not implemented\n");
1181 break;
1182 case GSM48_MT_MM_AUTH_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001183 rc = gsm48_rx_mm_auth_resp(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001184 break;
1185 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01001186 LOGP(DMM, LOGL_NOTICE, "Unknown GSM 04.08 MM msg type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001187 gh->msg_type);
1188 break;
1189 }
1190
1191 return rc;
1192}
Harald Weltebf5e8df2009-02-03 12:59:45 +00001193
Harald Welte2d35ae62009-02-06 12:02:13 +00001194/* Receive a PAGING RESPONSE message from the MS */
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001195static int gsm48_rx_rr_pag_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte2d35ae62009-02-06 12:02:13 +00001196{
1197 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherf6903de2010-05-16 01:51:14 +08001198 struct gsm48_pag_resp *resp;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001199 uint8_t *classmark2_lv = gh->data + 1;
1200 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001201 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +08001202 struct gsm_subscriber *subscr = NULL;
Harald Welte2d35ae62009-02-06 12:02:13 +00001203 int rc = 0;
1204
Holger Hans Peter Freytherf6903de2010-05-16 01:51:14 +08001205 resp = (struct gsm48_pag_resp *) &gh->data[0];
1206 gsm48_paging_extract_mi(resp, msgb_l3len(msg) - sizeof(*gh),
1207 mi_string, &mi_type);
Harald Welteb9845f92015-08-16 18:07:48 +02001208 DEBUGP(DRR, "PAGING RESPONSE: MI(%s)=%s\n",
1209 gsm48_mi_type_name(mi_type), mi_string);
Harald Welte3ac7f102009-08-10 10:12:45 +02001210
Harald Weltefe18d8f2009-02-22 21:14:24 +00001211 switch (mi_type) {
1212 case GSM_MI_TYPE_TMSI:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001213 subscr = subscr_get_by_tmsi(conn->network->subscr_group,
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001214 tmsi_from_string(mi_string));
Harald Weltefe18d8f2009-02-22 21:14:24 +00001215 break;
1216 case GSM_MI_TYPE_IMSI:
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02001217 subscr = subscr_get_by_imsi(conn->network->subscr_group,
Jacob Erlbeck1e30a282014-12-03 09:28:24 +01001218 mi_string);
Harald Weltefe18d8f2009-02-22 21:14:24 +00001219 break;
1220 }
Harald Welte2d35ae62009-02-06 12:02:13 +00001221
1222 if (!subscr) {
1223 DEBUGP(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte09e38af2009-02-16 22:52:23 +00001224 /* FIXME: request id? close channel? */
Harald Welte2d35ae62009-02-06 12:02:13 +00001225 return -EINVAL;
1226 }
Holger Hans Peter Freytherb7ccac42014-12-28 15:00:36 +01001227 log_set_context(BSC_CTX_SUBSCR, subscr);
Harald Welte2d35ae62009-02-06 12:02:13 +00001228 DEBUGP(DRR, "<- Channel was requested by %s\n",
Harald Welte76042182009-08-08 16:03:15 +02001229 subscr->name && strlen(subscr->name) ? subscr->name : subscr->imsi);
Holger Freyther053e09d2009-02-14 22:51:06 +00001230
Harald Weltec2e302d2009-07-05 14:08:13 +02001231 subscr->equipment.classmark2_len = *classmark2_lv;
1232 memcpy(subscr->equipment.classmark2, classmark2_lv+1, *classmark2_lv);
1233 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001234
Holger Hans Peter Freythere7bd8632013-06-30 15:30:47 +02001235 /* We received a paging */
1236 conn->expire_timer_stopped = 1;
1237
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001238 rc = gsm48_handle_paging_resp(conn, msg, subscr);
Harald Welte2d35ae62009-02-06 12:02:13 +00001239 return rc;
1240}
1241
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001242static int gsm48_rx_rr_app_info(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001243{
1244 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001245 uint8_t apdu_id_flags;
1246 uint8_t apdu_len;
1247 uint8_t *apdu_data;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001248
1249 apdu_id_flags = gh->data[0];
1250 apdu_len = gh->data[1];
1251 apdu_data = gh->data+2;
1252
Harald Welte70f92052012-07-16 13:22:19 +02001253 DEBUGP(DRR, "RX APPLICATION INFO id/flags=0x%02x apdu_len=%u apdu=%s",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001254 apdu_id_flags, apdu_len, osmo_hexdump(apdu_data, apdu_len));
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001255
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001256 return db_apdu_blob_store(conn->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001257}
1258
Harald Weltebf5e8df2009-02-03 12:59:45 +00001259/* Receive a GSM 04.08 Radio Resource (RR) message */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001260static int gsm0408_rcv_rr(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001261{
1262 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001263 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001264
1265 switch (gh->msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001266 case GSM48_MT_RR_PAG_RESP:
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001267 rc = gsm48_rx_rr_pag_resp(conn, msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001268 break;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001269 case GSM48_MT_RR_APP_INFO:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001270 rc = gsm48_rx_rr_app_info(conn, msg);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001271 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001272 default:
Harald Weltecf149ee2012-01-23 16:40:24 +01001273 LOGP(DRR, LOGL_NOTICE, "MSC: Unimplemented "
Harald Welte5d24ba12009-12-24 12:13:17 +01001274 "GSM 04.08 RR msg type 0x%02x\n", gh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001275 break;
1276 }
1277
Harald Welte2d35ae62009-02-06 12:02:13 +00001278 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001279}
1280
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001281int gsm48_send_rr_app_info(struct gsm_subscriber_connection *conn, uint8_t apdu_id,
1282 uint8_t apdu_len, const uint8_t *apdu)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001283{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01001284 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 APP INF");
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001285 struct gsm48_hdr *gh;
1286
Holger Hans Peter Freyther9ce1b272010-06-16 13:52:55 +08001287 msg->lchan = conn->lchan;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001288
1289 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1290 apdu_id, apdu_len);
1291
1292 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1293 gh->proto_discr = GSM48_PDISC_RR;
1294 gh->msg_type = GSM48_MT_RR_APP_INFO;
1295 gh->data[0] = apdu_id;
1296 gh->data[1] = apdu_len;
1297 memcpy(gh->data+2, apdu, apdu_len);
1298
Holger Hans Peter Freyther9ce1b272010-06-16 13:52:55 +08001299 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001300}
1301
Harald Welte4bc90a12008-12-27 16:32:52 +00001302/* Call Control */
1303
Harald Welte7584aea2009-02-11 11:44:12 +00001304/* The entire call control code is written in accordance with Figure 7.10c
1305 * for 'very early assignment', i.e. we allocate a TCH/F during IMMEDIATE
1306 * ASSIGN, then first use that TCH/F for signalling and later MODE MODIFY
1307 * it for voice */
1308
Harald Welte4bfdfe72009-06-10 23:11:52 +08001309static void new_cc_state(struct gsm_trans *trans, int state)
1310{
1311 if (state > 31 || state < 0)
1312 return;
1313
1314 DEBUGP(DCC, "new state %s -> %s\n",
Harald Weltee95daf192010-03-25 12:13:02 +08001315 gsm48_cc_state_name(trans->cc.state),
1316 gsm48_cc_state_name(state));
Harald Welte4bfdfe72009-06-10 23:11:52 +08001317
Harald Weltedcaf5652009-07-23 18:56:43 +02001318 trans->cc.state = state;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001319}
1320
1321static int gsm48_cc_tx_status(struct gsm_trans *trans, void *arg)
Harald Welte4bc90a12008-12-27 16:32:52 +00001322{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01001323 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC STATUS");
Harald Welte4bc90a12008-12-27 16:32:52 +00001324 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001325 uint8_t *cause, *call_state;
Harald Welte4bc90a12008-12-27 16:32:52 +00001326
Harald Welte4bc90a12008-12-27 16:32:52 +00001327 gh->msg_type = GSM48_MT_CC_STATUS;
1328
1329 cause = msgb_put(msg, 3);
1330 cause[0] = 2;
1331 cause[1] = GSM48_CAUSE_CS_GSM | GSM48_CAUSE_LOC_USER;
1332 cause[2] = 0x80 | 30; /* response to status inquiry */
1333
1334 call_state = msgb_put(msg, 1);
1335 call_state[0] = 0xc0 | 0x00;
1336
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08001337 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bc90a12008-12-27 16:32:52 +00001338}
1339
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001340static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001341 uint8_t pdisc, uint8_t msg_type)
Harald Welte4bc90a12008-12-27 16:32:52 +00001342{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01001343 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 TX SIMPLE");
Harald Welte4bc90a12008-12-27 16:32:52 +00001344 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1345
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001346 msg->lchan = conn->lchan;
Harald Welte4bc90a12008-12-27 16:32:52 +00001347
Harald Welte6f4b7532008-12-29 00:39:37 +00001348 gh->proto_discr = pdisc;
Harald Welte4bc90a12008-12-27 16:32:52 +00001349 gh->msg_type = msg_type;
1350
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001351 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte4bc90a12008-12-27 16:32:52 +00001352}
1353
Harald Welte4bfdfe72009-06-10 23:11:52 +08001354static void gsm48_stop_cc_timer(struct gsm_trans *trans)
1355{
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001356 if (osmo_timer_pending(&trans->cc.timer)) {
Harald Weltedcaf5652009-07-23 18:56:43 +02001357 DEBUGP(DCC, "stopping pending timer T%x\n", trans->cc.Tcurrent);
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001358 osmo_timer_del(&trans->cc.timer);
Harald Weltedcaf5652009-07-23 18:56:43 +02001359 trans->cc.Tcurrent = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001360 }
1361}
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001362
Harald Welte4bfdfe72009-06-10 23:11:52 +08001363static int mncc_recvmsg(struct gsm_network *net, struct gsm_trans *trans,
1364 int msg_type, struct gsm_mncc *mncc)
1365{
1366 struct msgb *msg;
Harald Welte04dc88f2010-12-22 21:45:05 +01001367 unsigned char *data;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001368
1369 if (trans)
Harald Welteb854b292010-12-26 19:06:37 +01001370 if (trans->conn && trans->conn->lchan)
Harald Welte6f5aee02009-07-23 21:21:14 +02001371 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08001372 "Sending '%s' to MNCC.\n",
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001373 trans->conn->lchan->ts->trx->bts->nr,
1374 trans->conn->lchan->ts->trx->nr,
1375 trans->conn->lchan->ts->nr, trans->transaction_id,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001376 (trans->subscr)?(trans->subscr->extension):"-",
1377 get_mncc_name(msg_type));
1378 else
1379 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
1380 "Sending '%s' to MNCC.\n",
1381 (trans->subscr)?(trans->subscr->extension):"-",
1382 get_mncc_name(msg_type));
1383 else
1384 DEBUGP(DCC, "(bts - trx - ts - ti -- sub -) "
1385 "Sending '%s' to MNCC.\n", get_mncc_name(msg_type));
1386
1387 mncc->msg_type = msg_type;
1388
Harald Welte966636f2009-06-26 19:39:35 +02001389 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08001390 if (!msg)
1391 return -ENOMEM;
Harald Welte04dc88f2010-12-22 21:45:05 +01001392
1393 data = msgb_put(msg, sizeof(struct gsm_mncc));
1394 memcpy(data, mncc, sizeof(struct gsm_mncc));
1395
Harald Welte54209c22010-12-22 23:43:29 +01001396 cc_tx_to_mncc(net, msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001397
1398 return 0;
1399}
1400
1401int mncc_release_ind(struct gsm_network *net, struct gsm_trans *trans,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001402 uint32_t callref, int location, int value)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001403{
1404 struct gsm_mncc rel;
1405
Harald Welte92f70c52009-06-12 01:54:08 +08001406 memset(&rel, 0, sizeof(rel));
Harald Welte4bfdfe72009-06-10 23:11:52 +08001407 rel.callref = callref;
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001408 mncc_set_cause(&rel, location, value);
Andreas Eversberg15907272013-01-25 08:38:29 +01001409 if (trans && trans->cc.state == GSM_CSTATE_RELEASE_REQ)
1410 return mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001411 return mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
1412}
1413
Harald Weltedcaf5652009-07-23 18:56:43 +02001414/* Call Control Specific transaction release.
1415 * gets called by trans_free, DO NOT CALL YOURSELF! */
1416void _gsm48_cc_trans_free(struct gsm_trans *trans)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001417{
Harald Welte4bfdfe72009-06-10 23:11:52 +08001418 gsm48_stop_cc_timer(trans);
1419
1420 /* send release to L4, if callref still exists */
1421 if (trans->callref) {
1422 /* Ressource unavailable */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01001423 mncc_release_ind(trans->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001424 GSM48_CAUSE_LOC_PRN_S_LU,
1425 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001426 }
Harald Weltedcaf5652009-07-23 18:56:43 +02001427 if (trans->cc.state != GSM_CSTATE_NULL)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001428 new_cc_state(trans, GSM_CSTATE_NULL);
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001429 if (trans->conn)
1430 trau_mux_unmap(&trans->conn->lchan->ts->e1_link, trans->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001431}
1432
1433static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001434
Harald Welte09e38af2009-02-16 22:52:23 +00001435/* call-back from paging the B-end of the connection */
1436static int setup_trig_pag_evt(unsigned int hooknum, unsigned int event,
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001437 struct msgb *msg, void *_conn, void *_transt)
Harald Welte09e38af2009-02-16 22:52:23 +00001438{
Holger Hans Peter Freyther86481c22010-06-17 15:05:57 +08001439 struct gsm_subscriber_connection *conn = _conn;
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001440 struct gsm_trans *transt = _transt;
Harald Weltec05677b2009-06-26 20:17:06 +02001441
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001442 OSMO_ASSERT(!transt->conn);
Harald Welte7584aea2009-02-11 11:44:12 +00001443
Harald Welte4bfdfe72009-06-10 23:11:52 +08001444 /* check all tranactions (without lchan) for subscriber */
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001445 switch (event) {
1446 case GSM_PAGING_SUCCEEDED:
1447 DEBUGP(DCC, "Paging subscr %s succeeded!\n", transt->subscr->extension);
Ivan Kluchnikov5fd0c642015-05-26 13:36:58 +03001448 OSMO_ASSERT(conn);
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001449 /* Assign lchan */
1450 transt->conn = conn;
1451 /* send SETUP request to called party */
1452 gsm48_cc_tx_setup(transt, &transt->cc.msg);
1453 break;
1454 case GSM_PAGING_EXPIRED:
1455 case GSM_PAGING_BUSY:
1456 DEBUGP(DCC, "Paging subscr %s expired!\n",
1457 transt->subscr->extension);
1458 /* Temporarily out of order */
1459 mncc_release_ind(transt->net, transt,
1460 transt->callref,
1461 GSM48_CAUSE_LOC_PRN_S_LU,
1462 GSM48_CC_CAUSE_DEST_OOO);
1463 transt->callref = 0;
1464 transt->paging_request = NULL;
1465 trans_free(transt);
1466 break;
1467 default:
1468 LOGP(DCC, LOGL_ERROR, "Unknown paging event %d\n", event);
1469 break;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001470 }
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001471
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02001472 transt->paging_request = NULL;
Harald Welte09e38af2009-02-16 22:52:23 +00001473 return 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00001474}
Harald Welte7584aea2009-02-11 11:44:12 +00001475
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001476static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable);
Harald Welteda7ab742009-12-19 22:23:05 +01001477
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001478/* handle audio path for handover */
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001479static int switch_for_handover(struct gsm_lchan *old_lchan,
1480 struct gsm_lchan *new_lchan)
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001481{
1482 struct rtp_socket *old_rs, *new_rs, *other_rs;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001483
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02001484 /* Ask the new socket to send to the already known port. */
1485 if (new_lchan->conn->mncc_rtp_bridge) {
1486 LOGP(DHO, LOGL_DEBUG, "Forwarding RTP\n");
1487 rsl_ipacc_mdcx(new_lchan,
1488 old_lchan->abis_ip.connect_ip,
1489 old_lchan->abis_ip.connect_port, 0);
1490 return 0;
1491 }
1492
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001493 if (ipacc_rtp_direct) {
1494 LOGP(DHO, LOGL_ERROR, "unable to handover in direct RTP mode\n");
1495 return 0;
1496 }
1497
1498 /* RTP Proxy mode */
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001499 new_rs = new_lchan->abis_ip.rtp_socket;
1500 old_rs = old_lchan->abis_ip.rtp_socket;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001501
1502 if (!new_rs) {
1503 LOGP(DHO, LOGL_ERROR, "no RTP socket for new_lchan\n");
1504 return -EIO;
1505 }
1506
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001507 rsl_ipacc_mdcx_to_rtpsock(new_lchan);
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001508
1509 if (!old_rs) {
1510 LOGP(DHO, LOGL_ERROR, "no RTP socket for old_lchan\n");
1511 return -EIO;
1512 }
1513
1514 /* copy rx_action and reference to other sock */
1515 new_rs->rx_action = old_rs->rx_action;
1516 new_rs->tx_action = old_rs->tx_action;
1517 new_rs->transmit = old_rs->transmit;
1518
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001519 switch (old_lchan->abis_ip.rtp_socket->rx_action) {
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001520 case RTP_PROXY:
1521 other_rs = old_rs->proxy.other_sock;
1522 rtp_socket_proxy(new_rs, other_rs);
1523 /* delete reference to other end socket to prevent
1524 * rtp_socket_free() from removing the inverse reference */
1525 old_rs->proxy.other_sock = NULL;
1526 break;
1527 case RTP_RECV_UPSTREAM:
1528 new_rs->receive = old_rs->receive;
1529 break;
1530 case RTP_NONE:
1531 break;
1532 }
1533
1534 return 0;
1535}
1536
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02001537static void maybe_switch_for_handover(struct gsm_lchan *lchan)
1538{
1539 struct gsm_lchan *old_lchan;
1540 old_lchan = bsc_handover_pending(lchan);
1541 if (old_lchan)
1542 switch_for_handover(old_lchan, lchan);
1543}
1544
Harald Welte805f6442009-07-28 18:25:29 +02001545/* some other part of the code sends us a signal */
1546static int handle_abisip_signal(unsigned int subsys, unsigned int signal,
1547 void *handler_data, void *signal_data)
1548{
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02001549 struct gsm_lchan *lchan = signal_data;
Harald Welte805f6442009-07-28 18:25:29 +02001550 int rc;
Harald Welteda7ab742009-12-19 22:23:05 +01001551 struct gsm_network *net;
1552 struct gsm_trans *trans;
Harald Welte805f6442009-07-28 18:25:29 +02001553
1554 if (subsys != SS_ABISIP)
1555 return 0;
1556
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02001557 /* RTP bridge handling */
1558 if (lchan->conn && lchan->conn->mncc_rtp_bridge)
1559 return tch_rtp_signal(lchan, signal);
1560
Harald Welte805f6442009-07-28 18:25:29 +02001561 /* in case we use direct BTS-to-BTS RTP */
1562 if (ipacc_rtp_direct)
1563 return 0;
1564
Harald Welte805f6442009-07-28 18:25:29 +02001565 switch (signal) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001566 case S_ABISIP_CRCX_ACK:
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001567 /* in case we don't use direct BTS-to-BTS RTP */
1568 /* the BTS has successfully bound a TCH to a local ip/port,
1569 * which means we can connect our UDP socket to it */
1570 if (lchan->abis_ip.rtp_socket) {
1571 rtp_socket_free(lchan->abis_ip.rtp_socket);
1572 lchan->abis_ip.rtp_socket = NULL;
1573 }
1574
1575 lchan->abis_ip.rtp_socket = rtp_socket_create();
1576 if (!lchan->abis_ip.rtp_socket)
1577 return -EIO;
1578
1579 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1580 lchan->abis_ip.bound_ip,
1581 lchan->abis_ip.bound_port);
1582 if (rc < 0)
1583 return -EIO;
1584
Harald Welteda7ab742009-12-19 22:23:05 +01001585 /* check if any transactions on this lchan still have
1586 * a tch_recv_mncc request pending */
1587 net = lchan->ts->trx->bts->network;
1588 llist_for_each_entry(trans, &net->trans_list, entry) {
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001589 if (trans->conn && trans->conn->lchan == lchan && trans->tch_recv) {
Harald Welteda7ab742009-12-19 22:23:05 +01001590 DEBUGP(DCC, "pending tch_recv_mncc request\n");
1591 tch_recv_mncc(net, trans->callref, 1);
1592 }
1593 }
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001594
1595 /*
1596 * TODO: this appears to be too early? Why not until after
1597 * the handover detect or the handover complete?
1598 *
1599 * Do we have a handover pending for this new lchan? In that
1600 * case re-route the audio from the old channel to the new one.
1601 */
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02001602 maybe_switch_for_handover(lchan);
Harald Welte805f6442009-07-28 18:25:29 +02001603 break;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001604 case S_ABISIP_DLCX_IND:
1605 /* the BTS tells us a RTP stream has been disconnected */
1606 if (lchan->abis_ip.rtp_socket) {
1607 rtp_socket_free(lchan->abis_ip.rtp_socket);
1608 lchan->abis_ip.rtp_socket = NULL;
1609 }
1610
1611 break;
Harald Welte805f6442009-07-28 18:25:29 +02001612 }
1613
1614 return 0;
Harald Welte805f6442009-07-28 18:25:29 +02001615}
1616
Harald Welte49f48b82009-02-17 15:29:33 +00001617/* map two ipaccess RTP streams onto each other */
Harald Welte11fa29c2009-02-19 17:24:39 +00001618static int tch_map(struct gsm_lchan *lchan, struct gsm_lchan *remote_lchan)
Harald Welte49f48b82009-02-17 15:29:33 +00001619{
Harald Welte11fa29c2009-02-19 17:24:39 +00001620 struct gsm_bts *bts = lchan->ts->trx->bts;
1621 struct gsm_bts *remote_bts = remote_lchan->ts->trx->bts;
Max8db12e42016-04-18 23:11:18 +02001622 enum gsm_chan_t lt = lchan->type, rt = remote_lchan->type;
Max3ffce192016-04-25 15:22:00 +02001623 enum gsm48_chan_mode lm = lchan->tch_mode, rm = remote_lchan->tch_mode;
Harald Welte805f6442009-07-28 18:25:29 +02001624 int rc;
Harald Welte49f48b82009-02-17 15:29:33 +00001625
Max8db12e42016-04-18 23:11:18 +02001626 DEBUGP(DCC, "Setting up TCH map between (bts=%u,trx=%u,ts=%u,%s) and "
1627 "(bts=%u,trx=%u,ts=%u,%s)\n",
1628 bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
1629 get_value_string(gsm_chan_t_names, lt),
1630 remote_bts->nr, remote_lchan->ts->trx->nr, remote_lchan->ts->nr,
1631 get_value_string(gsm_chan_t_names, rt));
Harald Welte11fa29c2009-02-19 17:24:39 +00001632
1633 if (bts->type != remote_bts->type) {
Harald Weltee5215b52011-08-09 21:53:20 +02001634 LOGP(DCC, LOGL_ERROR, "Cannot switch calls between different BTS types yet\n");
Harald Welte11fa29c2009-02-19 17:24:39 +00001635 return -EINVAL;
1636 }
Harald Welteda7ab742009-12-19 22:23:05 +01001637
Max3ffce192016-04-25 15:22:00 +02001638 if (lt != rt) {
1639 LOGP(DCC, LOGL_ERROR, "Cannot patch through call with different"
1640 " channel types: local = %s, remote = %s\n",
1641 get_value_string(gsm_chan_t_names, lt),
1642 get_value_string(gsm_chan_t_names, rt));
1643 return -EBADSLT;
1644 }
1645
1646 if (lm != rm) {
1647 LOGP(DCC, LOGL_ERROR, "Cannot patch through call with different"
1648 " channel modes: local = %s, remote = %s\n",
1649 get_value_string(gsm48_chan_mode_names, lm),
1650 get_value_string(gsm48_chan_mode_names, rm));
1651 return -EMEDIUMTYPE;
1652 }
1653
Harald Welteda7ab742009-12-19 22:23:05 +01001654 // todo: map between different bts types
Harald Welte11fa29c2009-02-19 17:24:39 +00001655 switch (bts->type) {
Mike Habene2d82272009-10-02 12:19:34 +01001656 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02001657 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte805f6442009-07-28 18:25:29 +02001658 if (!ipacc_rtp_direct) {
Andreas Eversberga4d0e3c2014-01-22 08:57:18 +01001659 if (!lchan->abis_ip.rtp_socket) {
1660 LOGP(DHO, LOGL_ERROR, "no RTP socket for "
1661 "lchan\n");
1662 return -EIO;
1663 }
1664 if (!remote_lchan->abis_ip.rtp_socket) {
1665 LOGP(DHO, LOGL_ERROR, "no RTP socket for "
1666 "remote_lchan\n");
1667 return -EIO;
1668 }
1669
Harald Welte805f6442009-07-28 18:25:29 +02001670 /* connect the TCH's to our RTP proxy */
Harald Weltea72273e2009-12-20 16:51:09 +01001671 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welte805f6442009-07-28 18:25:29 +02001672 if (rc < 0)
1673 return rc;
Harald Weltea72273e2009-12-20 16:51:09 +01001674 rc = rsl_ipacc_mdcx_to_rtpsock(remote_lchan);
Harald Welte4d54d0b2011-02-19 16:48:17 +01001675 if (rc < 0)
1676 return rc;
Harald Welte805f6442009-07-28 18:25:29 +02001677 /* connect them with each other */
Harald Welte2c828992009-12-02 01:56:49 +05301678 rtp_socket_proxy(lchan->abis_ip.rtp_socket,
1679 remote_lchan->abis_ip.rtp_socket);
Harald Welte805f6442009-07-28 18:25:29 +02001680 } else {
1681 /* directly connect TCH RTP streams to each other */
Harald Welte2c828992009-12-02 01:56:49 +05301682 rc = rsl_ipacc_mdcx(lchan, remote_lchan->abis_ip.bound_ip,
1683 remote_lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301684 remote_lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001685 if (rc < 0)
1686 return rc;
Harald Welte2c828992009-12-02 01:56:49 +05301687 rc = rsl_ipacc_mdcx(remote_lchan, lchan->abis_ip.bound_ip,
1688 lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301689 lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001690 }
Harald Welte11fa29c2009-02-19 17:24:39 +00001691 break;
1692 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03001693 case GSM_BTS_TYPE_RBS2000:
Dieter Spaar16646022011-07-28 00:01:50 +02001694 case GSM_BTS_TYPE_NOKIA_SITE:
Harald Welte11fa29c2009-02-19 17:24:39 +00001695 trau_mux_map_lchan(lchan, remote_lchan);
1696 break;
1697 default:
Harald Weltee5215b52011-08-09 21:53:20 +02001698 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01001699 return -EINVAL;
Harald Welte11fa29c2009-02-19 17:24:39 +00001700 }
Harald Welte49f48b82009-02-17 15:29:33 +00001701
1702 return 0;
1703}
1704
Harald Welte4bfdfe72009-06-10 23:11:52 +08001705/* bridge channels of two transactions */
Harald Welte53d51f52015-12-03 14:59:04 +01001706static int tch_bridge(struct gsm_network *net, struct gsm_mncc_bridge *bridge)
Harald Welte7ccf7782009-02-17 01:43:01 +00001707{
Harald Welte53d51f52015-12-03 14:59:04 +01001708 struct gsm_trans *trans1 = trans_find_by_callref(net, bridge->callref[0]);
1709 struct gsm_trans *trans2 = trans_find_by_callref(net, bridge->callref[1]);
Harald Welte7ccf7782009-02-17 01:43:01 +00001710
Harald Welte4bfdfe72009-06-10 23:11:52 +08001711 if (!trans1 || !trans2)
Harald Welte7ccf7782009-02-17 01:43:01 +00001712 return -EIO;
1713
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001714 if (!trans1->conn || !trans2->conn)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001715 return -EIO;
1716
Holger Hans Peter Freyther249b3f32013-12-29 20:24:37 +01001717 /* Which subscriber do we want to track trans1 or trans2? */
1718 log_set_context(BSC_CTX_SUBSCR, trans1->subscr);
1719
Harald Welte4bfdfe72009-06-10 23:11:52 +08001720 /* through-connect channel */
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001721 return tch_map(trans1->conn->lchan, trans2->conn->lchan);
Harald Welte7ccf7782009-02-17 01:43:01 +00001722}
1723
Harald Welteda7ab742009-12-19 22:23:05 +01001724/* enable receive of channels to MNCC upqueue */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001725static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001726{
1727 struct gsm_trans *trans;
Harald Welteda7ab742009-12-19 22:23:05 +01001728 struct gsm_lchan *lchan;
1729 struct gsm_bts *bts;
1730 int rc;
Harald Welte7ccf7782009-02-17 01:43:01 +00001731
Harald Welte4bfdfe72009-06-10 23:11:52 +08001732 /* Find callref */
Harald Welteda7ab742009-12-19 22:23:05 +01001733 trans = trans_find_by_callref(net, callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001734 if (!trans)
1735 return -EIO;
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001736 if (!trans->conn)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001737 return 0;
Holger Hans Peter Freyther249b3f32013-12-29 20:24:37 +01001738
1739 log_set_context(BSC_CTX_SUBSCR, trans->subscr);
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001740 lchan = trans->conn->lchan;
Harald Welteda7ab742009-12-19 22:23:05 +01001741 bts = lchan->ts->trx->bts;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001742
Andreas Eversbergdcf38e12013-12-05 14:37:11 +01001743 /* store receive state */
1744 trans->tch_recv = enable;
1745
Harald Welteda7ab742009-12-19 22:23:05 +01001746 switch (bts->type) {
1747 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02001748 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welteda7ab742009-12-19 22:23:05 +01001749 if (ipacc_rtp_direct) {
Harald Weltee5215b52011-08-09 21:53:20 +02001750 LOGP(DCC, LOGL_ERROR, "Error: RTP proxy is disabled\n");
Harald Welteda7ab742009-12-19 22:23:05 +01001751 return -EINVAL;
1752 }
Andreas Eversbergdcf38e12013-12-05 14:37:11 +01001753 /* In case, we don't have a RTP socket to the BTS yet, the BTS
1754 * will not be connected to our RTP proxy and the socket will
1755 * not be assigned to the application interface. This method
1756 * will be called again, once the audio socket is created and
1757 * connected. */
Harald Welteda7ab742009-12-19 22:23:05 +01001758 if (!lchan->abis_ip.rtp_socket) {
Harald Welteda7ab742009-12-19 22:23:05 +01001759 DEBUGP(DCC, "queue tch_recv_mncc request (%d)\n", enable);
1760 return 0;
1761 }
1762 if (enable) {
1763 /* connect the TCH's to our RTP proxy */
Harald Weltea72273e2009-12-20 16:51:09 +01001764 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welteda7ab742009-12-19 22:23:05 +01001765 if (rc < 0)
1766 return rc;
1767 /* assign socket to application interface */
1768 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1769 net, callref);
1770 } else
1771 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1772 net, 0);
1773 break;
1774 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03001775 case GSM_BTS_TYPE_RBS2000:
Harald Welte10456972011-08-05 20:11:18 +02001776 case GSM_BTS_TYPE_NOKIA_SITE:
Andreas Eversbergdcf38e12013-12-05 14:37:11 +01001777 /* In case we don't have a TCH with correct mode, the TRAU muxer
1778 * will not be asigned to the application interface. This is
1779 * performed by switch_trau_mux() after successful handover or
1780 * assignment. */
1781 if (lchan->tch_mode == GSM48_CMODE_SIGN) {
1782 DEBUGP(DCC, "queue tch_recv_mncc request (%d)\n", enable);
1783 return 0;
1784 }
Harald Welteda7ab742009-12-19 22:23:05 +01001785 if (enable)
1786 return trau_recv_lchan(lchan, callref);
1787 return trau_mux_unmap(NULL, callref);
1788 break;
1789 default:
Harald Weltee5215b52011-08-09 21:53:20 +02001790 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01001791 return -EINVAL;
1792 }
1793
1794 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001795}
1796
Harald Welte4bfdfe72009-06-10 23:11:52 +08001797static int gsm48_cc_rx_status_enq(struct gsm_trans *trans, struct msgb *msg)
1798{
1799 DEBUGP(DCC, "-> STATUS ENQ\n");
1800 return gsm48_cc_tx_status(trans, msg);
1801}
1802
1803static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg);
1804static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg);
1805
1806static void gsm48_cc_timeout(void *arg)
1807{
1808 struct gsm_trans *trans = arg;
1809 int disconnect = 0, release = 0;
Harald Weltec66b71c2009-06-11 14:23:20 +08001810 int mo_cause = GSM48_CC_CAUSE_RECOVERY_TIMER;
1811 int mo_location = GSM48_CAUSE_LOC_USER;
1812 int l4_cause = GSM48_CC_CAUSE_NORMAL_UNSPEC;
1813 int l4_location = GSM48_CAUSE_LOC_PRN_S_LU;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001814 struct gsm_mncc mo_rel, l4_rel;
1815
1816 memset(&mo_rel, 0, sizeof(struct gsm_mncc));
1817 mo_rel.callref = trans->callref;
1818 memset(&l4_rel, 0, sizeof(struct gsm_mncc));
1819 l4_rel.callref = trans->callref;
1820
Harald Weltedcaf5652009-07-23 18:56:43 +02001821 switch(trans->cc.Tcurrent) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08001822 case 0x303:
1823 release = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001824 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001825 break;
1826 case 0x310:
1827 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001828 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001829 break;
1830 case 0x313:
1831 disconnect = 1;
1832 /* unknown, did not find it in the specs */
1833 break;
1834 case 0x301:
1835 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001836 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001837 break;
1838 case 0x308:
Harald Weltedcaf5652009-07-23 18:56:43 +02001839 if (!trans->cc.T308_second) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08001840 /* restart T308 a second time */
Harald Weltedcaf5652009-07-23 18:56:43 +02001841 gsm48_cc_tx_release(trans, &trans->cc.msg);
1842 trans->cc.T308_second = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001843 break; /* stay in release state */
1844 }
Harald Weltedcaf5652009-07-23 18:56:43 +02001845 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001846 return;
1847// release = 1;
1848// l4_cause = 14;
1849// break;
1850 case 0x306:
1851 release = 1;
Harald Weltedcaf5652009-07-23 18:56:43 +02001852 mo_cause = trans->cc.msg.cause.value;
1853 mo_location = trans->cc.msg.cause.location;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001854 break;
1855 case 0x323:
1856 disconnect = 1;
1857 break;
1858 default:
1859 release = 1;
1860 }
1861
1862 if (release && trans->callref) {
1863 /* process release towards layer 4 */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01001864 mncc_release_ind(trans->net, trans, trans->callref,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001865 l4_location, l4_cause);
1866 trans->callref = 0;
1867 }
1868
1869 if (disconnect && trans->callref) {
1870 /* process disconnect towards layer 4 */
1871 mncc_set_cause(&l4_rel, l4_location, l4_cause);
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01001872 mncc_recvmsg(trans->net, trans, MNCC_DISC_IND, &l4_rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001873 }
1874
1875 /* process disconnect towards mobile station */
1876 if (disconnect || release) {
1877 mncc_set_cause(&mo_rel, mo_location, mo_cause);
Harald Weltedcaf5652009-07-23 18:56:43 +02001878 mo_rel.cause.diag[0] = ((trans->cc.Tcurrent & 0xf00) >> 8) + '0';
1879 mo_rel.cause.diag[1] = ((trans->cc.Tcurrent & 0x0f0) >> 4) + '0';
1880 mo_rel.cause.diag[2] = (trans->cc.Tcurrent & 0x00f) + '0';
Harald Welte4bfdfe72009-06-10 23:11:52 +08001881 mo_rel.cause.diag_len = 3;
1882
1883 if (disconnect)
1884 gsm48_cc_tx_disconnect(trans, &mo_rel);
1885 if (release)
1886 gsm48_cc_tx_release(trans, &mo_rel);
1887 }
1888
1889}
1890
Max3ffce192016-04-25 15:22:00 +02001891/* disconnect both calls from the bridge */
1892static inline void disconnect_bridge(struct gsm_network *net,
1893 struct gsm_mncc_bridge *bridge, int err)
1894{
1895 struct gsm_trans *trans0 = trans_find_by_callref(net, bridge->callref[0]);
1896 struct gsm_trans *trans1 = trans_find_by_callref(net, bridge->callref[1]);
1897 struct gsm_mncc mx_rel;
1898 if (!trans0 || !trans1)
1899 return;
1900
1901 DEBUGP(DCC, "Failed to bridge TCH for calls %x <-> %x :: %s \n",
1902 trans0->callref, trans1->callref, strerror(err));
1903
1904 memset(&mx_rel, 0, sizeof(struct gsm_mncc));
1905 mncc_set_cause(&mx_rel, GSM48_CAUSE_LOC_INN_NET,
1906 GSM48_CC_CAUSE_CHAN_UNACCEPT);
1907
1908 mx_rel.callref = trans0->callref;
1909 gsm48_cc_tx_disconnect(trans0, &mx_rel);
1910
1911 mx_rel.callref = trans1->callref;
1912 gsm48_cc_tx_disconnect(trans1, &mx_rel);
1913}
1914
Harald Welte4bfdfe72009-06-10 23:11:52 +08001915static void gsm48_start_cc_timer(struct gsm_trans *trans, int current,
1916 int sec, int micro)
1917{
1918 DEBUGP(DCC, "starting timer T%x with %d seconds\n", current, sec);
Harald Weltedcaf5652009-07-23 18:56:43 +02001919 trans->cc.timer.cb = gsm48_cc_timeout;
1920 trans->cc.timer.data = trans;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001921 osmo_timer_schedule(&trans->cc.timer, sec, micro);
Harald Weltedcaf5652009-07-23 18:56:43 +02001922 trans->cc.Tcurrent = current;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001923}
1924
1925static int gsm48_cc_rx_setup(struct gsm_trans *trans, struct msgb *msg)
1926{
1927 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyr531734a2016-03-14 16:13:24 +01001928 uint8_t msg_type = gsm48_hdr_msg_type(gh);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001929 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1930 struct tlv_parsed tp;
1931 struct gsm_mncc setup;
1932
1933 memset(&setup, 0, sizeof(struct gsm_mncc));
1934 setup.callref = trans->callref;
Andreas Eversbergcaae10b2014-01-16 16:04:12 +01001935 setup.lchan_type = trans->conn->lchan->type;
Harald Welte474d19f2010-03-02 23:18:30 +01001936 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001937 /* emergency setup is identified by msg_type */
1938 if (msg_type == GSM48_MT_CC_EMERG_SETUP)
1939 setup.emergency = 1;
1940
1941 /* use subscriber as calling party number */
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +02001942 setup.fields |= MNCC_F_CALLING;
1943 strncpy(setup.calling.number, trans->subscr->extension,
1944 sizeof(setup.calling.number)-1);
1945 strncpy(setup.imsi, trans->subscr->imsi,
1946 sizeof(setup.imsi)-1);
1947
Harald Welte4bfdfe72009-06-10 23:11:52 +08001948 /* bearer capability */
1949 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
1950 setup.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001951 gsm48_decode_bearer_cap(&setup.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001952 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
Andreas Eversberga83d5112013-12-07 18:32:28 +01001953 apply_codec_restrictions(trans->conn->bts, &setup.bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001954 }
1955 /* facility */
1956 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
1957 setup.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01001958 gsm48_decode_facility(&setup.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001959 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
1960 }
1961 /* called party bcd number */
1962 if (TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) {
1963 setup.fields |= MNCC_F_CALLED;
Harald Welte55c8f352010-03-07 23:40:35 +01001964 gsm48_decode_called(&setup.called,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001965 TLVP_VAL(&tp, GSM48_IE_CALLED_BCD)-1);
1966 }
1967 /* user-user */
1968 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
1969 setup.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01001970 gsm48_decode_useruser(&setup.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001971 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
1972 }
1973 /* ss-version */
1974 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
1975 setup.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01001976 gsm48_decode_ssversion(&setup.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001977 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
1978 }
1979 /* CLIR suppression */
1980 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_SUPP))
1981 setup.clir.sup = 1;
1982 /* CLIR invocation */
1983 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_INVOC))
1984 setup.clir.inv = 1;
1985 /* cc cap */
1986 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
1987 setup.fields |= MNCC_F_CCCAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001988 gsm48_decode_cccap(&setup.cccap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001989 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
1990 }
1991
Harald Welte4bfdfe72009-06-10 23:11:52 +08001992 new_cc_state(trans, GSM_CSTATE_INITIATED);
1993
Harald Welte (local)47df3992009-12-26 19:45:03 +01001994 LOGP(DCC, LOGL_INFO, "Subscriber %s (%s) sends SETUP to %s\n",
1995 subscr_name(trans->subscr), trans->subscr->extension,
1996 setup.called.number);
1997
Alexander Couzensb847a212016-08-02 11:34:11 +02001998 rate_ctr_inc(&trans->net->msc_ctrs->ctr[MSC_CTR_CALL_MO_SETUP]);
Harald Weltea29e43a2010-12-24 16:06:33 +01001999
Harald Welte4bfdfe72009-06-10 23:11:52 +08002000 /* indicate setup to MNCC */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002001 mncc_recvmsg(trans->net, trans, MNCC_SETUP_IND, &setup);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002002
Harald Welte13cac662009-07-29 12:10:35 +02002003 /* MNCC code will modify the channel asynchronously, we should
2004 * ipaccess-bind only after the modification has been made to the
2005 * lchan->tch_mode */
Harald Welte4bfdfe72009-06-10 23:11:52 +08002006 return 0;
2007}
2008
2009static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg)
Harald Welte65e74cc2008-12-29 01:55:35 +00002010{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002011 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC STUP");
Harald Welte65e74cc2008-12-29 01:55:35 +00002012 struct gsm48_hdr *gh;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002013 struct gsm_mncc *setup = arg;
Harald Welte78283ef2009-07-23 21:36:44 +02002014 int rc, trans_id;
Harald Welte65e74cc2008-12-29 01:55:35 +00002015
Harald Welte7ccf7782009-02-17 01:43:01 +00002016 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Welte65e74cc2008-12-29 01:55:35 +00002017
Harald Welte4bfdfe72009-06-10 23:11:52 +08002018 /* transaction id must not be assigned */
2019 if (trans->transaction_id != 0xff) { /* unasssigned */
2020 DEBUGP(DCC, "TX Setup with assigned transaction. "
2021 "This is not allowed!\n");
2022 /* Temporarily out of order */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002023 rc = mncc_release_ind(trans->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002024 GSM48_CAUSE_LOC_PRN_S_LU,
2025 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002026 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002027 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002028 return rc;
2029 }
2030
2031 /* Get free transaction_id */
Jacob Erlbeckdae1f642014-12-02 14:22:53 +01002032 trans_id = trans_assign_trans_id(trans->net, trans->subscr,
2033 GSM48_PDISC_CC, 0);
Harald Welte78283ef2009-07-23 21:36:44 +02002034 if (trans_id < 0) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002035 /* no free transaction ID */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002036 rc = mncc_release_ind(trans->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002037 GSM48_CAUSE_LOC_PRN_S_LU,
2038 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002039 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002040 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002041 return rc;
2042 }
Harald Welte78283ef2009-07-23 21:36:44 +02002043 trans->transaction_id = trans_id;
Harald Welte49f48b82009-02-17 15:29:33 +00002044
Harald Welte65e74cc2008-12-29 01:55:35 +00002045 gh->msg_type = GSM48_MT_CC_SETUP;
Harald Welte09e38af2009-02-16 22:52:23 +00002046
Harald Welte4bfdfe72009-06-10 23:11:52 +08002047 gsm48_start_cc_timer(trans, 0x303, GSM48_T303);
Harald Welte65e74cc2008-12-29 01:55:35 +00002048
Harald Welte4bfdfe72009-06-10 23:11:52 +08002049 /* bearer capability */
2050 if (setup->fields & MNCC_F_BEARER_CAP)
Harald Welte55c8f352010-03-07 23:40:35 +01002051 gsm48_encode_bearer_cap(msg, 0, &setup->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002052 /* facility */
2053 if (setup->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002054 gsm48_encode_facility(msg, 0, &setup->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002055 /* progress */
2056 if (setup->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002057 gsm48_encode_progress(msg, 0, &setup->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002058 /* calling party BCD number */
2059 if (setup->fields & MNCC_F_CALLING)
Harald Welte55c8f352010-03-07 23:40:35 +01002060 gsm48_encode_calling(msg, &setup->calling);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002061 /* called party BCD number */
2062 if (setup->fields & MNCC_F_CALLED)
Harald Welte55c8f352010-03-07 23:40:35 +01002063 gsm48_encode_called(msg, &setup->called);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002064 /* user-user */
2065 if (setup->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002066 gsm48_encode_useruser(msg, 0, &setup->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002067 /* redirecting party BCD number */
2068 if (setup->fields & MNCC_F_REDIRECTING)
Harald Welte55c8f352010-03-07 23:40:35 +01002069 gsm48_encode_redirecting(msg, &setup->redirecting);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002070 /* signal */
2071 if (setup->fields & MNCC_F_SIGNAL)
Harald Welte55c8f352010-03-07 23:40:35 +01002072 gsm48_encode_signal(msg, setup->signal);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002073
2074 new_cc_state(trans, GSM_CSTATE_CALL_PRESENT);
Harald Welte65e74cc2008-12-29 01:55:35 +00002075
Alexander Couzensb847a212016-08-02 11:34:11 +02002076 rate_ctr_inc(&trans->net->msc_ctrs->ctr[MSC_CTR_CALL_MT_SETUP]);
Harald Weltea29e43a2010-12-24 16:06:33 +01002077
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002078 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte65e74cc2008-12-29 01:55:35 +00002079}
2080
Harald Welte4bfdfe72009-06-10 23:11:52 +08002081static int gsm48_cc_rx_call_conf(struct gsm_trans *trans, struct msgb *msg)
2082{
2083 struct gsm48_hdr *gh = msgb_l3(msg);
2084 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2085 struct tlv_parsed tp;
2086 struct gsm_mncc call_conf;
2087
2088 gsm48_stop_cc_timer(trans);
2089 gsm48_start_cc_timer(trans, 0x310, GSM48_T310);
2090
2091 memset(&call_conf, 0, sizeof(struct gsm_mncc));
2092 call_conf.callref = trans->callref;
Andreas Eversbergcaae10b2014-01-16 16:04:12 +01002093 call_conf.lchan_type = trans->conn->lchan->type;
Harald Welte474d19f2010-03-02 23:18:30 +01002094 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002095#if 0
2096 /* repeat */
2097 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_CIR))
2098 call_conf.repeat = 1;
2099 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_SEQ))
2100 call_conf.repeat = 2;
2101#endif
2102 /* bearer capability */
2103 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2104 call_conf.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002105 gsm48_decode_bearer_cap(&call_conf.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002106 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
Andreas Eversberga83d5112013-12-07 18:32:28 +01002107 apply_codec_restrictions(trans->conn->bts, &call_conf.bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002108 }
2109 /* cause */
2110 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2111 call_conf.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002112 gsm48_decode_cause(&call_conf.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002113 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2114 }
2115 /* cc cap */
2116 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
2117 call_conf.fields |= MNCC_F_CCCAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002118 gsm48_decode_cccap(&call_conf.cccap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002119 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
2120 }
2121
Andreas Eversberg035b8742013-09-19 09:27:06 +02002122 /* IMSI of called subscriber */
2123 strncpy(call_conf.imsi, trans->subscr->imsi,
2124 sizeof(call_conf.imsi)-1);
2125
Harald Welte4bfdfe72009-06-10 23:11:52 +08002126 new_cc_state(trans, GSM_CSTATE_MO_TERM_CALL_CONF);
2127
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002128 return mncc_recvmsg(trans->net, trans, MNCC_CALL_CONF_IND,
Harald Welte596fed42009-07-23 19:06:52 +02002129 &call_conf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002130}
2131
2132static int gsm48_cc_tx_call_proc(struct gsm_trans *trans, void *arg)
2133{
2134 struct gsm_mncc *proceeding = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002135 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC PROC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002136 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2137
Harald Welte4bfdfe72009-06-10 23:11:52 +08002138 gh->msg_type = GSM48_MT_CC_CALL_PROC;
2139
2140 new_cc_state(trans, GSM_CSTATE_MO_CALL_PROC);
2141
2142 /* bearer capability */
2143 if (proceeding->fields & MNCC_F_BEARER_CAP)
Harald Welte55c8f352010-03-07 23:40:35 +01002144 gsm48_encode_bearer_cap(msg, 0, &proceeding->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002145 /* facility */
2146 if (proceeding->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002147 gsm48_encode_facility(msg, 0, &proceeding->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002148 /* progress */
2149 if (proceeding->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002150 gsm48_encode_progress(msg, 0, &proceeding->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002151
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002152 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002153}
2154
2155static int gsm48_cc_rx_alerting(struct gsm_trans *trans, struct msgb *msg)
2156{
2157 struct gsm48_hdr *gh = msgb_l3(msg);
2158 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2159 struct tlv_parsed tp;
2160 struct gsm_mncc alerting;
2161
2162 gsm48_stop_cc_timer(trans);
2163 gsm48_start_cc_timer(trans, 0x301, GSM48_T301);
2164
2165 memset(&alerting, 0, sizeof(struct gsm_mncc));
2166 alerting.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002167 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002168 /* facility */
2169 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2170 alerting.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002171 gsm48_decode_facility(&alerting.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002172 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2173 }
2174
2175 /* progress */
2176 if (TLVP_PRESENT(&tp, GSM48_IE_PROGR_IND)) {
2177 alerting.fields |= MNCC_F_PROGRESS;
Harald Welte55c8f352010-03-07 23:40:35 +01002178 gsm48_decode_progress(&alerting.progress,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002179 TLVP_VAL(&tp, GSM48_IE_PROGR_IND)-1);
2180 }
2181 /* ss-version */
2182 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2183 alerting.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002184 gsm48_decode_ssversion(&alerting.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002185 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2186 }
2187
2188 new_cc_state(trans, GSM_CSTATE_CALL_RECEIVED);
2189
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002190 return mncc_recvmsg(trans->net, trans, MNCC_ALERT_IND,
Harald Welte596fed42009-07-23 19:06:52 +02002191 &alerting);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002192}
2193
2194static int gsm48_cc_tx_alerting(struct gsm_trans *trans, void *arg)
2195{
2196 struct gsm_mncc *alerting = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002197 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC ALERT");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002198 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2199
Harald Welte4bfdfe72009-06-10 23:11:52 +08002200 gh->msg_type = GSM48_MT_CC_ALERTING;
2201
2202 /* facility */
2203 if (alerting->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002204 gsm48_encode_facility(msg, 0, &alerting->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002205 /* progress */
2206 if (alerting->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002207 gsm48_encode_progress(msg, 0, &alerting->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002208 /* user-user */
2209 if (alerting->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002210 gsm48_encode_useruser(msg, 0, &alerting->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002211
2212 new_cc_state(trans, GSM_CSTATE_CALL_DELIVERED);
2213
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002214 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002215}
2216
2217static int gsm48_cc_tx_progress(struct gsm_trans *trans, void *arg)
2218{
2219 struct gsm_mncc *progress = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002220 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC PROGRESS");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002221 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2222
Harald Welte4bfdfe72009-06-10 23:11:52 +08002223 gh->msg_type = GSM48_MT_CC_PROGRESS;
2224
2225 /* progress */
Harald Welte55c8f352010-03-07 23:40:35 +01002226 gsm48_encode_progress(msg, 1, &progress->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002227 /* user-user */
2228 if (progress->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002229 gsm48_encode_useruser(msg, 0, &progress->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002230
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002231 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002232}
2233
2234static int gsm48_cc_tx_connect(struct gsm_trans *trans, void *arg)
2235{
2236 struct gsm_mncc *connect = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002237 struct msgb *msg = gsm48_msgb_alloc_name("GSN 04.08 CC CON");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002238 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2239
Harald Welte4bfdfe72009-06-10 23:11:52 +08002240 gh->msg_type = GSM48_MT_CC_CONNECT;
2241
2242 gsm48_stop_cc_timer(trans);
2243 gsm48_start_cc_timer(trans, 0x313, GSM48_T313);
2244
2245 /* facility */
2246 if (connect->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002247 gsm48_encode_facility(msg, 0, &connect->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002248 /* progress */
2249 if (connect->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002250 gsm48_encode_progress(msg, 0, &connect->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002251 /* connected number */
2252 if (connect->fields & MNCC_F_CONNECTED)
Harald Welte55c8f352010-03-07 23:40:35 +01002253 gsm48_encode_connected(msg, &connect->connected);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002254 /* user-user */
2255 if (connect->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002256 gsm48_encode_useruser(msg, 0, &connect->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002257
2258 new_cc_state(trans, GSM_CSTATE_CONNECT_IND);
2259
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002260 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002261}
2262
2263static int gsm48_cc_rx_connect(struct gsm_trans *trans, struct msgb *msg)
2264{
2265 struct gsm48_hdr *gh = msgb_l3(msg);
2266 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2267 struct tlv_parsed tp;
2268 struct gsm_mncc connect;
2269
2270 gsm48_stop_cc_timer(trans);
2271
2272 memset(&connect, 0, sizeof(struct gsm_mncc));
2273 connect.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002274 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002275 /* use subscriber as connected party number */
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +02002276 connect.fields |= MNCC_F_CONNECTED;
2277 strncpy(connect.connected.number, trans->subscr->extension,
2278 sizeof(connect.connected.number)-1);
2279 strncpy(connect.imsi, trans->subscr->imsi,
2280 sizeof(connect.imsi)-1);
2281
Harald Welte4bfdfe72009-06-10 23:11:52 +08002282 /* facility */
2283 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2284 connect.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002285 gsm48_decode_facility(&connect.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002286 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2287 }
2288 /* user-user */
2289 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2290 connect.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002291 gsm48_decode_useruser(&connect.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002292 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2293 }
2294 /* ss-version */
2295 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2296 connect.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002297 gsm48_decode_ssversion(&connect.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002298 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2299 }
2300
2301 new_cc_state(trans, GSM_CSTATE_CONNECT_REQUEST);
Alexander Couzensb847a212016-08-02 11:34:11 +02002302 rate_ctr_inc(&trans->net->msc_ctrs->ctr[MSC_CTR_CALL_MT_CONNECT]);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002303
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002304 return mncc_recvmsg(trans->net, trans, MNCC_SETUP_CNF, &connect);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002305}
2306
2307
2308static int gsm48_cc_rx_connect_ack(struct gsm_trans *trans, struct msgb *msg)
2309{
2310 struct gsm_mncc connect_ack;
2311
2312 gsm48_stop_cc_timer(trans);
2313
2314 new_cc_state(trans, GSM_CSTATE_ACTIVE);
Alexander Couzensb847a212016-08-02 11:34:11 +02002315 rate_ctr_inc(&trans->net->msc_ctrs->ctr[MSC_CTR_CALL_MO_CONNECT_ACK]);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002316
2317 memset(&connect_ack, 0, sizeof(struct gsm_mncc));
2318 connect_ack.callref = trans->callref;
Harald Weltea29e43a2010-12-24 16:06:33 +01002319
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002320 return mncc_recvmsg(trans->net, trans, MNCC_SETUP_COMPL_IND,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002321 &connect_ack);
2322}
2323
2324static int gsm48_cc_tx_connect_ack(struct gsm_trans *trans, void *arg)
2325{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002326 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC CON ACK");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002327 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2328
Harald Welte4bfdfe72009-06-10 23:11:52 +08002329 gh->msg_type = GSM48_MT_CC_CONNECT_ACK;
2330
2331 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2332
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002333 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002334}
2335
2336static int gsm48_cc_rx_disconnect(struct gsm_trans *trans, struct msgb *msg)
2337{
2338 struct gsm48_hdr *gh = msgb_l3(msg);
2339 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2340 struct tlv_parsed tp;
2341 struct gsm_mncc disc;
2342
2343 gsm48_stop_cc_timer(trans);
2344
2345 new_cc_state(trans, GSM_CSTATE_DISCONNECT_REQ);
2346
2347 memset(&disc, 0, sizeof(struct gsm_mncc));
2348 disc.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002349 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_CAUSE, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002350 /* cause */
2351 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2352 disc.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002353 gsm48_decode_cause(&disc.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002354 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2355 }
2356 /* facility */
2357 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2358 disc.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002359 gsm48_decode_facility(&disc.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002360 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2361 }
2362 /* user-user */
2363 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2364 disc.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002365 gsm48_decode_useruser(&disc.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002366 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2367 }
2368 /* ss-version */
2369 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2370 disc.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002371 gsm48_decode_ssversion(&disc.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002372 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2373 }
2374
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002375 return mncc_recvmsg(trans->net, trans, MNCC_DISC_IND, &disc);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002376
2377}
2378
Harald Weltec66b71c2009-06-11 14:23:20 +08002379static struct gsm_mncc_cause default_cause = {
2380 .location = GSM48_CAUSE_LOC_PRN_S_LU,
2381 .coding = 0,
2382 .rec = 0,
2383 .rec_val = 0,
2384 .value = GSM48_CC_CAUSE_NORMAL_UNSPEC,
2385 .diag_len = 0,
2386 .diag = { 0 },
2387};
Harald Welte4bfdfe72009-06-10 23:11:52 +08002388
2389static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg)
2390{
2391 struct gsm_mncc *disc = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002392 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC DISC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002393 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2394
Harald Welte4bfdfe72009-06-10 23:11:52 +08002395 gh->msg_type = GSM48_MT_CC_DISCONNECT;
2396
2397 gsm48_stop_cc_timer(trans);
2398 gsm48_start_cc_timer(trans, 0x306, GSM48_T306);
2399
2400 /* cause */
2401 if (disc->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002402 gsm48_encode_cause(msg, 1, &disc->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002403 else
Harald Welte55c8f352010-03-07 23:40:35 +01002404 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002405
2406 /* facility */
2407 if (disc->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002408 gsm48_encode_facility(msg, 0, &disc->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002409 /* progress */
2410 if (disc->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002411 gsm48_encode_progress(msg, 0, &disc->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002412 /* user-user */
2413 if (disc->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002414 gsm48_encode_useruser(msg, 0, &disc->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002415
2416 /* store disconnect cause for T306 expiry */
Harald Weltedcaf5652009-07-23 18:56:43 +02002417 memcpy(&trans->cc.msg, disc, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002418
2419 new_cc_state(trans, GSM_CSTATE_DISCONNECT_IND);
2420
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002421 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002422}
2423
2424static int gsm48_cc_rx_release(struct gsm_trans *trans, struct msgb *msg)
2425{
2426 struct gsm48_hdr *gh = msgb_l3(msg);
2427 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2428 struct tlv_parsed tp;
2429 struct gsm_mncc rel;
2430 int rc;
2431
2432 gsm48_stop_cc_timer(trans);
2433
2434 memset(&rel, 0, sizeof(struct gsm_mncc));
2435 rel.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002436 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002437 /* cause */
2438 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2439 rel.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002440 gsm48_decode_cause(&rel.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002441 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2442 }
2443 /* facility */
2444 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2445 rel.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002446 gsm48_decode_facility(&rel.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002447 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2448 }
2449 /* user-user */
2450 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2451 rel.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002452 gsm48_decode_useruser(&rel.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002453 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2454 }
2455 /* ss-version */
2456 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2457 rel.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002458 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002459 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2460 }
2461
Harald Weltedcaf5652009-07-23 18:56:43 +02002462 if (trans->cc.state == GSM_CSTATE_RELEASE_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002463 /* release collision 5.4.5 */
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002464 rc = mncc_recvmsg(trans->net, trans, MNCC_REL_CNF, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002465 } else {
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08002466 rc = gsm48_tx_simple(trans->conn,
Harald Welte6f5aee02009-07-23 21:21:14 +02002467 GSM48_PDISC_CC | (trans->transaction_id << 4),
Harald Welte596fed42009-07-23 19:06:52 +02002468 GSM48_MT_CC_RELEASE_COMPL);
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002469 rc = mncc_recvmsg(trans->net, trans, MNCC_REL_IND, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002470 }
2471
2472 new_cc_state(trans, GSM_CSTATE_NULL);
2473
2474 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002475 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002476
2477 return rc;
2478}
2479
2480static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg)
2481{
2482 struct gsm_mncc *rel = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002483 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC REL");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002484 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2485
Harald Welte4bfdfe72009-06-10 23:11:52 +08002486 gh->msg_type = GSM48_MT_CC_RELEASE;
2487
Harald Welte4bfdfe72009-06-10 23:11:52 +08002488 gsm48_stop_cc_timer(trans);
2489 gsm48_start_cc_timer(trans, 0x308, GSM48_T308);
2490
2491 /* cause */
2492 if (rel->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002493 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002494 /* facility */
2495 if (rel->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002496 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002497 /* user-user */
2498 if (rel->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002499 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002500
Harald Weltedcaf5652009-07-23 18:56:43 +02002501 trans->cc.T308_second = 0;
2502 memcpy(&trans->cc.msg, rel, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002503
Harald Weltedcaf5652009-07-23 18:56:43 +02002504 if (trans->cc.state != GSM_CSTATE_RELEASE_REQ)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002505 new_cc_state(trans, GSM_CSTATE_RELEASE_REQ);
2506
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002507 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002508}
2509
2510static int gsm48_cc_rx_release_compl(struct gsm_trans *trans, struct msgb *msg)
2511{
2512 struct gsm48_hdr *gh = msgb_l3(msg);
2513 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2514 struct tlv_parsed tp;
2515 struct gsm_mncc rel;
2516 int rc = 0;
2517
2518 gsm48_stop_cc_timer(trans);
2519
2520 memset(&rel, 0, sizeof(struct gsm_mncc));
2521 rel.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002522 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002523 /* cause */
2524 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2525 rel.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002526 gsm48_decode_cause(&rel.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002527 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2528 }
2529 /* facility */
2530 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2531 rel.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002532 gsm48_decode_facility(&rel.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002533 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2534 }
2535 /* user-user */
2536 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2537 rel.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002538 gsm48_decode_useruser(&rel.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002539 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2540 }
2541 /* ss-version */
2542 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2543 rel.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002544 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002545 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2546 }
2547
2548 if (trans->callref) {
Harald Weltedcaf5652009-07-23 18:56:43 +02002549 switch (trans->cc.state) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002550 case GSM_CSTATE_CALL_PRESENT:
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002551 rc = mncc_recvmsg(trans->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002552 MNCC_REJ_IND, &rel);
2553 break;
2554 case GSM_CSTATE_RELEASE_REQ:
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002555 rc = mncc_recvmsg(trans->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002556 MNCC_REL_CNF, &rel);
2557 break;
2558 default:
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002559 rc = mncc_recvmsg(trans->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002560 MNCC_REL_IND, &rel);
2561 }
2562 }
2563
2564 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002565 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002566
2567 return rc;
2568}
2569
2570static int gsm48_cc_tx_release_compl(struct gsm_trans *trans, void *arg)
2571{
2572 struct gsm_mncc *rel = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002573 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC REL COMPL");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002574 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Weltec7782de2010-12-21 19:31:41 +01002575 int ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002576
Harald Welte4bfdfe72009-06-10 23:11:52 +08002577 gh->msg_type = GSM48_MT_CC_RELEASE_COMPL;
2578
2579 trans->callref = 0;
2580
2581 gsm48_stop_cc_timer(trans);
2582
2583 /* cause */
2584 if (rel->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002585 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002586 /* facility */
2587 if (rel->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002588 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002589 /* user-user */
2590 if (rel->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002591 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002592
Harald Weltec7782de2010-12-21 19:31:41 +01002593 ret = gsm48_conn_sendmsg(msg, trans->conn, trans);
2594
Harald Weltedcaf5652009-07-23 18:56:43 +02002595 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002596
Harald Weltec7782de2010-12-21 19:31:41 +01002597 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002598}
2599
2600static int gsm48_cc_rx_facility(struct gsm_trans *trans, struct msgb *msg)
2601{
2602 struct gsm48_hdr *gh = msgb_l3(msg);
2603 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2604 struct tlv_parsed tp;
2605 struct gsm_mncc fac;
2606
2607 memset(&fac, 0, sizeof(struct gsm_mncc));
2608 fac.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002609 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_FACILITY, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002610 /* facility */
2611 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2612 fac.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002613 gsm48_decode_facility(&fac.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002614 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2615 }
2616 /* ss-version */
2617 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2618 fac.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002619 gsm48_decode_ssversion(&fac.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002620 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2621 }
2622
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002623 return mncc_recvmsg(trans->net, trans, MNCC_FACILITY_IND, &fac);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002624}
2625
2626static int gsm48_cc_tx_facility(struct gsm_trans *trans, void *arg)
2627{
2628 struct gsm_mncc *fac = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002629 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC FAC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002630 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2631
Harald Welte4bfdfe72009-06-10 23:11:52 +08002632 gh->msg_type = GSM48_MT_CC_FACILITY;
2633
2634 /* facility */
Harald Welte55c8f352010-03-07 23:40:35 +01002635 gsm48_encode_facility(msg, 1, &fac->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002636
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002637 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002638}
2639
2640static int gsm48_cc_rx_hold(struct gsm_trans *trans, struct msgb *msg)
2641{
2642 struct gsm_mncc hold;
2643
2644 memset(&hold, 0, sizeof(struct gsm_mncc));
2645 hold.callref = trans->callref;
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002646 return mncc_recvmsg(trans->net, trans, MNCC_HOLD_IND, &hold);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002647}
2648
2649static int gsm48_cc_tx_hold_ack(struct gsm_trans *trans, void *arg)
2650{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002651 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC HLD ACK");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002652 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2653
Harald Welte4bfdfe72009-06-10 23:11:52 +08002654 gh->msg_type = GSM48_MT_CC_HOLD_ACK;
2655
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002656 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002657}
2658
2659static int gsm48_cc_tx_hold_rej(struct gsm_trans *trans, void *arg)
2660{
2661 struct gsm_mncc *hold_rej = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002662 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC HLD REJ");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002663 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2664
Harald Welte4bfdfe72009-06-10 23:11:52 +08002665 gh->msg_type = GSM48_MT_CC_HOLD_REJ;
2666
2667 /* cause */
2668 if (hold_rej->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002669 gsm48_encode_cause(msg, 1, &hold_rej->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002670 else
Harald Welte55c8f352010-03-07 23:40:35 +01002671 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002672
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002673 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002674}
2675
2676static int gsm48_cc_rx_retrieve(struct gsm_trans *trans, struct msgb *msg)
2677{
2678 struct gsm_mncc retrieve;
2679
2680 memset(&retrieve, 0, sizeof(struct gsm_mncc));
2681 retrieve.callref = trans->callref;
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002682 return mncc_recvmsg(trans->net, trans, MNCC_RETRIEVE_IND,
Harald Welte596fed42009-07-23 19:06:52 +02002683 &retrieve);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002684}
2685
2686static int gsm48_cc_tx_retrieve_ack(struct gsm_trans *trans, void *arg)
2687{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002688 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC RETR ACK");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002689 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2690
Harald Welte4bfdfe72009-06-10 23:11:52 +08002691 gh->msg_type = GSM48_MT_CC_RETR_ACK;
2692
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002693 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002694}
2695
2696static int gsm48_cc_tx_retrieve_rej(struct gsm_trans *trans, void *arg)
2697{
2698 struct gsm_mncc *retrieve_rej = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002699 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC RETR REJ");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002700 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2701
Harald Welte4bfdfe72009-06-10 23:11:52 +08002702 gh->msg_type = GSM48_MT_CC_RETR_REJ;
2703
2704 /* cause */
2705 if (retrieve_rej->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002706 gsm48_encode_cause(msg, 1, &retrieve_rej->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002707 else
Harald Welte55c8f352010-03-07 23:40:35 +01002708 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002709
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002710 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002711}
2712
2713static int gsm48_cc_rx_start_dtmf(struct gsm_trans *trans, struct msgb *msg)
2714{
2715 struct gsm48_hdr *gh = msgb_l3(msg);
2716 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2717 struct tlv_parsed tp;
2718 struct gsm_mncc dtmf;
2719
2720 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2721 dtmf.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002722 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002723 /* keypad facility */
2724 if (TLVP_PRESENT(&tp, GSM48_IE_KPD_FACILITY)) {
2725 dtmf.fields |= MNCC_F_KEYPAD;
Harald Welte55c8f352010-03-07 23:40:35 +01002726 gsm48_decode_keypad(&dtmf.keypad,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002727 TLVP_VAL(&tp, GSM48_IE_KPD_FACILITY)-1);
2728 }
2729
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002730 return mncc_recvmsg(trans->net, trans, MNCC_START_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002731}
2732
2733static int gsm48_cc_tx_start_dtmf_ack(struct gsm_trans *trans, void *arg)
2734{
2735 struct gsm_mncc *dtmf = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002736 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 DTMF ACK");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002737 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2738
Harald Welte4bfdfe72009-06-10 23:11:52 +08002739 gh->msg_type = GSM48_MT_CC_START_DTMF_ACK;
2740
2741 /* keypad */
2742 if (dtmf->fields & MNCC_F_KEYPAD)
Harald Welte55c8f352010-03-07 23:40:35 +01002743 gsm48_encode_keypad(msg, dtmf->keypad);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002744
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002745 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002746}
2747
2748static int gsm48_cc_tx_start_dtmf_rej(struct gsm_trans *trans, void *arg)
2749{
2750 struct gsm_mncc *dtmf = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002751 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 DTMF REJ");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002752 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2753
Harald Welte4bfdfe72009-06-10 23:11:52 +08002754 gh->msg_type = GSM48_MT_CC_START_DTMF_REJ;
2755
2756 /* cause */
2757 if (dtmf->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002758 gsm48_encode_cause(msg, 1, &dtmf->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002759 else
Harald Welte55c8f352010-03-07 23:40:35 +01002760 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002761
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002762 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002763}
2764
2765static int gsm48_cc_tx_stop_dtmf_ack(struct gsm_trans *trans, void *arg)
2766{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002767 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 DTMF STP ACK");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002768 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2769
Harald Welte4bfdfe72009-06-10 23:11:52 +08002770 gh->msg_type = GSM48_MT_CC_STOP_DTMF_ACK;
2771
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002772 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002773}
2774
2775static int gsm48_cc_rx_stop_dtmf(struct gsm_trans *trans, struct msgb *msg)
2776{
2777 struct gsm_mncc dtmf;
2778
2779 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2780 dtmf.callref = trans->callref;
2781
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002782 return mncc_recvmsg(trans->net, trans, MNCC_STOP_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002783}
2784
2785static int gsm48_cc_rx_modify(struct gsm_trans *trans, struct msgb *msg)
2786{
2787 struct gsm48_hdr *gh = msgb_l3(msg);
2788 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2789 struct tlv_parsed tp;
2790 struct gsm_mncc modify;
2791
2792 memset(&modify, 0, sizeof(struct gsm_mncc));
2793 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002794 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002795 /* bearer capability */
2796 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2797 modify.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002798 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002799 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
Andreas Eversberga83d5112013-12-07 18:32:28 +01002800 apply_codec_restrictions(trans->conn->bts, &modify.bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002801 }
2802
2803 new_cc_state(trans, GSM_CSTATE_MO_ORIG_MODIFY);
2804
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002805 return mncc_recvmsg(trans->net, trans, MNCC_MODIFY_IND, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002806}
2807
2808static int gsm48_cc_tx_modify(struct gsm_trans *trans, void *arg)
2809{
2810 struct gsm_mncc *modify = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002811 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC MOD");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002812 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2813
Harald Welte4bfdfe72009-06-10 23:11:52 +08002814 gh->msg_type = GSM48_MT_CC_MODIFY;
2815
2816 gsm48_start_cc_timer(trans, 0x323, GSM48_T323);
2817
2818 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002819 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002820
2821 new_cc_state(trans, GSM_CSTATE_MO_TERM_MODIFY);
2822
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002823 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002824}
2825
2826static int gsm48_cc_rx_modify_complete(struct gsm_trans *trans, struct msgb *msg)
2827{
2828 struct gsm48_hdr *gh = msgb_l3(msg);
2829 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2830 struct tlv_parsed tp;
2831 struct gsm_mncc modify;
2832
2833 gsm48_stop_cc_timer(trans);
2834
2835 memset(&modify, 0, sizeof(struct gsm_mncc));
2836 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002837 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002838 /* bearer capability */
2839 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2840 modify.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002841 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002842 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
Andreas Eversberga83d5112013-12-07 18:32:28 +01002843 apply_codec_restrictions(trans->conn->bts, &modify.bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002844 }
2845
2846 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2847
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002848 return mncc_recvmsg(trans->net, trans, MNCC_MODIFY_CNF, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002849}
2850
2851static int gsm48_cc_tx_modify_complete(struct gsm_trans *trans, void *arg)
2852{
2853 struct gsm_mncc *modify = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002854 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC MOD COMPL");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002855 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2856
Harald Welte4bfdfe72009-06-10 23:11:52 +08002857 gh->msg_type = GSM48_MT_CC_MODIFY_COMPL;
2858
2859 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002860 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002861
2862 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2863
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002864 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002865}
2866
2867static int gsm48_cc_rx_modify_reject(struct gsm_trans *trans, struct msgb *msg)
2868{
2869 struct gsm48_hdr *gh = msgb_l3(msg);
2870 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2871 struct tlv_parsed tp;
2872 struct gsm_mncc modify;
2873
2874 gsm48_stop_cc_timer(trans);
2875
2876 memset(&modify, 0, sizeof(struct gsm_mncc));
2877 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002878 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, GSM48_IE_CAUSE);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002879 /* bearer capability */
2880 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2881 modify.fields |= GSM48_IE_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002882 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002883 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
Andreas Eversberga83d5112013-12-07 18:32:28 +01002884 apply_codec_restrictions(trans->conn->bts, &modify.bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002885 }
2886 /* cause */
2887 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2888 modify.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002889 gsm48_decode_cause(&modify.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002890 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2891 }
2892
2893 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2894
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002895 return mncc_recvmsg(trans->net, trans, MNCC_MODIFY_REJ, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002896}
2897
2898static int gsm48_cc_tx_modify_reject(struct gsm_trans *trans, void *arg)
2899{
2900 struct gsm_mncc *modify = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002901 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC MOD REJ");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002902 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2903
Harald Welte4bfdfe72009-06-10 23:11:52 +08002904 gh->msg_type = GSM48_MT_CC_MODIFY_REJECT;
2905
2906 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002907 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002908 /* cause */
Harald Welte55c8f352010-03-07 23:40:35 +01002909 gsm48_encode_cause(msg, 1, &modify->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002910
2911 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2912
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002913 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002914}
2915
2916static int gsm48_cc_tx_notify(struct gsm_trans *trans, void *arg)
2917{
2918 struct gsm_mncc *notify = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002919 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CC NOT");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002920 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2921
Harald Welte4bfdfe72009-06-10 23:11:52 +08002922 gh->msg_type = GSM48_MT_CC_NOTIFY;
2923
2924 /* notify */
Harald Welte55c8f352010-03-07 23:40:35 +01002925 gsm48_encode_notify(msg, notify->notify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002926
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002927 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002928}
2929
2930static int gsm48_cc_rx_notify(struct gsm_trans *trans, struct msgb *msg)
2931{
2932 struct gsm48_hdr *gh = msgb_l3(msg);
2933 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2934// struct tlv_parsed tp;
2935 struct gsm_mncc notify;
2936
2937 memset(&notify, 0, sizeof(struct gsm_mncc));
2938 notify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002939// tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002940 if (payload_len >= 1)
Harald Welte55c8f352010-03-07 23:40:35 +01002941 gsm48_decode_notify(&notify.notify, gh->data);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002942
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002943 return mncc_recvmsg(trans->net, trans, MNCC_NOTIFY_IND, &notify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002944}
2945
2946static int gsm48_cc_tx_userinfo(struct gsm_trans *trans, void *arg)
2947{
2948 struct gsm_mncc *user = arg;
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +01002949 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 USR INFO");
Harald Welte4bfdfe72009-06-10 23:11:52 +08002950 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2951
Harald Welte4bfdfe72009-06-10 23:11:52 +08002952 gh->msg_type = GSM48_MT_CC_USER_INFO;
2953
2954 /* user-user */
2955 if (user->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002956 gsm48_encode_useruser(msg, 1, &user->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002957 /* more data */
2958 if (user->more)
Harald Welte55c8f352010-03-07 23:40:35 +01002959 gsm48_encode_more(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002960
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002961 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002962}
2963
2964static int gsm48_cc_rx_userinfo(struct gsm_trans *trans, struct msgb *msg)
2965{
2966 struct gsm48_hdr *gh = msgb_l3(msg);
2967 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2968 struct tlv_parsed tp;
2969 struct gsm_mncc user;
2970
2971 memset(&user, 0, sizeof(struct gsm_mncc));
2972 user.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002973 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_USER_USER, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002974 /* user-user */
2975 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2976 user.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002977 gsm48_decode_useruser(&user.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002978 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2979 }
2980 /* more data */
2981 if (TLVP_PRESENT(&tp, GSM48_IE_MORE_DATA))
2982 user.more = 1;
2983
Jacob Erlbeckf07c6052014-12-02 11:58:00 +01002984 return mncc_recvmsg(trans->net, trans, MNCC_USERINFO_IND, &user);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002985}
2986
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02002987static int _gsm48_lchan_modify(struct gsm_trans *trans, void *arg)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002988{
2989 struct gsm_mncc *mode = arg;
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02002990 struct gsm_lchan *lchan = trans->conn->lchan;
2991
2992 /*
2993 * We were forced to make an assignment a lot earlier and
2994 * we should avoid sending another assignment that might
2995 * even lead to a different kind of lchan (TCH/F vs. TCH/H).
2996 * In case of rtp-bridge it is too late to change things
2997 * here.
2998 */
2999 if (trans->conn->mncc_rtp_bridge && lchan->tch_mode != GSM48_CMODE_SIGN)
3000 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003001
Andreas Eversberg72c0dbd2013-03-31 11:50:35 +02003002 return gsm0808_assign_req(trans->conn, mode->lchan_mode,
3003 trans->conn->lchan->type != GSM_LCHAN_TCH_H);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003004}
3005
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003006static void mncc_recv_rtp(struct gsm_network *net, uint32_t callref,
3007 int cmd, uint32_t addr, uint16_t port, uint32_t payload_type,
3008 uint32_t payload_msg_type)
3009{
3010 uint8_t data[sizeof(struct gsm_mncc)];
3011 struct gsm_mncc_rtp *rtp;
3012
3013 memset(&data, 0, sizeof(data));
3014 rtp = (struct gsm_mncc_rtp *) &data[0];
3015
3016 rtp->callref = callref;
3017 rtp->msg_type = cmd;
3018 rtp->ip = addr;
3019 rtp->port = port;
3020 rtp->payload_type = payload_type;
3021 rtp->payload_msg_type = payload_msg_type;
3022 mncc_recvmsg(net, NULL, cmd, (struct gsm_mncc *)data);
3023}
3024
3025static void mncc_recv_rtp_sock(struct gsm_network *net, struct gsm_trans *trans, int cmd)
3026{
3027 struct gsm_lchan *lchan;
3028 int msg_type;
3029
3030 lchan = trans->conn->lchan;
3031 switch (lchan->abis_ip.rtp_payload) {
3032 case RTP_PT_GSM_FULL:
3033 msg_type = GSM_TCHF_FRAME;
3034 break;
3035 case RTP_PT_GSM_EFR:
3036 msg_type = GSM_TCHF_FRAME_EFR;
3037 break;
3038 case RTP_PT_GSM_HALF:
3039 msg_type = GSM_TCHH_FRAME;
3040 break;
3041 case RTP_PT_AMR:
3042 msg_type = GSM_TCH_FRAME_AMR;
3043 break;
3044 default:
3045 LOGP(DMNCC, LOGL_ERROR, "%s unknown payload type %d\n",
3046 gsm_lchan_name(lchan), lchan->abis_ip.rtp_payload);
3047 msg_type = 0;
3048 break;
3049 }
3050
3051 return mncc_recv_rtp(net, trans->callref, cmd,
3052 lchan->abis_ip.bound_ip,
3053 lchan->abis_ip.bound_port,
3054 lchan->abis_ip.rtp_payload,
3055 msg_type);
3056}
3057
3058static void mncc_recv_rtp_err(struct gsm_network *net, uint32_t callref, int cmd)
3059{
3060 return mncc_recv_rtp(net, callref, cmd, 0, 0, 0, 0);
3061}
3062
3063static int tch_rtp_create(struct gsm_network *net, uint32_t callref)
3064{
3065 struct gsm_bts *bts;
3066 struct gsm_lchan *lchan;
3067 struct gsm_trans *trans;
Max8db12e42016-04-18 23:11:18 +02003068 enum gsm48_chan_mode m;
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003069
3070 /* Find callref */
3071 trans = trans_find_by_callref(net, callref);
3072 if (!trans) {
3073 LOGP(DMNCC, LOGL_ERROR, "RTP create for non-existing trans\n");
3074 mncc_recv_rtp_err(net, callref, MNCC_RTP_CREATE);
3075 return -EIO;
3076 }
3077 log_set_context(BSC_CTX_SUBSCR, trans->subscr);
3078 if (!trans->conn) {
3079 LOGP(DMNCC, LOGL_NOTICE, "RTP create for trans without conn\n");
3080 mncc_recv_rtp_err(net, callref, MNCC_RTP_CREATE);
3081 return 0;
3082 }
3083
3084 lchan = trans->conn->lchan;
3085 bts = lchan->ts->trx->bts;
3086 if (!is_ipaccess_bts(bts)) {
3087 /*
3088 * I want this to be straight forward and have no audio flow
3089 * through the nitb/osmo-mss system. This currently means that
3090 * this will not work with BS11/Nokia type BTS. We would need
3091 * to have a trau<->rtp bridge for these but still preferable
3092 * in another process.
3093 */
3094 LOGP(DMNCC, LOGL_ERROR, "RTP create only works with IP systems\n");
3095 mncc_recv_rtp_err(net, callref, MNCC_RTP_CREATE);
3096 return -EINVAL;
3097 }
3098
3099 trans->conn->mncc_rtp_bridge = 1;
3100 /*
3101 * *sigh* we need to pick a codec now. Pick the most generic one
3102 * right now and hope we could fix that later on. This is very
Holger Hans Peter Freyther53122b02015-08-20 19:10:58 +02003103 * similiar to the routine above.
3104 * Fallback to the internal MNCC mode to select a route.
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003105 */
3106 if (lchan->tch_mode == GSM48_CMODE_SIGN) {
3107 trans->conn->mncc_rtp_create_pending = 1;
Max8db12e42016-04-18 23:11:18 +02003108 m = mncc_codec_for_mode(lchan->type);
3109 LOGP(DMNCC, LOGL_DEBUG, "RTP create: codec=%s, chan_type=%s\n",
3110 get_value_string(gsm48_chan_mode_names, m),
3111 get_value_string(gsm_chan_t_names, lchan->type));
3112 return gsm0808_assign_req(trans->conn, m,
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003113 lchan->type != GSM_LCHAN_TCH_H);
3114 }
3115
3116 mncc_recv_rtp_sock(trans->net, trans, MNCC_RTP_CREATE);
3117 return 0;
3118}
3119
3120static int tch_rtp_connect(struct gsm_network *net, void *arg)
3121{
3122 struct gsm_lchan *lchan;
3123 struct gsm_trans *trans;
3124 struct gsm_mncc_rtp *rtp = arg;
3125
3126 /* Find callref */
3127 trans = trans_find_by_callref(net, rtp->callref);
3128 if (!trans) {
3129 LOGP(DMNCC, LOGL_ERROR, "RTP connect for non-existing trans\n");
3130 mncc_recv_rtp_err(net, rtp->callref, MNCC_RTP_CONNECT);
3131 return -EIO;
3132 }
3133 log_set_context(BSC_CTX_SUBSCR, trans->subscr);
3134 if (!trans->conn) {
3135 LOGP(DMNCC, LOGL_ERROR, "RTP connect for trans without conn\n");
3136 mncc_recv_rtp_err(net, rtp->callref, MNCC_RTP_CONNECT);
3137 return 0;
3138 }
3139
3140 lchan = trans->conn->lchan;
Max8db12e42016-04-18 23:11:18 +02003141 LOGP(DMNCC, LOGL_DEBUG, "RTP connect: codec=%s, chan_type=%s\n",
3142 get_value_string(gsm48_chan_mode_names,
3143 mncc_codec_for_mode(lchan->type)),
3144 get_value_string(gsm_chan_t_names, lchan->type));
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003145
3146 /* TODO: Check if payload_msg_type is compatible with what we have */
3147 if (rtp->payload_type != lchan->abis_ip.rtp_payload) {
3148 LOGP(DMNCC, LOGL_ERROR, "RTP connect with different RTP payload\n");
3149 mncc_recv_rtp_err(net, rtp->callref, MNCC_RTP_CONNECT);
3150 }
3151
3152 /*
3153 * FIXME: payload2 can't be sent with MDCX as the osmo-bts code
3154 * complains about both rtp and rtp payload2 being present in the
3155 * same package!
3156 */
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02003157 trans->conn->mncc_rtp_connect_pending = 1;
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003158 return rsl_ipacc_mdcx(lchan, rtp->ip, rtp->port, 0);
3159}
3160
3161static int tch_rtp_signal(struct gsm_lchan *lchan, int signal)
3162{
3163 struct gsm_network *net;
3164 struct gsm_trans *tmp, *trans = NULL;
3165
3166 net = lchan->ts->trx->bts->network;
3167 llist_for_each_entry(tmp, &net->trans_list, entry) {
3168 if (!tmp->conn)
3169 continue;
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02003170 if (tmp->conn->lchan != lchan && tmp->conn->ho_lchan != lchan)
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003171 continue;
3172 trans = tmp;
3173 break;
3174 }
3175
3176 if (!trans) {
3177 LOGP(DMNCC, LOGL_ERROR, "%s IPA abis signal but no transaction.\n",
3178 gsm_lchan_name(lchan));
3179 return 0;
3180 }
3181
3182 switch (signal) {
3183 case S_ABISIP_CRCX_ACK:
3184 if (lchan->conn->mncc_rtp_create_pending) {
3185 lchan->conn->mncc_rtp_create_pending = 0;
3186 LOGP(DMNCC, LOGL_NOTICE, "%s sending pending RTP create ind.\n",
3187 gsm_lchan_name(lchan));
3188 mncc_recv_rtp_sock(net, trans, MNCC_RTP_CREATE);
3189 }
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02003190 /*
3191 * TODO: this appears to be too early? Why not until after
3192 * the handover detect or the handover complete?
3193 */
3194 maybe_switch_for_handover(lchan);
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003195 break;
3196 case S_ABISIP_MDCX_ACK:
Holger Hans Peter Freytherc21dcb22015-08-04 14:41:21 +02003197 if (lchan->conn->mncc_rtp_connect_pending) {
3198 lchan->conn->mncc_rtp_connect_pending = 0;
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003199 LOGP(DMNCC, LOGL_NOTICE, "%s sending pending RTP connect ind.\n",
3200 gsm_lchan_name(lchan));
3201 mncc_recv_rtp_sock(net, trans, MNCC_RTP_CONNECT);
3202 }
3203 break;
3204 }
3205
3206 return 0;
3207}
3208
3209
Harald Welte4bfdfe72009-06-10 23:11:52 +08003210static struct downstate {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02003211 uint32_t states;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003212 int type;
3213 int (*rout) (struct gsm_trans *trans, void *arg);
3214} downstatelist[] = {
3215 /* mobile originating call establishment */
3216 {SBIT(GSM_CSTATE_INITIATED), /* 5.2.1.2 */
3217 MNCC_CALL_PROC_REQ, gsm48_cc_tx_call_proc},
3218 {SBIT(GSM_CSTATE_INITIATED) | SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.2 | 5.2.1.5 */
3219 MNCC_ALERT_REQ, gsm48_cc_tx_alerting},
3220 {SBIT(GSM_CSTATE_INITIATED) | SBIT(GSM_CSTATE_MO_CALL_PROC) | SBIT(GSM_CSTATE_CALL_DELIVERED), /* 5.2.1.2 | 5.2.1.6 | 5.2.1.6 */
3221 MNCC_SETUP_RSP, gsm48_cc_tx_connect},
3222 {SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.4.2 */
3223 MNCC_PROGRESS_REQ, gsm48_cc_tx_progress},
3224 /* mobile terminating call establishment */
3225 {SBIT(GSM_CSTATE_NULL), /* 5.2.2.1 */
3226 MNCC_SETUP_REQ, gsm48_cc_tx_setup},
3227 {SBIT(GSM_CSTATE_CONNECT_REQUEST),
3228 MNCC_SETUP_COMPL_REQ, gsm48_cc_tx_connect_ack},
3229 /* signalling during call */
3230 {SBIT(GSM_CSTATE_ACTIVE),
3231 MNCC_NOTIFY_REQ, gsm48_cc_tx_notify},
3232 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ),
3233 MNCC_FACILITY_REQ, gsm48_cc_tx_facility},
3234 {ALL_STATES,
3235 MNCC_START_DTMF_RSP, gsm48_cc_tx_start_dtmf_ack},
3236 {ALL_STATES,
3237 MNCC_START_DTMF_REJ, gsm48_cc_tx_start_dtmf_rej},
3238 {ALL_STATES,
3239 MNCC_STOP_DTMF_RSP, gsm48_cc_tx_stop_dtmf_ack},
3240 {SBIT(GSM_CSTATE_ACTIVE),
3241 MNCC_HOLD_CNF, gsm48_cc_tx_hold_ack},
3242 {SBIT(GSM_CSTATE_ACTIVE),
3243 MNCC_HOLD_REJ, gsm48_cc_tx_hold_rej},
3244 {SBIT(GSM_CSTATE_ACTIVE),
3245 MNCC_RETRIEVE_CNF, gsm48_cc_tx_retrieve_ack},
3246 {SBIT(GSM_CSTATE_ACTIVE),
3247 MNCC_RETRIEVE_REJ, gsm48_cc_tx_retrieve_rej},
3248 {SBIT(GSM_CSTATE_ACTIVE),
3249 MNCC_MODIFY_REQ, gsm48_cc_tx_modify},
3250 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
3251 MNCC_MODIFY_RSP, gsm48_cc_tx_modify_complete},
3252 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
3253 MNCC_MODIFY_REJ, gsm48_cc_tx_modify_reject},
3254 {SBIT(GSM_CSTATE_ACTIVE),
3255 MNCC_USERINFO_REQ, gsm48_cc_tx_userinfo},
3256 /* clearing */
3257 {SBIT(GSM_CSTATE_INITIATED),
3258 MNCC_REJ_REQ, gsm48_cc_tx_release_compl},
3259 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_DISCONNECT_IND) - SBIT(GSM_CSTATE_RELEASE_REQ) - SBIT(GSM_CSTATE_DISCONNECT_REQ), /* 5.4.4 */
3260 MNCC_DISC_REQ, gsm48_cc_tx_disconnect},
3261 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3262 MNCC_REL_REQ, gsm48_cc_tx_release},
3263 /* special */
3264 {ALL_STATES,
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02003265 MNCC_LCHAN_MODIFY, _gsm48_lchan_modify},
Harald Welte4bfdfe72009-06-10 23:11:52 +08003266};
3267
3268#define DOWNSLLEN \
3269 (sizeof(downstatelist) / sizeof(struct downstate))
3270
3271
Harald Welte76556372010-12-22 23:57:45 +01003272int mncc_tx_to_cc(struct gsm_network *net, int msg_type, void *arg)
Harald Welte4bfdfe72009-06-10 23:11:52 +08003273{
Harald Welte1a6f7982009-08-09 18:52:33 +02003274 int i, rc = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003275 struct gsm_trans *trans = NULL, *transt;
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003276 struct gsm_subscriber_connection *conn = NULL;
Holger Hans Peter Freytherb56a6bb2010-12-27 16:02:25 +01003277 struct gsm_bts *bts = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003278 struct gsm_mncc *data = arg, rel;
3279
Harald Welte04dc88f2010-12-22 21:45:05 +01003280 DEBUGP(DMNCC, "receive message %s\n", get_mncc_name(msg_type));
3281
Harald Welte4bfdfe72009-06-10 23:11:52 +08003282 /* handle special messages */
3283 switch(msg_type) {
3284 case MNCC_BRIDGE:
Max3ffce192016-04-25 15:22:00 +02003285 rc = tch_bridge(net, arg);
3286 if (rc < 0)
3287 disconnect_bridge(net, arg, -rc);
3288 return rc;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003289 case MNCC_FRAME_DROP:
Harald Welteda7ab742009-12-19 22:23:05 +01003290 return tch_recv_mncc(net, data->callref, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003291 case MNCC_FRAME_RECV:
Harald Welteda7ab742009-12-19 22:23:05 +01003292 return tch_recv_mncc(net, data->callref, 1);
Holger Hans Peter Freytherc8a6c132015-08-04 13:32:09 +02003293 case MNCC_RTP_CREATE:
3294 return tch_rtp_create(net, data->callref);
3295 case MNCC_RTP_CONNECT:
3296 return tch_rtp_connect(net, arg);
3297 case MNCC_RTP_FREE:
3298 /* unused right now */
3299 return -EIO;
Harald Welteda7ab742009-12-19 22:23:05 +01003300 case GSM_TCHF_FRAME:
Andreas Eversbergd074f8f2013-12-06 16:59:10 +01003301 case GSM_TCHF_FRAME_EFR:
Andreas Eversberg63bfdd82014-01-17 19:06:38 +01003302 case GSM_TCHH_FRAME:
Andreas Eversbergd8967f72012-03-08 14:39:19 +01003303 case GSM_TCH_FRAME_AMR:
Harald Welteda7ab742009-12-19 22:23:05 +01003304 /* Find callref */
3305 trans = trans_find_by_callref(net, data->callref);
Harald Welte04dc88f2010-12-22 21:45:05 +01003306 if (!trans) {
3307 LOGP(DMNCC, LOGL_ERROR, "TCH frame for non-existing trans\n");
Harald Welteda7ab742009-12-19 22:23:05 +01003308 return -EIO;
Harald Welte04dc88f2010-12-22 21:45:05 +01003309 }
Holger Hans Peter Freyther249b3f32013-12-29 20:24:37 +01003310 log_set_context(BSC_CTX_SUBSCR, trans->subscr);
Harald Welte04dc88f2010-12-22 21:45:05 +01003311 if (!trans->conn) {
3312 LOGP(DMNCC, LOGL_NOTICE, "TCH frame for trans without conn\n");
Harald Welteda7ab742009-12-19 22:23:05 +01003313 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01003314 }
Andreas Eversberg93e795c2013-03-11 08:20:48 +01003315 if (!trans->conn->lchan) {
3316 LOGP(DMNCC, LOGL_NOTICE, "TCH frame for trans without lchan\n");
3317 return 0;
3318 }
Andreas Eversberg63bfdd82014-01-17 19:06:38 +01003319 if (trans->conn->lchan->type != GSM_LCHAN_TCH_F
3320 && trans->conn->lchan->type != GSM_LCHAN_TCH_H) {
Harald Welte04dc88f2010-12-22 21:45:05 +01003321 /* This should be LOGL_ERROR or NOTICE, but
3322 * unfortuantely it happens for a couple of frames at
3323 * the beginning of every RTP connection */
Andreas Eversberg63bfdd82014-01-17 19:06:38 +01003324 LOGP(DMNCC, LOGL_DEBUG, "TCH frame for lchan != TCH_F/TCH_H\n");
Harald Welteda7ab742009-12-19 22:23:05 +01003325 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01003326 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003327 bts = trans->conn->lchan->ts->trx->bts;
Harald Welteda7ab742009-12-19 22:23:05 +01003328 switch (bts->type) {
3329 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02003330 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte04dc88f2010-12-22 21:45:05 +01003331 if (!trans->conn->lchan->abis_ip.rtp_socket) {
Harald Welte91c59c82010-12-24 12:40:21 +01003332 DEBUGP(DMNCC, "TCH frame to lchan without RTP connection\n");
Harald Welteda7ab742009-12-19 22:23:05 +01003333 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01003334 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003335 return rtp_send_frame(trans->conn->lchan->abis_ip.rtp_socket, arg);
Harald Welteda7ab742009-12-19 22:23:05 +01003336 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03003337 case GSM_BTS_TYPE_RBS2000:
Harald Welte10456972011-08-05 20:11:18 +02003338 case GSM_BTS_TYPE_NOKIA_SITE:
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003339 return trau_send_frame(trans->conn->lchan, arg);
Harald Welteda7ab742009-12-19 22:23:05 +01003340 default:
Harald Weltee5215b52011-08-09 21:53:20 +02003341 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01003342 }
3343 return -EINVAL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003344 }
3345
3346 memset(&rel, 0, sizeof(struct gsm_mncc));
3347 rel.callref = data->callref;
3348
3349 /* Find callref */
Harald Weltedcaf5652009-07-23 18:56:43 +02003350 trans = trans_find_by_callref(net, data->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003351
3352 /* Callref unknown */
3353 if (!trans) {
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003354 struct gsm_subscriber *subscr;
3355
Harald Welte4a3464c2009-07-04 10:11:24 +02003356 if (msg_type != MNCC_SETUP_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003357 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3358 "Received '%s' from MNCC with "
3359 "unknown callref %d\n", data->called.number,
3360 get_mncc_name(msg_type), data->callref);
3361 /* Invalid call reference */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003362 return mncc_release_ind(net, NULL, data->callref,
3363 GSM48_CAUSE_LOC_PRN_S_LU,
3364 GSM48_CC_CAUSE_INVAL_TRANS_ID);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003365 }
Andreas Eversbergc079be42009-06-15 23:22:09 +02003366 if (!data->called.number[0] && !data->imsi[0]) {
3367 DEBUGP(DCC, "(bts - trx - ts - ti) "
3368 "Received '%s' from MNCC with "
3369 "no number or IMSI\n", get_mncc_name(msg_type));
3370 /* Invalid number */
3371 return mncc_release_ind(net, NULL, data->callref,
3372 GSM48_CAUSE_LOC_PRN_S_LU,
3373 GSM48_CC_CAUSE_INV_NR_FORMAT);
3374 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003375 /* New transaction due to setup, find subscriber */
Andreas Eversbergc079be42009-06-15 23:22:09 +02003376 if (data->called.number[0])
Jacob Erlbeck1e30a282014-12-03 09:28:24 +01003377 subscr = subscr_get_by_extension(net->subscr_group,
Harald Welte9176bd42009-07-23 18:46:00 +02003378 data->called.number);
Andreas Eversbergc079be42009-06-15 23:22:09 +02003379 else
Jacob Erlbeck1e30a282014-12-03 09:28:24 +01003380 subscr = subscr_get_by_imsi(net->subscr_group,
3381 data->imsi);
Holger Hans Peter Freyther249b3f32013-12-29 20:24:37 +01003382
3383 /* update the subscriber we deal with */
3384 log_set_context(BSC_CTX_SUBSCR, subscr);
3385
Harald Welte4bfdfe72009-06-10 23:11:52 +08003386 /* If subscriber is not found */
3387 if (!subscr) {
3388 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3389 "Received '%s' from MNCC with "
3390 "unknown subscriber %s\n", data->called.number,
3391 get_mncc_name(msg_type), data->called.number);
3392 /* Unknown subscriber */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003393 return mncc_release_ind(net, NULL, data->callref,
3394 GSM48_CAUSE_LOC_PRN_S_LU,
3395 GSM48_CC_CAUSE_UNASSIGNED_NR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003396 }
3397 /* If subscriber is not "attached" */
3398 if (!subscr->lac) {
3399 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3400 "Received '%s' from MNCC with "
3401 "detached subscriber %s\n", data->called.number,
3402 get_mncc_name(msg_type), data->called.number);
3403 subscr_put(subscr);
3404 /* Temporarily out of order */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003405 return mncc_release_ind(net, NULL, data->callref,
3406 GSM48_CAUSE_LOC_PRN_S_LU,
3407 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003408 }
3409 /* Create transaction */
Jacob Erlbeckaf792d62014-12-02 14:22:53 +01003410 trans = trans_alloc(net, subscr, GSM48_PDISC_CC, 0xff, data->callref);
Harald Weltedcaf5652009-07-23 18:56:43 +02003411 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003412 DEBUGP(DCC, "No memory for trans.\n");
3413 subscr_put(subscr);
3414 /* Ressource unavailable */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003415 mncc_release_ind(net, NULL, data->callref,
3416 GSM48_CAUSE_LOC_PRN_S_LU,
3417 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003418 return -ENOMEM;
3419 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003420 /* Find lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003421 conn = connection_for_subscr(subscr);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003422
Harald Welte4bfdfe72009-06-10 23:11:52 +08003423 /* If subscriber has no lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003424 if (!conn) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003425 /* find transaction with this subscriber already paging */
3426 llist_for_each_entry(transt, &net->trans_list, entry) {
3427 /* Transaction of our lchan? */
3428 if (transt == trans ||
3429 transt->subscr != subscr)
3430 continue;
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01003431 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003432 "Received '%s' from MNCC with "
3433 "unallocated channel, paging already "
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01003434 "started for lac %d.\n",
Harald Welte4bfdfe72009-06-10 23:11:52 +08003435 data->called.number,
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01003436 get_mncc_name(msg_type), subscr->lac);
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003437 subscr_put(subscr);
3438 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003439 return 0;
3440 }
3441 /* store setup informations until paging was successfull */
Harald Weltedcaf5652009-07-23 18:56:43 +02003442 memcpy(&trans->cc.msg, data, sizeof(struct gsm_mncc));
Sylvain Munaut567c8dc2010-12-01 22:17:36 +01003443
Holger Hans Peter Freytherd6d7aff2015-04-06 12:03:45 +02003444 /* Request a channel */
3445 trans->paging_request = subscr_request_channel(subscr,
3446 RSL_CHANNEED_TCH_F, setup_trig_pag_evt,
3447 trans);
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01003448 if (!trans->paging_request) {
3449 LOGP(DCC, LOGL_ERROR, "Failed to allocate paging token.\n");
3450 subscr_put(subscr);
3451 trans_free(trans);
3452 return 0;
3453 }
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003454 subscr_put(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003455 return 0;
3456 }
3457 /* Assign lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003458 trans->conn = conn;
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003459 subscr_put(subscr);
Holger Hans Peter Freyther249b3f32013-12-29 20:24:37 +01003460 } else {
3461 /* update the subscriber we deal with */
3462 log_set_context(BSC_CTX_SUBSCR, trans->subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003463 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003464
3465 if (trans->conn)
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003466 conn = trans->conn;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003467
3468 /* if paging did not respond yet */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003469 if (!conn) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003470 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02003471 "Received '%s' from MNCC in paging state\n",
Harald Welte4bfdfe72009-06-10 23:11:52 +08003472 (trans->subscr)?(trans->subscr->extension):"-",
3473 get_mncc_name(msg_type));
Harald Weltec66b71c2009-06-11 14:23:20 +08003474 mncc_set_cause(&rel, GSM48_CAUSE_LOC_PRN_S_LU,
3475 GSM48_CC_CAUSE_NORM_CALL_CLEAR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003476 if (msg_type == MNCC_REL_REQ)
3477 rc = mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
3478 else
3479 rc = mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
3480 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02003481 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003482 return rc;
3483 }
3484
3485 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x sub %s) "
3486 "Received '%s' from MNCC in state %d (%s)\n",
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003487 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Harald Welte4bfdfe72009-06-10 23:11:52 +08003488 trans->transaction_id,
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003489 (trans->conn->subscr)?(trans->conn->subscr->extension):"-",
Harald Weltedcaf5652009-07-23 18:56:43 +02003490 get_mncc_name(msg_type), trans->cc.state,
Harald Weltee95daf192010-03-25 12:13:02 +08003491 gsm48_cc_state_name(trans->cc.state));
Harald Welte4bfdfe72009-06-10 23:11:52 +08003492
3493 /* Find function for current state and message */
3494 for (i = 0; i < DOWNSLLEN; i++)
3495 if ((msg_type == downstatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003496 && ((1 << trans->cc.state) & downstatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003497 break;
3498 if (i == DOWNSLLEN) {
3499 DEBUGP(DCC, "Message unhandled at this state.\n");
3500 return 0;
3501 }
3502
3503 rc = downstatelist[i].rout(trans, arg);
3504
3505 return rc;
3506}
3507
3508
3509static struct datastate {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02003510 uint32_t states;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003511 int type;
3512 int (*rout) (struct gsm_trans *trans, struct msgb *msg);
3513} datastatelist[] = {
3514 /* mobile originating call establishment */
3515 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3516 GSM48_MT_CC_SETUP, gsm48_cc_rx_setup},
3517 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3518 GSM48_MT_CC_EMERG_SETUP, gsm48_cc_rx_setup},
3519 {SBIT(GSM_CSTATE_CONNECT_IND), /* 5.2.1.2 */
3520 GSM48_MT_CC_CONNECT_ACK, gsm48_cc_rx_connect_ack},
3521 /* mobile terminating call establishment */
3522 {SBIT(GSM_CSTATE_CALL_PRESENT), /* 5.2.2.3.2 */
3523 GSM48_MT_CC_CALL_CONF, gsm48_cc_rx_call_conf},
3524 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF), /* ???? | 5.2.2.3.2 */
3525 GSM48_MT_CC_ALERTING, gsm48_cc_rx_alerting},
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02003526 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF) | SBIT(GSM_CSTATE_CALL_RECEIVED), /* (5.2.2.6) | 5.2.2.6 | 5.2.2.6 */
Harald Welte4bfdfe72009-06-10 23:11:52 +08003527 GSM48_MT_CC_CONNECT, gsm48_cc_rx_connect},
3528 /* signalling during call */
3529 {ALL_STATES - SBIT(GSM_CSTATE_NULL),
3530 GSM48_MT_CC_FACILITY, gsm48_cc_rx_facility},
3531 {SBIT(GSM_CSTATE_ACTIVE),
3532 GSM48_MT_CC_NOTIFY, gsm48_cc_rx_notify},
3533 {ALL_STATES,
3534 GSM48_MT_CC_START_DTMF, gsm48_cc_rx_start_dtmf},
3535 {ALL_STATES,
3536 GSM48_MT_CC_STOP_DTMF, gsm48_cc_rx_stop_dtmf},
3537 {ALL_STATES,
3538 GSM48_MT_CC_STATUS_ENQ, gsm48_cc_rx_status_enq},
3539 {SBIT(GSM_CSTATE_ACTIVE),
3540 GSM48_MT_CC_HOLD, gsm48_cc_rx_hold},
3541 {SBIT(GSM_CSTATE_ACTIVE),
3542 GSM48_MT_CC_RETR, gsm48_cc_rx_retrieve},
3543 {SBIT(GSM_CSTATE_ACTIVE),
3544 GSM48_MT_CC_MODIFY, gsm48_cc_rx_modify},
3545 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3546 GSM48_MT_CC_MODIFY_COMPL, gsm48_cc_rx_modify_complete},
3547 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3548 GSM48_MT_CC_MODIFY_REJECT, gsm48_cc_rx_modify_reject},
3549 {SBIT(GSM_CSTATE_ACTIVE),
3550 GSM48_MT_CC_USER_INFO, gsm48_cc_rx_userinfo},
3551 /* clearing */
3552 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3553 GSM48_MT_CC_DISCONNECT, gsm48_cc_rx_disconnect},
3554 {ALL_STATES - SBIT(GSM_CSTATE_NULL), /* 5.4.4.1.2.2 */
3555 GSM48_MT_CC_RELEASE, gsm48_cc_rx_release},
3556 {ALL_STATES, /* 5.4.3.4 */
3557 GSM48_MT_CC_RELEASE_COMPL, gsm48_cc_rx_release_compl},
3558};
3559
3560#define DATASLLEN \
3561 (sizeof(datastatelist) / sizeof(struct datastate))
3562
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003563static int gsm0408_rcv_cc(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte4bc90a12008-12-27 16:32:52 +00003564{
3565 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyr531734a2016-03-14 16:13:24 +01003566 uint8_t msg_type = gsm48_hdr_msg_type(gh);
Neels Hofmeyr961bd0b2016-03-14 16:13:25 +01003567 uint8_t transaction_id = gsm48_hdr_trans_id_flip_ti(gh);
Harald Weltedcaf5652009-07-23 18:56:43 +02003568 struct gsm_trans *trans = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003569 int i, rc = 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00003570
Harald Welte4bfdfe72009-06-10 23:11:52 +08003571 if (msg_type & 0x80) {
3572 DEBUGP(DCC, "MSG 0x%2x not defined for PD error\n", msg_type);
3573 return -EINVAL;
Harald Welte4bc90a12008-12-27 16:32:52 +00003574 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003575
Harald Welte4bfdfe72009-06-10 23:11:52 +08003576 /* Find transaction */
Jacob Erlbeckdae1f642014-12-02 14:22:53 +01003577 trans = trans_find_by_id(conn, GSM48_PDISC_CC, transaction_id);
Harald Weltedcaf5652009-07-23 18:56:43 +02003578
Harald Welte6f5aee02009-07-23 21:21:14 +02003579 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003580 "Received '%s' from MS in state %d (%s)\n",
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003581 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003582 transaction_id, (conn->subscr)?(conn->subscr->extension):"-",
Harald Weltee95daf192010-03-25 12:13:02 +08003583 gsm48_cc_msg_name(msg_type), trans?(trans->cc.state):0,
3584 gsm48_cc_state_name(trans?(trans->cc.state):0));
Harald Welte4bfdfe72009-06-10 23:11:52 +08003585
3586 /* Create transaction */
3587 if (!trans) {
Harald Welte6f5aee02009-07-23 21:21:14 +02003588 DEBUGP(DCC, "Unknown transaction ID %x, "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003589 "creating new trans.\n", transaction_id);
3590 /* Create transaction */
Neels Hofmeyra9f2bb52016-05-09 21:09:47 +02003591 trans = trans_alloc(conn->network, conn->subscr,
Jacob Erlbeckaf792d62014-12-02 14:22:53 +01003592 GSM48_PDISC_CC,
Harald Weltedcaf5652009-07-23 18:56:43 +02003593 transaction_id, new_callref++);
3594 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003595 DEBUGP(DCC, "No memory for trans.\n");
Holger Hans Peter Freytherb549ddf2011-01-16 18:17:04 +01003596 rc = gsm48_tx_simple(conn,
Harald Welte6f5aee02009-07-23 21:21:14 +02003597 GSM48_PDISC_CC | (transaction_id << 4),
Harald Welte4bfdfe72009-06-10 23:11:52 +08003598 GSM48_MT_CC_RELEASE_COMPL);
3599 return -ENOMEM;
3600 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003601 /* Assign transaction */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003602 trans->conn = conn;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003603 }
3604
3605 /* find function for current state and message */
3606 for (i = 0; i < DATASLLEN; i++)
3607 if ((msg_type == datastatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003608 && ((1 << trans->cc.state) & datastatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003609 break;
3610 if (i == DATASLLEN) {
3611 DEBUGP(DCC, "Message unhandled at this state.\n");
3612 return 0;
3613 }
3614
Holger Hans Peter Freyther1e61b252013-07-06 11:45:38 +02003615 assert(trans->subscr);
3616
Harald Welte4bfdfe72009-06-10 23:11:52 +08003617 rc = datastatelist[i].rout(trans, msg);
Harald Welte4bc90a12008-12-27 16:32:52 +00003618
3619 return rc;
3620}
3621
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003622/* Create a dummy to wait five seconds */
3623static void release_anchor(struct gsm_subscriber_connection *conn)
3624{
3625 if (!conn->anch_operation)
3626 return;
3627
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02003628 osmo_timer_del(&conn->anch_operation->timeout);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003629 talloc_free(conn->anch_operation);
3630 conn->anch_operation = NULL;
3631}
3632
3633static void anchor_timeout(void *_data)
3634{
3635 struct gsm_subscriber_connection *con = _data;
3636
3637 release_anchor(con);
3638 msc_release_connection(con);
3639}
3640
3641int gsm0408_new_conn(struct gsm_subscriber_connection *conn)
3642{
3643 conn->anch_operation = talloc_zero(conn, struct gsm_anchor_operation);
3644 if (!conn->anch_operation)
3645 return -1;
3646
3647 conn->anch_operation->timeout.data = conn;
3648 conn->anch_operation->timeout.cb = anchor_timeout;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02003649 osmo_timer_schedule(&conn->anch_operation->timeout, 5, 0);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003650 return 0;
3651}
3652
Neels Hofmeyr378a4922016-05-09 21:07:43 +02003653/* Main entry point for GSM 04.08/44.008 Layer 3 data (e.g. from the BSC). */
Holger Hans Peter Freyther97643312010-06-17 16:41:25 +08003654int gsm0408_dispatch(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00003655{
3656 struct gsm48_hdr *gh = msgb_l3(msg);
Neels Hofmeyr531734a2016-03-14 16:13:24 +01003657 uint8_t pdisc = gsm48_hdr_pdisc(gh);
Harald Welte8470bf22008-12-25 23:28:35 +00003658 int rc = 0;
Harald Welte51008772009-12-29 11:49:12 +01003659
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02003660 OSMO_ASSERT(conn);
3661 OSMO_ASSERT(msg);
3662
Jacob Erlbeck8e68b562014-01-30 21:01:12 +01003663 LOGP(DRLL, LOGL_DEBUG, "Dispatching 04.08 message, pdisc=%d\n", pdisc);
Holger Hans Peter Freyther758f4df2010-06-21 10:34:03 +08003664 if (silent_call_reroute(conn, msg))
3665 return silent_call_rx(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003666
3667 switch (pdisc) {
3668 case GSM48_PDISC_CC:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003669 release_anchor(conn);
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003670 rc = gsm0408_rcv_cc(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003671 break;
3672 case GSM48_PDISC_MM:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003673 rc = gsm0408_rcv_mm(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003674 break;
3675 case GSM48_PDISC_RR:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003676 rc = gsm0408_rcv_rr(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003677 break;
Harald Weltebcae43f2008-12-27 21:45:37 +00003678 case GSM48_PDISC_SMS:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003679 release_anchor(conn);
Holger Hans Peter Freyther97643312010-06-17 16:41:25 +08003680 rc = gsm0411_rcv_sms(conn, msg);
Harald Weltebcae43f2008-12-27 21:45:37 +00003681 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003682 case GSM48_PDISC_MM_GPRS:
Harald Weltebcae43f2008-12-27 21:45:37 +00003683 case GSM48_PDISC_SM_GPRS:
Harald Welte5d24ba12009-12-24 12:13:17 +01003684 LOGP(DRLL, LOGL_NOTICE, "Unimplemented "
3685 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02003686 rc = -ENOTSUP;
Harald Welte52b1f982008-12-23 20:25:15 +00003687 break;
Harald Welte6eafe912009-10-16 08:32:58 +02003688 case GSM48_PDISC_NC_SS:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003689 release_anchor(conn);
Holger Hans Peter Freytherd42c3f22010-06-17 17:35:57 +08003690 rc = handle_rcv_ussd(conn, msg);
Harald Welte6eafe912009-10-16 08:32:58 +02003691 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003692 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01003693 LOGP(DRLL, LOGL_NOTICE, "Unknown "
3694 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Neels Hofmeyrffaed9e2016-05-09 21:38:51 +02003695 rc = -EINVAL;
Harald Welte52b1f982008-12-23 20:25:15 +00003696 break;
3697 }
3698
3699 return rc;
3700}
Harald Welte8470bf22008-12-25 23:28:35 +00003701
Harald Welte805f6442009-07-28 18:25:29 +02003702/*
3703 * This will be ran by the linker when loading the DSO. We use it to
3704 * do system initialization, e.g. registration of signal handlers.
3705 */
3706static __attribute__((constructor)) void on_dso_load_0408(void)
3707{
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02003708 osmo_signal_register_handler(SS_ABISIP, handle_abisip_signal, NULL);
Harald Welte805f6442009-07-28 18:25:29 +02003709}