blob: b69ab953cafd54989f85ccc47c563d6565004bc6 [file] [log] [blame]
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001/* GSM Mobile Radio Interface Layer 3 messages on the A-bis interface
Harald Welte59b04682009-06-10 05:40:52 +08002 * 3GPP TS 04.08 version 7.21.0 Release 1998 / ETSI TS 100 940 V7.21.0 */
3
4/* (C) 2008-2009 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01005 * (C) 2008-2012 by Holger Hans Peter Freyther <zecke@selfish.org>
Harald Welte59b04682009-06-10 05:40:52 +08006 *
7 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
Harald Welte0e3e88e2011-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 Welte59b04682009-06-10 05:40:52 +080012 * (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 Welte0e3e88e2011-01-01 15:25:50 +010017 * GNU Affero General Public License for more details.
Harald Welte59b04682009-06-10 05:40:52 +080018 *
Harald Welte0e3e88e2011-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 Welte59b04682009-06-10 05:40:52 +080021 *
22 */
23
24
25#include <stdio.h>
26#include <stdlib.h>
27#include <string.h>
28#include <errno.h>
29#include <time.h>
30#include <netinet/in.h>
31
Harald Welteeaf4a522012-04-08 16:59:24 +020032#include "bscconfig.h"
33
Sylvain Munaut28c47162009-12-24 00:27:26 +010034#include <openbsc/auth.h>
Harald Welte59b04682009-06-10 05:40:52 +080035#include <openbsc/db.h>
Harald Welte59b04682009-06-10 05:40:52 +080036#include <openbsc/debug.h>
37#include <openbsc/gsm_data.h>
38#include <openbsc/gsm_subscriber.h>
39#include <openbsc/gsm_04_11.h>
40#include <openbsc/gsm_04_08.h>
Holger Hans Peter Freyther9aa29b52010-08-12 01:41:57 +080041#include <openbsc/gsm_04_80.h>
Harald Welte59b04682009-06-10 05:40:52 +080042#include <openbsc/abis_rsl.h>
43#include <openbsc/chan_alloc.h>
44#include <openbsc/paging.h>
45#include <openbsc/signal.h>
Pablo Neira Ayuso42e41df2011-08-17 22:44:07 +020046#include <osmocom/abis/trau_frame.h>
Harald Welte59b04682009-06-10 05:40:52 +080047#include <openbsc/trau_mux.h>
Harald Welte3c062072009-07-28 18:25:29 +020048#include <openbsc/rtp_proxy.h>
Harald Weltec2189a62009-07-23 18:56:43 +020049#include <openbsc/transaction.h>
Harald Welte03115042009-10-16 08:32:58 +020050#include <openbsc/ussd.h>
Harald Weltef6a38ec2009-12-29 11:49:12 +010051#include <openbsc/silent_call.h>
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +080052#include <openbsc/bsc_api.h>
Holger Hans Peter Freyther3a0ec172010-06-30 12:44:07 +080053#include <openbsc/osmo_msc.h>
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +010054#include <openbsc/handover.h>
Pablo Neira Ayuso42e41df2011-08-17 22:44:07 +020055#include <osmocom/abis/e1_input.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010056#include <osmocom/core/bitvec.h>
Holger Hans Peter Freyther89253132010-09-30 18:52:23 +080057
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010058#include <osmocom/gsm/gsm48.h>
59#include <osmocom/gsm/gsm0480.h>
60#include <osmocom/gsm/gsm_utils.h>
61#include <osmocom/core/msgb.h>
62#include <osmocom/core/talloc.h>
63#include <osmocom/gsm/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080064
Holger Hans Peter Freytherac009e52013-07-06 11:45:38 +020065#include <assert.h>
66
Harald Welte (local)8751ee92009-08-15 02:30:58 +020067void *tall_locop_ctx;
Sylvain Munaut28c47162009-12-24 00:27:26 +010068void *tall_authciphop_ctx;
Harald Weltea8379772009-06-20 22:36:41 +020069
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020070int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn, uint32_t tmsi);
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +080071static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020072 uint8_t pdisc, uint8_t msg_type);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +010073static void schedule_reject(struct gsm_subscriber_connection *conn);
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +080074static void release_anchor(struct gsm_subscriber_connection *conn);
Harald Welte59b04682009-06-10 05:40:52 +080075
76struct gsm_lai {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020077 uint16_t mcc;
78 uint16_t mnc;
79 uint16_t lac;
Harald Welte59b04682009-06-10 05:40:52 +080080};
81
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020082static uint32_t new_callref = 0x80000001;
Harald Welte03740842009-06-10 23:11:52 +080083
Harald Welte4f272cc2011-03-03 23:29:05 +010084void cc_tx_to_mncc(struct gsm_network *net, struct msgb *msg)
85{
86 net->mncc_recv(net, msg);
87}
88
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +080089static int gsm48_conn_sendmsg(struct msgb *msg, struct gsm_subscriber_connection *conn,
90 struct gsm_trans *trans)
91{
92 struct gsm48_hdr *gh = (struct gsm48_hdr *) msg->data;
93
94 /* if we get passed a transaction reference, do some common
95 * work that the caller no longer has to do */
96 if (trans) {
97 gh->proto_discr = trans->protocol | (trans->transaction_id << 4);
98 msg->lchan = trans->conn->lchan;
99 }
100
101
102 if (msg->lchan) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200103 struct e1inp_sign_link *sign_link =
104 msg->lchan->ts->trx->rsl_link;
105
106 msg->dst = sign_link;
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800107 if ((gh->proto_discr & GSM48_PDISC_MASK) == GSM48_PDISC_CC)
108 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x) "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200109 "Sending '%s' to MS.\n",
110 sign_link->trx->bts->nr,
111 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800112 gh->proto_discr & 0xf0,
113 gsm48_cc_msg_name(gh->msg_type));
114 else
115 DEBUGP(DCC, "(bts %d trx %d ts %d pd %02x) "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200116 "Sending 0x%02x to MS.\n",
117 sign_link->trx->bts->nr,
118 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800119 gh->proto_discr, gh->msg_type);
120 }
121
Holger Hans Peter Freyther6bfcad82010-11-10 10:16:02 +0100122 return gsm0808_submit_dtap(conn, msg, 0, 0);
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800123}
Sylvain Munaut28c47162009-12-24 00:27:26 +0100124
Holger Hans Peter Freyther9aa29b52010-08-12 01:41:57 +0800125int gsm48_cc_tx_notify_ss(struct gsm_trans *trans, const char *message)
126{
127 struct gsm48_hdr *gh;
128 struct msgb *ss_notify;
129
130 ss_notify = gsm0480_create_notifySS(message);
131 if (!ss_notify)
132 return -1;
133
134 gsm0480_wrap_invoke(ss_notify, GSM0480_OP_CODE_NOTIFY_SS, 0);
135 uint8_t *data = msgb_push(ss_notify, 1);
136 data[0] = ss_notify->len - 1;
137 gh = (struct gsm48_hdr *) msgb_push(ss_notify, sizeof(*gh));
138 gh->msg_type = GSM48_MT_CC_FACILITY;
139 return gsm48_conn_sendmsg(ss_notify, trans->conn, trans);
140}
141
Harald Weltefe01ed72012-01-23 16:40:24 +0100142void release_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut28c47162009-12-24 00:27:26 +0100143{
144 if (!conn->sec_operation)
145 return;
146
147 talloc_free(conn->sec_operation);
148 conn->sec_operation = NULL;
Holger Hans Peter Freyther6e5c50f2010-06-28 17:09:29 +0800149 msc_release_connection(conn);
Sylvain Munaut28c47162009-12-24 00:27:26 +0100150}
151
Harald Weltefe01ed72012-01-23 16:40:24 +0100152void allocate_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut28c47162009-12-24 00:27:26 +0100153{
Sylvain Munaut28c47162009-12-24 00:27:26 +0100154 conn->sec_operation = talloc_zero(tall_authciphop_ctx,
155 struct gsm_security_operation);
156}
157
Sylvain Munautc0bdbb42010-12-01 22:37:05 +0100158int gsm48_secure_channel(struct gsm_subscriber_connection *conn, int key_seq,
159 gsm_cbfn *cb, void *cb_data)
Sylvain Munaut28c47162009-12-24 00:27:26 +0100160{
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800161 struct gsm_network *net = conn->bts->network;
162 struct gsm_subscriber *subscr = conn->subscr;
Sylvain Munaut28c47162009-12-24 00:27:26 +0100163 struct gsm_security_operation *op;
164 struct gsm_auth_tuple atuple;
165 int status = -1, rc;
166
167 /* Check if we _can_ enable encryption. Cases where we can't:
168 * - Encryption disabled in config
169 * - Channel already secured (nothing to do)
170 * - Subscriber equipment doesn't support configured encryption
171 */
172 if (!net->a5_encryption) {
173 status = GSM_SECURITY_NOAVAIL;
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800174 } else if (conn->lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Sylvain Munaut28c47162009-12-24 00:27:26 +0100175 DEBUGP(DMM, "Requesting to secure an already secure channel");
176 status = GSM_SECURITY_SUCCEEDED;
177 } else if (!ms_cm2_a5n_support(subscr->equipment.classmark2,
178 net->a5_encryption)) {
179 DEBUGP(DMM, "Subscriber equipment doesn't support requested encryption");
180 status = GSM_SECURITY_NOAVAIL;
181 }
182
183 /* If not done yet, try to get info for this user */
184 if (status < 0) {
185 rc = auth_get_tuple_for_subscr(&atuple, subscr, key_seq);
186 if (rc <= 0)
187 status = GSM_SECURITY_NOAVAIL;
188 }
189
190 /* Are we done yet ? */
191 if (status >= 0)
192 return cb ?
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800193 cb(GSM_HOOK_RR_SECURITY, status, NULL, conn, cb_data) :
Sylvain Munaut28c47162009-12-24 00:27:26 +0100194 0;
195
196 /* Start an operation (can't have more than one pending !!!) */
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800197 if (conn->sec_operation)
Sylvain Munaut28c47162009-12-24 00:27:26 +0100198 return -EBUSY;
199
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800200 allocate_security_operation(conn);
201 op = conn->sec_operation;
Sylvain Munaut28c47162009-12-24 00:27:26 +0100202 op->cb = cb;
203 op->cb_data = cb_data;
204 memcpy(&op->atuple, &atuple, sizeof(struct gsm_auth_tuple));
205
206 /* FIXME: Should start a timer for completion ... */
207
208 /* Then do whatever is needed ... */
Harald Welte857e15d2010-12-23 18:07:49 +0100209 if (rc == AUTH_DO_AUTH_THAN_CIPH) {
Sylvain Munaut28c47162009-12-24 00:27:26 +0100210 /* Start authentication */
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800211 return gsm48_tx_mm_auth_req(conn, op->atuple.rand, op->atuple.key_seq);
Harald Welte857e15d2010-12-23 18:07:49 +0100212 } else if (rc == AUTH_DO_CIPH) {
Sylvain Munaut28c47162009-12-24 00:27:26 +0100213 /* Start ciphering directly */
Sylvain Munaut469c28f2010-11-29 08:19:04 +0100214 return gsm0808_cipher_mode(conn, net->a5_encryption,
215 op->atuple.kc, 8, 0);
Sylvain Munaut28c47162009-12-24 00:27:26 +0100216 }
217
218 return -EINVAL; /* not reached */
219}
220
Harald Welte59b04682009-06-10 05:40:52 +0800221static int authorize_subscriber(struct gsm_loc_updating_operation *loc,
222 struct gsm_subscriber *subscriber)
223{
224 if (!subscriber)
225 return 0;
226
227 /*
228 * Do not send accept yet as more information should arrive. Some
229 * phones will not send us the information and we will have to check
230 * what we want to do with that.
231 */
232 if (loc && (loc->waiting_for_imsi || loc->waiting_for_imei))
233 return 0;
234
Jan Luebbe3d6294e2009-08-12 12:48:00 +0200235 switch (subscriber->net->auth_policy) {
236 case GSM_AUTH_POLICY_CLOSED:
237 return subscriber->authorized;
Harald Welte (local)16480eb2009-08-13 13:49:51 +0200238 case GSM_AUTH_POLICY_TOKEN:
Harald Welte (local)272f5c72009-08-13 20:44:23 +0200239 if (subscriber->authorized)
240 return subscriber->authorized;
Harald Welte (local)16480eb2009-08-13 13:49:51 +0200241 return (subscriber->flags & GSM_SUBSCRIBER_FIRST_CONTACT);
Jan Luebbe3d6294e2009-08-12 12:48:00 +0200242 case GSM_AUTH_POLICY_ACCEPT_ALL:
Harald Welte59b04682009-06-10 05:40:52 +0800243 return 1;
Jan Luebbe3d6294e2009-08-12 12:48:00 +0200244 default:
245 return 0;
246 }
Harald Welte59b04682009-06-10 05:40:52 +0800247}
248
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100249static void release_loc_updating_req(struct gsm_subscriber_connection *conn)
Harald Welte59b04682009-06-10 05:40:52 +0800250{
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100251 if (!conn->loc_operation)
Harald Welte59b04682009-06-10 05:40:52 +0800252 return;
253
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +0800254 /* No need to keep the connection up */
255 release_anchor(conn);
256
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200257 osmo_timer_del(&conn->loc_operation->updating_timer);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100258 talloc_free(conn->loc_operation);
Holger Hans Peter Freytherbed07092010-12-22 08:53:28 +0100259 conn->loc_operation = NULL;
Holger Hans Peter Freyther6e5c50f2010-06-28 17:09:29 +0800260 msc_release_connection(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800261}
262
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100263static void allocate_loc_updating_req(struct gsm_subscriber_connection *conn)
Harald Welte59b04682009-06-10 05:40:52 +0800264{
Holger Hans Peter Freyther6e5c50f2010-06-28 17:09:29 +0800265 if (conn->loc_operation)
266 LOGP(DMM, LOGL_ERROR, "Connection already had operation.\n");
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100267 release_loc_updating_req(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800268
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100269 conn->loc_operation = talloc_zero(tall_locop_ctx,
Harald Welte857e00d2009-06-26 20:25:23 +0200270 struct gsm_loc_updating_operation);
Harald Welte59b04682009-06-10 05:40:52 +0800271}
272
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100273static int _gsm0408_authorize_sec_cb(unsigned int hooknum, unsigned int event,
274 struct msgb *msg, void *data, void *param)
275{
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800276 struct gsm_subscriber_connection *conn = data;
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100277 int rc = 0;
278
279 switch (event) {
280 case GSM_SECURITY_AUTH_FAILED:
281 release_loc_updating_req(conn);
282 break;
283
284 case GSM_SECURITY_NOAVAIL:
285 case GSM_SECURITY_SUCCEEDED:
286 /* We're all good */
287 db_subscriber_alloc_tmsi(conn->subscr);
Holger Hans Peter Freytherfa2bafd2010-06-15 14:07:27 +0800288 rc = gsm0408_loc_upd_acc(conn, conn->subscr->tmsi);
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800289 if (conn->bts->network->send_mm_info) {
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100290 /* send MM INFO with network name */
Holger Hans Peter Freyther3d315272010-06-15 14:16:02 +0800291 rc = gsm48_tx_mm_info(conn);
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100292 }
293
294 /* call subscr_update after putting the loc_upd_acc
295 * in the transmit queue, since S_SUBSCR_ATTACHED might
296 * trigger further action like SMS delivery */
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800297 subscr_update(conn->subscr, conn->bts,
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100298 GSM_SUBSCRIBER_UPDATE_ATTACHED);
299
Holger Hans Peter Freytherf08a1d72010-12-22 12:11:01 +0100300 /*
301 * The gsm0408_loc_upd_acc sends a MI with the TMSI. The
302 * MS needs to respond with a TMSI REALLOCATION COMPLETE
303 * (even if the TMSI is the same).
304 */
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100305 break;
306
307 default:
308 rc = -EINVAL;
309 };
310
311 return rc;
312}
313
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100314static int gsm0408_authorize(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +0800315{
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100316 if (authorize_subscriber(conn->loc_operation, conn->subscr))
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800317 return gsm48_secure_channel(conn,
Sylvain Munautcb321fb2009-12-24 00:28:01 +0100318 conn->loc_operation->key_seq,
319 _gsm0408_authorize_sec_cb, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800320 return 0;
321}
322
Holger Hans Peter Freytherdfd61a32010-09-18 06:44:24 +0800323void gsm0408_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause)
Harald Welte59b04682009-06-10 05:40:52 +0800324{
Harald Welte03740842009-06-10 23:11:52 +0800325 struct gsm_trans *trans, *temp;
Holger Hans Peter Freyther6e5c50f2010-06-28 17:09:29 +0800326
327 /* avoid someone issuing a clear */
328 conn->in_release = 1;
329
Harald Welte59b04682009-06-10 05:40:52 +0800330 /*
331 * Cancel any outstanding location updating request
Holger Hans Peter Freythered4e3bd2010-06-15 13:16:52 +0800332 * operation taking place on the subscriber connection.
Harald Welte59b04682009-06-10 05:40:52 +0800333 */
Holger Hans Peter Freythered4e3bd2010-06-15 13:16:52 +0800334 release_loc_updating_req(conn);
Holger Hans Peter Freytherd91346a2010-12-28 14:57:20 +0100335
336 /* We might need to cancel the paging response or such. */
337 if (conn->sec_operation && conn->sec_operation->cb) {
338 conn->sec_operation->cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
339 NULL, conn, conn->sec_operation->cb_data);
340 }
341
Holger Hans Peter Freythered4e3bd2010-06-15 13:16:52 +0800342 release_security_operation(conn);
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +0800343 release_anchor(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800344
Holger Hans Peter Freyther0b28dbc2012-12-22 18:45:27 +0100345 /*
346 * Free all transactions that are associated with the released
347 * connection. The transaction code will inform the CC or SMS
348 * facilities that will send the release indications. As part of
349 * the CC REL_IND the remote leg might be released and this will
350 * trigger the call to trans_free. This is something the llist
351 * macro can not handle and we will need to re-iterate the list.
352 *
353 * TODO: Move the trans_list into the subscriber connection and
354 * create a pending list for MT transactions. These exist before
355 * we have a subscriber connection.
356 */
357restart:
Holger Hans Peter Freythered4e3bd2010-06-15 13:16:52 +0800358 llist_for_each_entry_safe(trans, temp, &conn->bts->network->trans_list, entry) {
Holger Hans Peter Freyther0b28dbc2012-12-22 18:45:27 +0100359 if (trans->conn == conn) {
Harald Weltec2189a62009-07-23 18:56:43 +0200360 trans_free(trans);
Holger Hans Peter Freyther0b28dbc2012-12-22 18:45:27 +0100361 goto restart;
362 }
Harald Welte03740842009-06-10 23:11:52 +0800363 }
Harald Welte59b04682009-06-10 05:40:52 +0800364}
365
Harald Weltee8d16172010-12-22 23:17:50 +0100366void gsm0408_clear_all_trans(struct gsm_network *net, int protocol)
367{
368 struct gsm_trans *trans, *temp;
369
370 LOGP(DCC, LOGL_NOTICE, "Clearing all currently active transactions!!!\n");
371
372 llist_for_each_entry_safe(trans, temp, &net->trans_list, entry) {
Harald Weltebd0f33c2010-12-23 02:47:53 +0100373 if (trans->protocol == protocol) {
374 trans->callref = 0;
Harald Weltee8d16172010-12-22 23:17:50 +0100375 trans_free(trans);
Harald Weltebd0f33c2010-12-23 02:47:53 +0100376 }
Harald Weltee8d16172010-12-22 23:17:50 +0100377 }
378}
379
Harald Welte59b04682009-06-10 05:40:52 +0800380/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200381int gsm0408_loc_upd_rej(struct gsm_subscriber_connection *conn, uint8_t cause)
Harald Welte59b04682009-06-10 05:40:52 +0800382{
Holger Hans Peter Freytherb57d5562010-06-15 14:09:34 +0800383 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freyther8073cbd2010-06-15 19:40:05 +0800384 struct msgb *msg;
385
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200386 osmo_counter_inc(bts->network->stats.loc_upd_resp.reject);
Holger Hans Peter Freyther8073cbd2010-06-15 19:40:05 +0800387
388 msg = gsm48_create_loc_upd_rej(cause);
389 if (!msg) {
390 LOGP(DMM, LOGL_ERROR, "Failed to create msg for LOCATION UPDATING REJECT.\n");
391 return -1;
392 }
Harald Welte59b04682009-06-10 05:40:52 +0800393
Holger Hans Peter Freytherb57d5562010-06-15 14:09:34 +0800394 msg->lchan = conn->lchan;
Harald Welte59b04682009-06-10 05:40:52 +0800395
Harald Welte (local)38a9e5d2009-12-26 22:15:28 +0100396 LOGP(DMM, LOGL_INFO, "Subscriber %s: LOCATION UPDATING REJECT "
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100397 "LAC=%u BTS=%u\n", conn->subscr ?
398 subscr_name(conn->subscr) : "unknown",
Holger Hans Peter Freytherb57d5562010-06-15 14:09:34 +0800399 bts->location_area_code, bts->nr);
Harald Welte3edc5a92009-12-22 00:41:05 +0100400
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800401 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800402}
403
404/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200405int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn, uint32_t tmsi)
Harald Welte59b04682009-06-10 05:40:52 +0800406{
Holger Hans Peter Freytherfa2bafd2010-06-15 14:07:27 +0800407 struct gsm_bts *bts = conn->bts;
Harald Welte59b04682009-06-10 05:40:52 +0800408 struct msgb *msg = gsm48_msgb_alloc();
409 struct gsm48_hdr *gh;
410 struct gsm48_loc_area_id *lai;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200411 uint8_t *mid;
Harald Welte59b04682009-06-10 05:40:52 +0800412
Holger Hans Peter Freytherfa2bafd2010-06-15 14:07:27 +0800413 msg->lchan = conn->lchan;
Harald Welte59b04682009-06-10 05:40:52 +0800414
415 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
416 gh->proto_discr = GSM48_PDISC_MM;
417 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
418
419 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Harald Welted8493ac2010-03-04 10:55:40 +0100420 gsm48_generate_lai(lai, bts->network->country_code,
Harald Welte59b04682009-06-10 05:40:52 +0800421 bts->network->network_code, bts->location_area_code);
422
Holger Hans Peter Freyther36897102009-08-01 07:26:59 +0200423 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
Holger Hans Peter Freyther20a0f322009-08-20 08:41:24 +0200424 gsm48_generate_mid_from_tmsi(mid, tmsi);
Harald Welte59b04682009-06-10 05:40:52 +0800425
426 DEBUGP(DMM, "-> LOCATION UPDATE ACCEPT\n");
427
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200428 osmo_counter_inc(bts->network->stats.loc_upd_resp.accept);
Harald Welte3edc5a92009-12-22 00:41:05 +0100429
Holger Hans Peter Freytherfa2bafd2010-06-15 14:07:27 +0800430 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800431}
432
Harald Welte59b04682009-06-10 05:40:52 +0800433/* Transmit Chapter 9.2.10 Identity Request */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200434static int mm_tx_identity_req(struct gsm_subscriber_connection *conn, uint8_t id_type)
Harald Welte59b04682009-06-10 05:40:52 +0800435{
436 struct msgb *msg = gsm48_msgb_alloc();
437 struct gsm48_hdr *gh;
438
Holger Hans Peter Freythercbecea52010-06-15 14:11:01 +0800439 msg->lchan = conn->lchan;
Harald Welte59b04682009-06-10 05:40:52 +0800440
441 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
442 gh->proto_discr = GSM48_PDISC_MM;
443 gh->msg_type = GSM48_MT_MM_ID_REQ;
444 gh->data[0] = id_type;
445
Holger Hans Peter Freythercbecea52010-06-15 14:11:01 +0800446 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800447}
448
Harald Welte59b04682009-06-10 05:40:52 +0800449
450/* Parse Chapter 9.2.11 Identity Response */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800451static int mm_rx_id_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +0800452{
453 struct gsm48_hdr *gh = msgb_l3(msg);
454 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75350412009-07-23 18:46:00 +0200455 struct gsm_bts *bts = lchan->ts->trx->bts;
456 struct gsm_network *net = bts->network;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200457 uint8_t mi_type = gh->data[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200458 char mi_string[GSM48_MI_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800459
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200460 gsm48_mi_to_string(mi_string, sizeof(mi_string), &gh->data[1], gh->data[0]);
Harald Welte59b04682009-06-10 05:40:52 +0800461 DEBUGP(DMM, "IDENTITY RESPONSE: mi_type=0x%02x MI(%s)\n",
462 mi_type, mi_string);
463
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +0200464 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
Harald Welteedf48af2009-12-13 12:39:18 +0100465
Harald Welte59b04682009-06-10 05:40:52 +0800466 switch (mi_type) {
467 case GSM_MI_TYPE_IMSI:
Jan Luebbe9bdbd622009-08-12 10:19:34 +0200468 /* look up subscriber based on IMSI, create if not found */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100469 if (!conn->subscr) {
470 conn->subscr = subscr_get_by_imsi(net, mi_string);
471 if (!conn->subscr)
472 conn->subscr = db_create_subscriber(net, mi_string);
Jan Luebbee2974032009-08-12 10:12:52 +0200473 }
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100474 if (conn->loc_operation)
475 conn->loc_operation->waiting_for_imsi = 0;
Harald Welte59b04682009-06-10 05:40:52 +0800476 break;
477 case GSM_MI_TYPE_IMEI:
478 case GSM_MI_TYPE_IMEISV:
479 /* update subscribe <-> IMEI mapping */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100480 if (conn->subscr) {
481 db_subscriber_assoc_imei(conn->subscr, mi_string);
482 db_sync_equipment(&conn->subscr->equipment);
Harald Welte (local)ced09ed2009-08-17 09:39:55 +0200483 }
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100484 if (conn->loc_operation)
485 conn->loc_operation->waiting_for_imei = 0;
Harald Welte59b04682009-06-10 05:40:52 +0800486 break;
487 }
488
489 /* Check if we can let the mobile station enter */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100490 return gsm0408_authorize(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +0800491}
492
493
494static void loc_upd_rej_cb(void *data)
495{
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100496 struct gsm_subscriber_connection *conn = data;
497 struct gsm_lchan *lchan = conn->lchan;
Harald Welte59936d72009-11-18 20:33:19 +0100498 struct gsm_bts *bts = lchan->ts->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +0800499
Holger Hans Peter Freyther0d91c462011-11-07 12:26:29 +0100500 LOGP(DMM, LOGL_DEBUG, "Location Updating Request procedure timedout.\n");
Holger Hans Peter Freytherb57d5562010-06-15 14:09:34 +0800501 gsm0408_loc_upd_rej(conn, bts->network->reject_cause);
Holger Hans Peter Freyther1817b0b2010-06-16 12:52:28 +0800502 release_loc_updating_req(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800503}
504
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100505static void schedule_reject(struct gsm_subscriber_connection *conn)
Harald Welte59b04682009-06-10 05:40:52 +0800506{
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100507 conn->loc_operation->updating_timer.cb = loc_upd_rej_cb;
508 conn->loc_operation->updating_timer.data = conn;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200509 osmo_timer_schedule(&conn->loc_operation->updating_timer, 5, 0);
Harald Welte59b04682009-06-10 05:40:52 +0800510}
511
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200512static const char *lupd_name(uint8_t type)
Harald Welte59b04682009-06-10 05:40:52 +0800513{
514 switch (type) {
515 case GSM48_LUPD_NORMAL:
516 return "NORMAL";
517 case GSM48_LUPD_PERIODIC:
518 return "PEROIDOC";
519 case GSM48_LUPD_IMSI_ATT:
520 return "IMSI ATTACH";
521 default:
522 return "UNKNOWN";
523 }
524}
525
Harald Welte59b04682009-06-10 05:40:52 +0800526/* Chapter 9.2.15: Receive Location Updating Request */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800527static int mm_rx_loc_upd_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +0800528{
529 struct gsm48_hdr *gh = msgb_l3(msg);
530 struct gsm48_loc_upd_req *lu;
Harald Welte03740842009-06-10 23:11:52 +0800531 struct gsm_subscriber *subscr = NULL;
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800532 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200533 uint8_t mi_type;
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200534 char mi_string[GSM48_MI_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800535
536 lu = (struct gsm48_loc_upd_req *) gh->data;
537
538 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
539
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200540 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Welte59b04682009-06-10 05:40:52 +0800541
Harald Welte79639662009-06-27 02:58:43 +0200542 DEBUGPC(DMM, "mi_type=0x%02x MI(%s) type=%s ", mi_type, mi_string,
Harald Welte59b04682009-06-10 05:40:52 +0800543 lupd_name(lu->type));
544
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +0200545 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
Harald Welteedf48af2009-12-13 12:39:18 +0100546
Harald Welte3edc5a92009-12-22 00:41:05 +0100547 switch (lu->type) {
548 case GSM48_LUPD_NORMAL:
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200549 osmo_counter_inc(bts->network->stats.loc_upd_type.normal);
Harald Welte3edc5a92009-12-22 00:41:05 +0100550 break;
551 case GSM48_LUPD_IMSI_ATT:
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200552 osmo_counter_inc(bts->network->stats.loc_upd_type.attach);
Harald Welte3edc5a92009-12-22 00:41:05 +0100553 break;
554 case GSM48_LUPD_PERIODIC:
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200555 osmo_counter_inc(bts->network->stats.loc_upd_type.periodic);
Harald Welte3edc5a92009-12-22 00:41:05 +0100556 break;
557 }
558
Harald Welte59b04682009-06-10 05:40:52 +0800559 /*
560 * Pseudo Spoof detection: Just drop a second/concurrent
561 * location updating request.
562 */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100563 if (conn->loc_operation) {
Harald Welte79639662009-06-27 02:58:43 +0200564 DEBUGPC(DMM, "ignoring request due an existing one: %p.\n",
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100565 conn->loc_operation);
Holger Hans Peter Freytherb57d5562010-06-15 14:09:34 +0800566 gsm0408_loc_upd_rej(conn, GSM48_REJECT_PROTOCOL_ERROR);
Harald Welte59b04682009-06-10 05:40:52 +0800567 return 0;
568 }
569
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800570 allocate_loc_updating_req(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800571
Sylvain Munaut360fc582010-06-10 13:36:59 +0200572 conn->loc_operation->key_seq = lu->key_seq;
573
Harald Welte59b04682009-06-10 05:40:52 +0800574 switch (mi_type) {
575 case GSM_MI_TYPE_IMSI:
Harald Welte79639662009-06-27 02:58:43 +0200576 DEBUGPC(DMM, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800577 /* we always want the IMEI, too */
Holger Hans Peter Freyther1a9f3ee2012-09-11 11:55:03 +0200578 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100579 conn->loc_operation->waiting_for_imei = 1;
Harald Welte59b04682009-06-10 05:40:52 +0800580
Jan Luebbe9bdbd622009-08-12 10:19:34 +0200581 /* look up subscriber based on IMSI, create if not found */
582 subscr = subscr_get_by_imsi(bts->network, mi_string);
583 if (!subscr) {
584 subscr = db_create_subscriber(bts->network, mi_string);
585 }
Harald Welte59b04682009-06-10 05:40:52 +0800586 break;
587 case GSM_MI_TYPE_TMSI:
Harald Welte79639662009-06-27 02:58:43 +0200588 DEBUGPC(DMM, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800589 /* look up the subscriber based on TMSI, request IMSI if it fails */
Holger Hans Peter Freythercd8bacf2009-08-19 12:53:57 +0200590 subscr = subscr_get_by_tmsi(bts->network,
591 tmsi_from_string(mi_string));
Harald Welte59b04682009-06-10 05:40:52 +0800592 if (!subscr) {
593 /* send IDENTITY REQUEST message to get IMSI */
Holger Hans Peter Freyther1a9f3ee2012-09-11 11:55:03 +0200594 mm_tx_identity_req(conn, GSM_MI_TYPE_IMSI);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100595 conn->loc_operation->waiting_for_imsi = 1;
Harald Welte59b04682009-06-10 05:40:52 +0800596 }
Harald Welteca6dfc02010-06-07 17:56:32 +0200597 /* we always want the IMEI, too */
Holger Hans Peter Freyther1a9f3ee2012-09-11 11:55:03 +0200598 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Harald Welteca6dfc02010-06-07 17:56:32 +0200599 conn->loc_operation->waiting_for_imei = 1;
Harald Welte59b04682009-06-10 05:40:52 +0800600 break;
601 case GSM_MI_TYPE_IMEI:
602 case GSM_MI_TYPE_IMEISV:
603 /* no sim card... FIXME: what to do ? */
Harald Welte79639662009-06-27 02:58:43 +0200604 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte59b04682009-06-10 05:40:52 +0800605 break;
606 default:
Harald Welte79639662009-06-27 02:58:43 +0200607 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte59b04682009-06-10 05:40:52 +0800608 break;
609 }
610
Harald Welteccd69362009-07-04 10:18:00 +0200611 /* schedule the reject timer */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100612 schedule_reject(conn);
Harald Welteccd69362009-07-04 10:18:00 +0200613
Harald Welte03740842009-06-10 23:11:52 +0800614 if (!subscr) {
Harald Welte79639662009-06-27 02:58:43 +0200615 DEBUGPC(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte03740842009-06-10 23:11:52 +0800616 /* FIXME: request id? close channel? */
617 return -EINVAL;
618 }
619
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100620 conn->subscr = subscr;
621 conn->subscr->equipment.classmark1 = lu->classmark1;
Harald Welte59b04682009-06-10 05:40:52 +0800622
Harald Welteccd69362009-07-04 10:18:00 +0200623 /* check if we can let the subscriber into our network immediately
624 * or if we need to wait for identity responses. */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100625 return gsm0408_authorize(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +0800626}
627
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100628/* Turn int into semi-octet representation: 98 => 0x89 */
629static uint8_t bcdify(uint8_t value)
Harald Welte03740842009-06-10 23:11:52 +0800630{
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100631 uint8_t ret;
632
633 ret = value / 10;
634 ret |= (value % 10) << 4;
635
636 return ret;
Harald Welte03740842009-06-10 23:11:52 +0800637}
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100638
Harald Welte03740842009-06-10 23:11:52 +0800639
Harald Welte59b04682009-06-10 05:40:52 +0800640/* Section 9.2.15a */
Holger Hans Peter Freyther3d315272010-06-15 14:16:02 +0800641int gsm48_tx_mm_info(struct gsm_subscriber_connection *conn)
Harald Welte59b04682009-06-10 05:40:52 +0800642{
643 struct msgb *msg = gsm48_msgb_alloc();
644 struct gsm48_hdr *gh;
Holger Hans Peter Freyther3d315272010-06-15 14:16:02 +0800645 struct gsm_network *net = conn->bts->network;
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100646 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200647 uint8_t *ptr8;
Daniel Willmannc8188202009-08-13 03:42:07 +0200648 int name_len, name_pad;
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100649
Harald Welte03740842009-06-10 23:11:52 +0800650 time_t cur_t;
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100651 struct tm* gmt_time;
652 struct tm* local_time;
653 int tzunits;
Harald Welte59b04682009-06-10 05:40:52 +0800654
Holger Hans Peter Freyther3d315272010-06-15 14:16:02 +0800655 msg->lchan = conn->lchan;
Harald Welte59b04682009-06-10 05:40:52 +0800656
657 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
658 gh->proto_discr = GSM48_PDISC_MM;
659 gh->msg_type = GSM48_MT_MM_INFO;
660
661 if (net->name_long) {
Daniel Willmannc8188202009-08-13 03:42:07 +0200662#if 0
Harald Welte59b04682009-06-10 05:40:52 +0800663 name_len = strlen(net->name_long);
664 /* 10.5.3.5a */
665 ptr8 = msgb_put(msg, 3);
666 ptr8[0] = GSM48_IE_NAME_LONG;
667 ptr8[1] = name_len*2 +1;
668 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
669
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200670 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Welte59b04682009-06-10 05:40:52 +0800671 for (i = 0; i < name_len; i++)
672 ptr16[i] = htons(net->name_long[i]);
673
674 /* FIXME: Use Cell Broadcast, not UCS-2, since
675 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmannc8188202009-08-13 03:42:07 +0200676#endif
677 name_len = (strlen(net->name_long)*7)/8;
678 name_pad = (8 - strlen(net->name_long)*7)%8;
679 if (name_pad > 0)
680 name_len++;
681 /* 10.5.3.5a */
682 ptr8 = msgb_put(msg, 3);
683 ptr8[0] = GSM48_IE_NAME_LONG;
684 ptr8[1] = name_len +1;
685 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
686
687 ptr8 = msgb_put(msg, name_len);
688 gsm_7bit_encode(ptr8, net->name_long);
689
Harald Welte59b04682009-06-10 05:40:52 +0800690 }
691
692 if (net->name_short) {
Daniel Willmannc8188202009-08-13 03:42:07 +0200693#if 0
Harald Welte59b04682009-06-10 05:40:52 +0800694 name_len = strlen(net->name_short);
695 /* 10.5.3.5a */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200696 ptr8 = (uint8_t *) msgb_put(msg, 3);
Harald Weltef6284712009-07-19 17:51:36 +0200697 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Welte59b04682009-06-10 05:40:52 +0800698 ptr8[1] = name_len*2 + 1;
699 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
700
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200701 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Welte59b04682009-06-10 05:40:52 +0800702 for (i = 0; i < name_len; i++)
703 ptr16[i] = htons(net->name_short[i]);
Daniel Willmannc8188202009-08-13 03:42:07 +0200704#endif
705 name_len = (strlen(net->name_short)*7)/8;
706 name_pad = (8 - strlen(net->name_short)*7)%8;
707 if (name_pad > 0)
708 name_len++;
709 /* 10.5.3.5a */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200710 ptr8 = (uint8_t *) msgb_put(msg, 3);
Daniel Willmannc8188202009-08-13 03:42:07 +0200711 ptr8[0] = GSM48_IE_NAME_SHORT;
712 ptr8[1] = name_len +1;
713 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
714
715 ptr8 = msgb_put(msg, name_len);
716 gsm_7bit_encode(ptr8, net->name_short);
717
Harald Welte59b04682009-06-10 05:40:52 +0800718 }
719
Harald Welte59b04682009-06-10 05:40:52 +0800720 /* Section 10.5.3.9 */
721 cur_t = time(NULL);
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100722 gmt_time = gmtime(&cur_t);
723
Harald Welte59b04682009-06-10 05:40:52 +0800724 ptr8 = msgb_put(msg, 8);
725 ptr8[0] = GSM48_IE_NET_TIME_TZ;
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100726 ptr8[1] = bcdify(gmt_time->tm_year % 100);
727 ptr8[2] = bcdify(gmt_time->tm_mon + 1);
728 ptr8[3] = bcdify(gmt_time->tm_mday);
729 ptr8[4] = bcdify(gmt_time->tm_hour);
730 ptr8[5] = bcdify(gmt_time->tm_min);
731 ptr8[6] = bcdify(gmt_time->tm_sec);
732
Harald Welte5c3abf92012-07-08 16:48:11 +0200733 if (bts->tz.override) {
734 /* Convert tz.hr and tz.mn to units */
735 if (bts->tz.hr < 0) {
736 tzunits = ((bts->tz.hr/-1)*4);
737 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100738 ptr8[7] = bcdify(tzunits);
739 /* Set negative time */
740 ptr8[7] |= 0x08;
741 }
742 else {
Harald Welte5c3abf92012-07-08 16:48:11 +0200743 tzunits = bts->tz.hr*4;
744 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100745 ptr8[7] = bcdify(tzunits);
746 }
747 }
748 else {
749 /* Need to get GSM offset and convert into 15 min units */
750 /* This probably breaks if gmtoff returns a value not evenly divisible by 15? */
751 local_time = localtime(&cur_t);
Harald Welteeaf4a522012-04-08 16:59:24 +0200752#ifdef HAVE_TM_GMTOFF_IN_TM
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100753 tzunits = (local_time->tm_gmtoff/60)/15;
Harald Welteeaf4a522012-04-08 16:59:24 +0200754#else
755#warning find a portable way to obtain the timezone offset
756 tzunits = 0;
757#endif
Gus Bourgf9dc16b2011-12-02 10:18:17 +0100758 if (tzunits < 0) {
759 tzunits = tzunits/-1;
760 ptr8[7] = bcdify(tzunits);
761 /* Flip it to negative */
762 ptr8[7] |= 0x08;
763 }
764 else
765 ptr8[7] = bcdify(tzunits);
766 }
Harald Welte59b04682009-06-10 05:40:52 +0800767
Daniel Willmannc8188202009-08-13 03:42:07 +0200768 DEBUGP(DMM, "-> MM INFO\n");
769
Holger Hans Peter Freyther3d315272010-06-15 14:16:02 +0800770 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800771}
772
Harald Welte36970f62009-08-12 22:56:50 +0200773/* Section 9.2.2 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200774int gsm48_tx_mm_auth_req(struct gsm_subscriber_connection *conn, uint8_t *rand, int key_seq)
Harald Welte36970f62009-08-12 22:56:50 +0200775{
776 struct msgb *msg = gsm48_msgb_alloc();
777 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut6de6dc12009-09-27 11:10:17 +0200778 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte36970f62009-08-12 22:56:50 +0200779
Pablo Neira Ayusob1d5a692011-05-07 12:12:48 +0200780 DEBUGP(DMM, "-> AUTH REQ (rand = %s)\n", osmo_hexdump(rand, 16));
Harald Welte36970f62009-08-12 22:56:50 +0200781
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800782 msg->lchan = conn->lchan;
Harald Welte36970f62009-08-12 22:56:50 +0200783 gh->proto_discr = GSM48_PDISC_MM;
784 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
785
Sylvain Munaut0789c592009-12-24 00:23:46 +0100786 ar->key_seq = key_seq;
Sylvain Munaut6de6dc12009-09-27 11:10:17 +0200787
Harald Welte36970f62009-08-12 22:56:50 +0200788 /* 16 bytes RAND parameters */
Harald Welte36970f62009-08-12 22:56:50 +0200789 if (rand)
Sylvain Munaut6de6dc12009-09-27 11:10:17 +0200790 memcpy(ar->rand, rand, 16);
Harald Welte36970f62009-08-12 22:56:50 +0200791
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800792 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte36970f62009-08-12 22:56:50 +0200793}
794
795/* Section 9.2.1 */
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800796int gsm48_tx_mm_auth_rej(struct gsm_subscriber_connection *conn)
Harald Welte36970f62009-08-12 22:56:50 +0200797{
798 DEBUGP(DMM, "-> AUTH REJECT\n");
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800799 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
Harald Welte36970f62009-08-12 22:56:50 +0200800}
801
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800802static int gsm48_tx_mm_serv_ack(struct gsm_subscriber_connection *conn)
Harald Welte59b04682009-06-10 05:40:52 +0800803{
804 DEBUGP(DMM, "-> CM SERVICE ACK\n");
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +0800805 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_CM_SERV_ACC);
Harald Welte59b04682009-06-10 05:40:52 +0800806}
807
808/* 9.2.6 CM service reject */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100809static int gsm48_tx_mm_serv_rej(struct gsm_subscriber_connection *conn,
Harald Welte59b04682009-06-10 05:40:52 +0800810 enum gsm48_reject_value value)
811{
Holger Hans Peter Freythera44eea52010-06-15 19:39:27 +0800812 struct msgb *msg;
Harald Welte59b04682009-06-10 05:40:52 +0800813
Holger Hans Peter Freythera44eea52010-06-15 19:39:27 +0800814 msg = gsm48_create_mm_serv_rej(value);
815 if (!msg) {
816 LOGP(DMM, LOGL_ERROR, "Failed to allocate CM Service Reject.\n");
817 return -1;
818 }
Harald Welte59b04682009-06-10 05:40:52 +0800819
Holger Hans Peter Freythera44eea52010-06-15 19:39:27 +0800820 DEBUGP(DMM, "-> CM SERVICE Reject cause: %d\n", value);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +0100821 msg->lchan = conn->lchan;
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +0800822 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800823}
824
Sylvain Munautbadc7112009-12-24 00:28:46 +0100825static int _gsm48_rx_mm_serv_req_sec_cb(
826 unsigned int hooknum, unsigned int event,
827 struct msgb *msg, void *data, void *param)
828{
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800829 struct gsm_subscriber_connection *conn = data;
Sylvain Munautbadc7112009-12-24 00:28:46 +0100830 int rc = 0;
831
832 switch (event) {
833 case GSM_SECURITY_AUTH_FAILED:
834 /* Nothing to do */
835 break;
836
837 case GSM_SECURITY_NOAVAIL:
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +0800838 rc = gsm48_tx_mm_serv_ack(conn);
Sylvain Munautbadc7112009-12-24 00:28:46 +0100839 break;
840
841 case GSM_SECURITY_SUCCEEDED:
842 /* nothing to do. CIPHER MODE COMMAND is
843 * implicit CM SERV ACK */
844 break;
845
846 default:
847 rc = -EINVAL;
848 };
849
850 return rc;
851}
852
Harald Welte59b04682009-06-10 05:40:52 +0800853/*
854 * Handle CM Service Requests
855 * a) Verify that the packet is long enough to contain the information
856 * we require otherwsie reject with INCORRECT_MESSAGE
857 * b) Try to parse the TMSI. If we do not have one reject
858 * c) Check that we know the subscriber with the TMSI otherwise reject
859 * with a HLR cause
860 * d) Set the subscriber on the gsm_lchan and accept
861 */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800862static int gsm48_rx_mm_serv_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +0800863{
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200864 uint8_t mi_type;
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200865 char mi_string[GSM48_MI_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800866
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800867 struct gsm_bts *bts = conn->bts;
Harald Welte59b04682009-06-10 05:40:52 +0800868 struct gsm_subscriber *subscr;
869 struct gsm48_hdr *gh = msgb_l3(msg);
870 struct gsm48_service_request *req =
871 (struct gsm48_service_request *)gh->data;
Holger Hans Peter Freyther05708322010-05-14 08:02:08 +0800872 /* unfortunately in Phase1 the classmark2 length is variable */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200873 uint8_t classmark2_len = gh->data[1];
874 uint8_t *classmark2 = gh->data+2;
875 uint8_t mi_len = *(classmark2 + classmark2_len);
876 uint8_t *mi = (classmark2 + classmark2_len + 1);
Harald Welte59b04682009-06-10 05:40:52 +0800877
878 DEBUGP(DMM, "<- CM SERVICE REQUEST ");
879 if (msg->data_len < sizeof(struct gsm48_service_request*)) {
880 DEBUGPC(DMM, "wrong sized message\n");
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800881 return gsm48_tx_mm_serv_rej(conn,
Harald Welte59b04682009-06-10 05:40:52 +0800882 GSM48_REJECT_INCORRECT_MESSAGE);
883 }
884
885 if (msg->data_len < req->mi_len + 6) {
886 DEBUGPC(DMM, "does not fit in packet\n");
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800887 return gsm48_tx_mm_serv_rej(conn,
Harald Welte59b04682009-06-10 05:40:52 +0800888 GSM48_REJECT_INCORRECT_MESSAGE);
889 }
890
891 mi_type = mi[0] & GSM_MI_TYPE_MASK;
892 if (mi_type != GSM_MI_TYPE_TMSI) {
893 DEBUGPC(DMM, "mi_type is not TMSI: %d\n", mi_type);
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800894 return gsm48_tx_mm_serv_rej(conn,
Harald Welte59b04682009-06-10 05:40:52 +0800895 GSM48_REJECT_INCORRECT_MESSAGE);
896 }
897
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200898 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
Harald Welte59b04682009-06-10 05:40:52 +0800899 DEBUGPC(DMM, "serv_type=0x%02x mi_type=0x%02x M(%s)\n",
900 req->cm_service_type, mi_type, mi_string);
901
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +0200902 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, (classmark2 + classmark2_len));
Harald Welteedf48af2009-12-13 12:39:18 +0100903
Harald Welte583ceaf2009-08-10 10:12:45 +0200904 if (is_siemens_bts(bts))
905 send_siemens_mrpci(msg->lchan, classmark2-1);
906
Holger Hans Peter Freythercd8bacf2009-08-19 12:53:57 +0200907 subscr = subscr_get_by_tmsi(bts->network,
908 tmsi_from_string(mi_string));
Harald Welte59b04682009-06-10 05:40:52 +0800909
910 /* FIXME: if we don't know the TMSI, inquire abit IMSI and allocate new TMSI */
911 if (!subscr)
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800912 return gsm48_tx_mm_serv_rej(conn,
Harald Welte59b04682009-06-10 05:40:52 +0800913 GSM48_REJECT_IMSI_UNKNOWN_IN_HLR);
Holger Hans Peter Freytherfe036952013-01-01 17:18:27 +0100914 if (subscr->lac == GSM_LAC_RESERVED_DETACHED)
Sylvain Munautf1087412012-12-28 00:33:04 +0100915 /* If the subscriber is not attached, reject service */
916 return gsm48_tx_mm_serv_rej(conn,
917 GSM48_REJECT_IMSI_UNKNOWN_IN_VLR);
Harald Welte59b04682009-06-10 05:40:52 +0800918
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800919 if (!conn->subscr)
920 conn->subscr = subscr;
921 else if (conn->subscr == subscr)
Sylvain Munaut7b9852c2009-12-18 18:28:10 +0100922 subscr_put(subscr); /* lchan already has a ref, don't need another one */
923 else {
Harald Welte59b04682009-06-10 05:40:52 +0800924 DEBUGP(DMM, "<- CM Channel already owned by someone else?\n");
925 subscr_put(subscr);
926 }
927
Harald Weltef6845a72009-07-05 14:08:13 +0200928 subscr->equipment.classmark2_len = classmark2_len;
929 memcpy(subscr->equipment.classmark2, classmark2, classmark2_len);
930 db_sync_equipment(&subscr->equipment);
Harald Welte59b04682009-06-10 05:40:52 +0800931
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +0800932 return gsm48_secure_channel(conn, req->cipher_key_seq,
Sylvain Munautbadc7112009-12-24 00:28:46 +0100933 _gsm48_rx_mm_serv_req_sec_cb, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800934}
935
Holger Hans Peter Freythere9db44d2012-07-10 08:53:27 +0200936static int gsm48_rx_mm_imsi_detach_ind(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +0800937{
Holger Hans Peter Freythere9db44d2012-07-10 08:53:27 +0200938 struct gsm_bts *bts = conn->bts;
Harald Welte59b04682009-06-10 05:40:52 +0800939 struct gsm48_hdr *gh = msgb_l3(msg);
940 struct gsm48_imsi_detach_ind *idi =
941 (struct gsm48_imsi_detach_ind *) gh->data;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200942 uint8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200943 char mi_string[GSM48_MI_SIZE];
Harald Welte03740842009-06-10 23:11:52 +0800944 struct gsm_subscriber *subscr = NULL;
Harald Welte59b04682009-06-10 05:40:52 +0800945
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +0200946 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Daniel Willmann2be30fe2012-12-28 19:29:44 +0100947 DEBUGP(DMM, "IMSI DETACH INDICATION: mi_type=0x%02x MI(%s)",
Harald Welte59b04682009-06-10 05:40:52 +0800948 mi_type, mi_string);
949
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200950 osmo_counter_inc(bts->network->stats.loc_upd_type.detach);
Harald Welte3edc5a92009-12-22 00:41:05 +0100951
Harald Welte59b04682009-06-10 05:40:52 +0800952 switch (mi_type) {
953 case GSM_MI_TYPE_TMSI:
Daniel Willmann2be30fe2012-12-28 19:29:44 +0100954 DEBUGPC(DMM, "\n");
Holger Hans Peter Freythercd8bacf2009-08-19 12:53:57 +0200955 subscr = subscr_get_by_tmsi(bts->network,
956 tmsi_from_string(mi_string));
Harald Welte59b04682009-06-10 05:40:52 +0800957 break;
958 case GSM_MI_TYPE_IMSI:
Daniel Willmann2be30fe2012-12-28 19:29:44 +0100959 DEBUGPC(DMM, "\n");
Harald Welte75350412009-07-23 18:46:00 +0200960 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Welte59b04682009-06-10 05:40:52 +0800961 break;
962 case GSM_MI_TYPE_IMEI:
963 case GSM_MI_TYPE_IMEISV:
964 /* no sim card... FIXME: what to do ? */
Daniel Willmann2be30fe2012-12-28 19:29:44 +0100965 DEBUGPC(DMM, ": unimplemented mobile identity type\n");
Harald Welte59b04682009-06-10 05:40:52 +0800966 break;
967 default:
Daniel Willmann2be30fe2012-12-28 19:29:44 +0100968 DEBUGPC(DMM, ": unknown mobile identity type\n");
Harald Welte59b04682009-06-10 05:40:52 +0800969 break;
970 }
971
972 if (subscr) {
Holger Hans Peter Freythere9db44d2012-07-10 08:53:27 +0200973 subscr_update(subscr, bts,
Harald Welte59b04682009-06-10 05:40:52 +0800974 GSM_SUBSCRIBER_UPDATE_DETACHED);
Harald Welte0747c6a2009-12-24 14:50:24 +0100975 DEBUGP(DMM, "Subscriber: %s\n", subscr_name(subscr));
Harald Welte (local)ced09ed2009-08-17 09:39:55 +0200976
977 subscr->equipment.classmark1 = idi->classmark1;
978 db_sync_equipment(&subscr->equipment);
979
Harald Welte59b04682009-06-10 05:40:52 +0800980 subscr_put(subscr);
981 } else
982 DEBUGP(DMM, "Unknown Subscriber ?!?\n");
983
Harald Welte43250dd2009-12-20 09:58:40 +0100984 /* FIXME: iterate over all transactions and release them,
985 * imagine an IMSI DETACH happening during an active call! */
986
Holger Hans Peter Freythere9db44d2012-07-10 08:53:27 +0200987 release_anchor(conn);
Harald Welte59b04682009-06-10 05:40:52 +0800988 return 0;
989}
990
991static int gsm48_rx_mm_status(struct msgb *msg)
992{
993 struct gsm48_hdr *gh = msgb_l3(msg);
994
995 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
996
997 return 0;
998}
999
Sylvain Munaut28c47162009-12-24 00:27:26 +01001000/* Chapter 9.2.3: Authentication Response */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001001static int gsm48_rx_mm_auth_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Sylvain Munaut28c47162009-12-24 00:27:26 +01001002{
1003 struct gsm48_hdr *gh = msgb_l3(msg);
1004 struct gsm48_auth_resp *ar = (struct gsm48_auth_resp*) gh->data;
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +08001005 struct gsm_network *net = conn->bts->network;
Sylvain Munaut28c47162009-12-24 00:27:26 +01001006
Sylvain Munaut20d99c62010-06-10 23:51:41 +02001007 DEBUGP(DMM, "MM AUTHENTICATION RESPONSE (sres = %s): ",
Pablo Neira Ayusob1d5a692011-05-07 12:12:48 +02001008 osmo_hexdump(ar->sres, 4));
Sylvain Munaut28c47162009-12-24 00:27:26 +01001009
1010 /* Safety check */
1011 if (!conn->sec_operation) {
1012 DEBUGP(DMM, "No authentication/cipher operation in progress !!!\n");
1013 return -EIO;
1014 }
1015
1016 /* Validate SRES */
1017 if (memcmp(conn->sec_operation->atuple.sres, ar->sres,4)) {
Holger Hans Peter Freyther8f351572010-12-27 10:57:56 +01001018 int rc;
Sylvain Munaut28c47162009-12-24 00:27:26 +01001019 gsm_cbfn *cb = conn->sec_operation->cb;
Sylvain Munaut20d99c62010-06-10 23:51:41 +02001020
1021 DEBUGPC(DMM, "Invalid (expected %s)\n",
Pablo Neira Ayusob1d5a692011-05-07 12:12:48 +02001022 osmo_hexdump(conn->sec_operation->atuple.sres, 4));
Sylvain Munaut20d99c62010-06-10 23:51:41 +02001023
Sylvain Munaut28c47162009-12-24 00:27:26 +01001024 if (cb)
1025 cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
Holger Hans Peter Freyther9acd1b12010-06-16 12:47:59 +08001026 NULL, conn, conn->sec_operation->cb_data);
Sylvain Munaut28c47162009-12-24 00:27:26 +01001027
Holger Hans Peter Freyther8f351572010-12-27 10:57:56 +01001028 rc = gsm48_tx_mm_auth_rej(conn);
Sylvain Munaut28c47162009-12-24 00:27:26 +01001029 release_security_operation(conn);
Holger Hans Peter Freyther8f351572010-12-27 10:57:56 +01001030 return rc;
Sylvain Munaut28c47162009-12-24 00:27:26 +01001031 }
1032
Sylvain Munaut20d99c62010-06-10 23:51:41 +02001033 DEBUGPC(DMM, "OK\n");
1034
Sylvain Munaut28c47162009-12-24 00:27:26 +01001035 /* Start ciphering */
Sylvain Munaut469c28f2010-11-29 08:19:04 +01001036 return gsm0808_cipher_mode(conn, net->a5_encryption,
1037 conn->sec_operation->atuple.kc, 8, 0);
Sylvain Munaut28c47162009-12-24 00:27:26 +01001038}
1039
Harald Welte59b04682009-06-10 05:40:52 +08001040/* Receive a GSM 04.08 Mobility Management (MM) message */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001041static int gsm0408_rcv_mm(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001042{
1043 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte03740842009-06-10 23:11:52 +08001044 int rc = 0;
Harald Welte59b04682009-06-10 05:40:52 +08001045
1046 switch (gh->msg_type & 0xbf) {
1047 case GSM48_MT_MM_LOC_UPD_REQUEST:
Harald Welte79639662009-06-27 02:58:43 +02001048 DEBUGP(DMM, "LOCATION UPDATING REQUEST: ");
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001049 rc = mm_rx_loc_upd_req(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001050 break;
1051 case GSM48_MT_MM_ID_RESP:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001052 rc = mm_rx_id_resp(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001053 break;
1054 case GSM48_MT_MM_CM_SERV_REQ:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001055 rc = gsm48_rx_mm_serv_req(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001056 break;
1057 case GSM48_MT_MM_STATUS:
1058 rc = gsm48_rx_mm_status(msg);
1059 break;
1060 case GSM48_MT_MM_TMSI_REALL_COMPL:
1061 DEBUGP(DMM, "TMSI Reallocation Completed. Subscriber: %s\n",
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001062 conn->subscr ?
1063 subscr_name(conn->subscr) :
Harald Welte59b04682009-06-10 05:40:52 +08001064 "unknown subscriber");
Holger Hans Peter Freytherf08a1d72010-12-22 12:11:01 +01001065 release_loc_updating_req(conn);
Harald Welte59b04682009-06-10 05:40:52 +08001066 break;
1067 case GSM48_MT_MM_IMSI_DETACH_IND:
Holger Hans Peter Freythere9db44d2012-07-10 08:53:27 +02001068 rc = gsm48_rx_mm_imsi_detach_ind(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001069 break;
1070 case GSM48_MT_MM_CM_REEST_REQ:
1071 DEBUGP(DMM, "CM REESTABLISH REQUEST: Not implemented\n");
1072 break;
1073 case GSM48_MT_MM_AUTH_RESP:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001074 rc = gsm48_rx_mm_auth_resp(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001075 break;
1076 default:
Harald Welte60e5f4f2009-12-24 12:13:17 +01001077 LOGP(DMM, LOGL_NOTICE, "Unknown GSM 04.08 MM msg type 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001078 gh->msg_type);
1079 break;
1080 }
1081
1082 return rc;
1083}
1084
1085/* Receive a PAGING RESPONSE message from the MS */
Holger Hans Peter Freyther0b83e542010-06-21 10:46:44 +08001086static int gsm48_rx_rr_pag_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001087{
Holger Hans Peter Freyther0b83e542010-06-21 10:46:44 +08001088 struct gsm_bts *bts = conn->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001089 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freythera943b2a2010-05-16 01:51:14 +08001090 struct gsm48_pag_resp *resp;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001091 uint8_t *classmark2_lv = gh->data + 1;
1092 uint8_t mi_type;
Holger Hans Peter Freyther1e6ef9f2009-08-19 07:54:59 +02001093 char mi_string[GSM48_MI_SIZE];
Harald Welte03740842009-06-10 23:11:52 +08001094 struct gsm_subscriber *subscr = NULL;
Harald Welte59b04682009-06-10 05:40:52 +08001095 int rc = 0;
1096
Holger Hans Peter Freythera943b2a2010-05-16 01:51:14 +08001097 resp = (struct gsm48_pag_resp *) &gh->data[0];
1098 gsm48_paging_extract_mi(resp, msgb_l3len(msg) - sizeof(*gh),
1099 mi_string, &mi_type);
Harald Welte59b04682009-06-10 05:40:52 +08001100 DEBUGP(DRR, "PAGING RESPONSE: mi_type=0x%02x MI(%s)\n",
1101 mi_type, mi_string);
Harald Welte583ceaf2009-08-10 10:12:45 +02001102
Harald Welte59b04682009-06-10 05:40:52 +08001103 switch (mi_type) {
1104 case GSM_MI_TYPE_TMSI:
Holger Hans Peter Freythercd8bacf2009-08-19 12:53:57 +02001105 subscr = subscr_get_by_tmsi(bts->network,
1106 tmsi_from_string(mi_string));
Harald Welte59b04682009-06-10 05:40:52 +08001107 break;
1108 case GSM_MI_TYPE_IMSI:
Harald Welte75350412009-07-23 18:46:00 +02001109 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Welte59b04682009-06-10 05:40:52 +08001110 break;
1111 }
1112
1113 if (!subscr) {
1114 DEBUGP(DRR, "<- Can't find any subscriber for this ID\n");
1115 /* FIXME: request id? close channel? */
1116 return -EINVAL;
1117 }
1118 DEBUGP(DRR, "<- Channel was requested by %s\n",
Harald Welte68b7df22009-08-08 16:03:15 +02001119 subscr->name && strlen(subscr->name) ? subscr->name : subscr->imsi);
Harald Welte59b04682009-06-10 05:40:52 +08001120
Harald Weltef6845a72009-07-05 14:08:13 +02001121 subscr->equipment.classmark2_len = *classmark2_lv;
1122 memcpy(subscr->equipment.classmark2, classmark2_lv+1, *classmark2_lv);
1123 db_sync_equipment(&subscr->equipment);
Harald Welte59b04682009-06-10 05:40:52 +08001124
Holger Hans Peter Freyther0b83e542010-06-21 10:46:44 +08001125 rc = gsm48_handle_paging_resp(conn, msg, subscr);
Harald Welte59b04682009-06-10 05:40:52 +08001126 return rc;
1127}
1128
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001129static int gsm48_rx_rr_app_info(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte (local)b5103922009-08-15 23:32:44 +02001130{
1131 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001132 uint8_t apdu_id_flags;
1133 uint8_t apdu_len;
1134 uint8_t *apdu_data;
Harald Welte (local)b5103922009-08-15 23:32:44 +02001135
1136 apdu_id_flags = gh->data[0];
1137 apdu_len = gh->data[1];
1138 apdu_data = gh->data+2;
1139
Harald Welted4f21662012-07-16 13:22:19 +02001140 DEBUGP(DRR, "RX APPLICATION INFO id/flags=0x%02x apdu_len=%u apdu=%s",
Pablo Neira Ayusob1d5a692011-05-07 12:12:48 +02001141 apdu_id_flags, apdu_len, osmo_hexdump(apdu_data, apdu_len));
Harald Welte (local)b5103922009-08-15 23:32:44 +02001142
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001143 return db_apdu_blob_store(conn->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte (local)b5103922009-08-15 23:32:44 +02001144}
1145
Harald Welte59b04682009-06-10 05:40:52 +08001146/* Receive a GSM 04.08 Radio Resource (RR) message */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001147static int gsm0408_rcv_rr(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001148{
1149 struct gsm48_hdr *gh = msgb_l3(msg);
1150 int rc = 0;
1151
1152 switch (gh->msg_type) {
Harald Welte59b04682009-06-10 05:40:52 +08001153 case GSM48_MT_RR_PAG_RESP:
Holger Hans Peter Freyther0b83e542010-06-21 10:46:44 +08001154 rc = gsm48_rx_rr_pag_resp(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08001155 break;
Harald Welte (local)b5103922009-08-15 23:32:44 +02001156 case GSM48_MT_RR_APP_INFO:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08001157 rc = gsm48_rx_rr_app_info(conn, msg);
Harald Welte (local)b5103922009-08-15 23:32:44 +02001158 break;
Harald Welte59b04682009-06-10 05:40:52 +08001159 default:
Harald Weltefe01ed72012-01-23 16:40:24 +01001160 LOGP(DRR, LOGL_NOTICE, "MSC: Unimplemented "
Harald Welte60e5f4f2009-12-24 12:13:17 +01001161 "GSM 04.08 RR msg type 0x%02x\n", gh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001162 break;
1163 }
1164
1165 return rc;
1166}
1167
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001168int gsm48_send_rr_app_info(struct gsm_subscriber_connection *conn, uint8_t apdu_id,
1169 uint8_t apdu_len, const uint8_t *apdu)
Harald Welte (local)b5103922009-08-15 23:32:44 +02001170{
1171 struct msgb *msg = gsm48_msgb_alloc();
1172 struct gsm48_hdr *gh;
1173
Holger Hans Peter Freyther92f1b2d2010-06-16 13:52:55 +08001174 msg->lchan = conn->lchan;
Harald Welte (local)b5103922009-08-15 23:32:44 +02001175
1176 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1177 apdu_id, apdu_len);
1178
1179 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1180 gh->proto_discr = GSM48_PDISC_RR;
1181 gh->msg_type = GSM48_MT_RR_APP_INFO;
1182 gh->data[0] = apdu_id;
1183 gh->data[1] = apdu_len;
1184 memcpy(gh->data+2, apdu, apdu_len);
1185
Holger Hans Peter Freyther92f1b2d2010-06-16 13:52:55 +08001186 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte (local)b5103922009-08-15 23:32:44 +02001187}
1188
Harald Welte59b04682009-06-10 05:40:52 +08001189/* Call Control */
1190
1191/* The entire call control code is written in accordance with Figure 7.10c
1192 * for 'very early assignment', i.e. we allocate a TCH/F during IMMEDIATE
1193 * ASSIGN, then first use that TCH/F for signalling and later MODE MODIFY
1194 * it for voice */
1195
Harald Welte03740842009-06-10 23:11:52 +08001196static void new_cc_state(struct gsm_trans *trans, int state)
1197{
1198 if (state > 31 || state < 0)
1199 return;
1200
1201 DEBUGP(DCC, "new state %s -> %s\n",
Harald Welteb30935e2010-03-25 12:13:02 +08001202 gsm48_cc_state_name(trans->cc.state),
1203 gsm48_cc_state_name(state));
Harald Welte03740842009-06-10 23:11:52 +08001204
Harald Weltec2189a62009-07-23 18:56:43 +02001205 trans->cc.state = state;
Harald Welte03740842009-06-10 23:11:52 +08001206}
1207
1208static int gsm48_cc_tx_status(struct gsm_trans *trans, void *arg)
Harald Welte59b04682009-06-10 05:40:52 +08001209{
1210 struct msgb *msg = gsm48_msgb_alloc();
1211 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001212 uint8_t *cause, *call_state;
Harald Welte59b04682009-06-10 05:40:52 +08001213
Harald Welte59b04682009-06-10 05:40:52 +08001214 gh->msg_type = GSM48_MT_CC_STATUS;
1215
1216 cause = msgb_put(msg, 3);
1217 cause[0] = 2;
1218 cause[1] = GSM48_CAUSE_CS_GSM | GSM48_CAUSE_LOC_USER;
1219 cause[2] = 0x80 | 30; /* response to status inquiry */
1220
1221 call_state = msgb_put(msg, 1);
1222 call_state[0] = 0xc0 | 0x00;
1223
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08001224 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte59b04682009-06-10 05:40:52 +08001225}
1226
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +08001227static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001228 uint8_t pdisc, uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +08001229{
1230 struct msgb *msg = gsm48_msgb_alloc();
1231 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1232
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +08001233 msg->lchan = conn->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001234
1235 gh->proto_discr = pdisc;
1236 gh->msg_type = msg_type;
1237
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +08001238 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte59b04682009-06-10 05:40:52 +08001239}
1240
Harald Welte03740842009-06-10 23:11:52 +08001241static void gsm48_stop_cc_timer(struct gsm_trans *trans)
1242{
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001243 if (osmo_timer_pending(&trans->cc.timer)) {
Harald Weltec2189a62009-07-23 18:56:43 +02001244 DEBUGP(DCC, "stopping pending timer T%x\n", trans->cc.Tcurrent);
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001245 osmo_timer_del(&trans->cc.timer);
Harald Weltec2189a62009-07-23 18:56:43 +02001246 trans->cc.Tcurrent = 0;
Harald Welte03740842009-06-10 23:11:52 +08001247 }
1248}
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001249
Harald Welte03740842009-06-10 23:11:52 +08001250static int mncc_recvmsg(struct gsm_network *net, struct gsm_trans *trans,
1251 int msg_type, struct gsm_mncc *mncc)
1252{
1253 struct msgb *msg;
Harald Welte17b56522010-12-22 21:45:05 +01001254 unsigned char *data;
Harald Welte03740842009-06-10 23:11:52 +08001255
1256 if (trans)
Harald Weltec51b1922010-12-26 19:06:37 +01001257 if (trans->conn && trans->conn->lchan)
Harald Welte4861c822009-07-23 21:21:14 +02001258 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte03740842009-06-10 23:11:52 +08001259 "Sending '%s' to MNCC.\n",
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001260 trans->conn->lchan->ts->trx->bts->nr,
1261 trans->conn->lchan->ts->trx->nr,
1262 trans->conn->lchan->ts->nr, trans->transaction_id,
Harald Welte03740842009-06-10 23:11:52 +08001263 (trans->subscr)?(trans->subscr->extension):"-",
1264 get_mncc_name(msg_type));
1265 else
1266 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
1267 "Sending '%s' to MNCC.\n",
1268 (trans->subscr)?(trans->subscr->extension):"-",
1269 get_mncc_name(msg_type));
1270 else
1271 DEBUGP(DCC, "(bts - trx - ts - ti -- sub -) "
1272 "Sending '%s' to MNCC.\n", get_mncc_name(msg_type));
1273
1274 mncc->msg_type = msg_type;
1275
Harald Welte9cfc9352009-06-26 19:39:35 +02001276 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
Harald Welte03740842009-06-10 23:11:52 +08001277 if (!msg)
1278 return -ENOMEM;
Harald Welte17b56522010-12-22 21:45:05 +01001279
1280 data = msgb_put(msg, sizeof(struct gsm_mncc));
1281 memcpy(data, mncc, sizeof(struct gsm_mncc));
1282
Harald Weltebe0cb682010-12-22 23:43:29 +01001283 cc_tx_to_mncc(net, msg);
Harald Welte03740842009-06-10 23:11:52 +08001284
1285 return 0;
1286}
1287
1288int mncc_release_ind(struct gsm_network *net, struct gsm_trans *trans,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001289 uint32_t callref, int location, int value)
Harald Welte03740842009-06-10 23:11:52 +08001290{
1291 struct gsm_mncc rel;
1292
Harald Weltecb0595f2009-06-12 01:54:08 +08001293 memset(&rel, 0, sizeof(rel));
Harald Welte03740842009-06-10 23:11:52 +08001294 rel.callref = callref;
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08001295 mncc_set_cause(&rel, location, value);
Andreas Eversberg59e79ee2013-01-25 08:38:29 +01001296 if (trans && trans->cc.state == GSM_CSTATE_RELEASE_REQ)
1297 return mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
Harald Welte03740842009-06-10 23:11:52 +08001298 return mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
1299}
1300
Harald Weltec2189a62009-07-23 18:56:43 +02001301/* Call Control Specific transaction release.
1302 * gets called by trans_free, DO NOT CALL YOURSELF! */
1303void _gsm48_cc_trans_free(struct gsm_trans *trans)
Harald Welte03740842009-06-10 23:11:52 +08001304{
Harald Welte03740842009-06-10 23:11:52 +08001305 gsm48_stop_cc_timer(trans);
1306
1307 /* send release to L4, if callref still exists */
1308 if (trans->callref) {
1309 /* Ressource unavailable */
Harald Welte0abe5a62009-07-23 19:06:52 +02001310 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08001311 GSM48_CAUSE_LOC_PRN_S_LU,
1312 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte03740842009-06-10 23:11:52 +08001313 }
Harald Weltec2189a62009-07-23 18:56:43 +02001314 if (trans->cc.state != GSM_CSTATE_NULL)
Harald Welte03740842009-06-10 23:11:52 +08001315 new_cc_state(trans, GSM_CSTATE_NULL);
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001316 if (trans->conn)
1317 trau_mux_unmap(&trans->conn->lchan->ts->e1_link, trans->callref);
Harald Welte03740842009-06-10 23:11:52 +08001318}
1319
1320static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001321
Harald Welte59b04682009-06-10 05:40:52 +08001322/* call-back from paging the B-end of the connection */
1323static int setup_trig_pag_evt(unsigned int hooknum, unsigned int event,
Holger Hans Peter Freytherd3aaf662010-06-17 15:05:57 +08001324 struct msgb *msg, void *_conn, void *param)
Harald Welte59b04682009-06-10 05:40:52 +08001325{
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001326 int found = 0;
Holger Hans Peter Freytherd3aaf662010-06-17 15:05:57 +08001327 struct gsm_subscriber_connection *conn = _conn;
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001328 struct gsm_network **paging_request = param, *net;
Harald Welte03740842009-06-10 23:11:52 +08001329 struct gsm_trans *transt, *tmp;
Harald Welte1ff81b52009-06-26 20:17:06 +02001330
Harald Welte59b04682009-06-10 05:40:52 +08001331 if (hooknum != GSM_HOOK_RR_PAGING)
1332 return -EINVAL;
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001333
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001334 net = *paging_request;
Harald Welte03740842009-06-10 23:11:52 +08001335 if (!net) {
1336 DEBUGP(DCC, "Error Network not set!\n");
1337 return -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08001338 }
1339
Harald Welte03740842009-06-10 23:11:52 +08001340 /* check all tranactions (without lchan) for subscriber */
1341 llist_for_each_entry_safe(transt, tmp, &net->trans_list, entry) {
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001342 if (transt->paging_request != paging_request || transt->conn)
Harald Welte03740842009-06-10 23:11:52 +08001343 continue;
1344 switch (event) {
1345 case GSM_PAGING_SUCCEEDED:
Holger Hans Peter Freytherd3aaf662010-06-17 15:05:57 +08001346 if (!conn) // paranoid
Harald Welte03740842009-06-10 23:11:52 +08001347 break;
1348 DEBUGP(DCC, "Paging subscr %s succeeded!\n",
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001349 transt->subscr->extension);
1350 found = 1;
Harald Welte03740842009-06-10 23:11:52 +08001351 /* Assign lchan */
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001352 if (!transt->conn) {
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001353 transt->paging_request = NULL;
Holger Hans Peter Freytherd3aaf662010-06-17 15:05:57 +08001354 transt->conn = conn;
Holger Hans Peter Freytherfb68bf32010-12-29 16:28:33 +01001355 conn->put_channel = 1;
Harald Welte03740842009-06-10 23:11:52 +08001356 }
1357 /* send SETUP request to called party */
Harald Weltec2189a62009-07-23 18:56:43 +02001358 gsm48_cc_tx_setup(transt, &transt->cc.msg);
Harald Welte03740842009-06-10 23:11:52 +08001359 break;
1360 case GSM_PAGING_EXPIRED:
Holger Hans Peter Freytherab2a9332010-12-23 18:19:17 +01001361 case GSM_PAGING_BUSY:
Harald Welte03740842009-06-10 23:11:52 +08001362 DEBUGP(DCC, "Paging subscr %s expired!\n",
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001363 transt->subscr->extension);
Harald Welte03740842009-06-10 23:11:52 +08001364 /* Temporarily out of order */
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001365 found = 1;
Harald Welte0abe5a62009-07-23 19:06:52 +02001366 mncc_release_ind(transt->subscr->net, transt,
1367 transt->callref,
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08001368 GSM48_CAUSE_LOC_PRN_S_LU,
1369 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte03740842009-06-10 23:11:52 +08001370 transt->callref = 0;
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001371 transt->paging_request = NULL;
Harald Weltec2189a62009-07-23 18:56:43 +02001372 trans_free(transt);
Harald Welte03740842009-06-10 23:11:52 +08001373 break;
1374 }
1375 }
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01001376
1377 talloc_free(paging_request);
1378
1379 /*
1380 * FIXME: The queue needs to be kicked. This is likely to go through a RF
1381 * failure and then the subscr will be poke again. This needs a lot of fixing
1382 * in the subscriber queue code.
1383 */
1384 if (!found && conn)
1385 conn->put_channel = 1;
Harald Welte59b04682009-06-10 05:40:52 +08001386 return 0;
1387}
1388
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001389static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable);
Harald Welte3971ad52009-12-19 22:23:05 +01001390
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001391/* handle audio path for handover */
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001392static int switch_for_handover(struct gsm_lchan *old_lchan,
1393 struct gsm_lchan *new_lchan)
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001394{
1395 struct rtp_socket *old_rs, *new_rs, *other_rs;
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001396
1397 if (ipacc_rtp_direct) {
1398 LOGP(DHO, LOGL_ERROR, "unable to handover in direct RTP mode\n");
1399 return 0;
1400 }
1401
1402 /* RTP Proxy mode */
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001403 new_rs = new_lchan->abis_ip.rtp_socket;
1404 old_rs = old_lchan->abis_ip.rtp_socket;
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001405
1406 if (!new_rs) {
1407 LOGP(DHO, LOGL_ERROR, "no RTP socket for new_lchan\n");
1408 return -EIO;
1409 }
1410
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001411 rsl_ipacc_mdcx_to_rtpsock(new_lchan);
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001412
1413 if (!old_rs) {
1414 LOGP(DHO, LOGL_ERROR, "no RTP socket for old_lchan\n");
1415 return -EIO;
1416 }
1417
1418 /* copy rx_action and reference to other sock */
1419 new_rs->rx_action = old_rs->rx_action;
1420 new_rs->tx_action = old_rs->tx_action;
1421 new_rs->transmit = old_rs->transmit;
1422
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001423 switch (old_lchan->abis_ip.rtp_socket->rx_action) {
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001424 case RTP_PROXY:
1425 other_rs = old_rs->proxy.other_sock;
1426 rtp_socket_proxy(new_rs, other_rs);
1427 /* delete reference to other end socket to prevent
1428 * rtp_socket_free() from removing the inverse reference */
1429 old_rs->proxy.other_sock = NULL;
1430 break;
1431 case RTP_RECV_UPSTREAM:
1432 new_rs->receive = old_rs->receive;
1433 break;
1434 case RTP_NONE:
1435 break;
1436 }
1437
1438 return 0;
1439}
1440
Harald Welte3c062072009-07-28 18:25:29 +02001441/* some other part of the code sends us a signal */
1442static int handle_abisip_signal(unsigned int subsys, unsigned int signal,
1443 void *handler_data, void *signal_data)
1444{
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001445 struct gsm_lchan *lchan = signal_data, *old_lchan;
Harald Welte3c062072009-07-28 18:25:29 +02001446 int rc;
Harald Welte3971ad52009-12-19 22:23:05 +01001447 struct gsm_network *net;
1448 struct gsm_trans *trans;
Harald Welte3c062072009-07-28 18:25:29 +02001449
1450 if (subsys != SS_ABISIP)
1451 return 0;
1452
1453 /* in case we use direct BTS-to-BTS RTP */
1454 if (ipacc_rtp_direct)
1455 return 0;
1456
Harald Welte3c062072009-07-28 18:25:29 +02001457 switch (signal) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001458 case S_ABISIP_CRCX_ACK:
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001459 /* in case we don't use direct BTS-to-BTS RTP */
1460 /* the BTS has successfully bound a TCH to a local ip/port,
1461 * which means we can connect our UDP socket to it */
1462 if (lchan->abis_ip.rtp_socket) {
1463 rtp_socket_free(lchan->abis_ip.rtp_socket);
1464 lchan->abis_ip.rtp_socket = NULL;
1465 }
1466
1467 lchan->abis_ip.rtp_socket = rtp_socket_create();
1468 if (!lchan->abis_ip.rtp_socket)
1469 return -EIO;
1470
1471 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1472 lchan->abis_ip.bound_ip,
1473 lchan->abis_ip.bound_port);
1474 if (rc < 0)
1475 return -EIO;
1476
Harald Welte3971ad52009-12-19 22:23:05 +01001477 /* check if any transactions on this lchan still have
1478 * a tch_recv_mncc request pending */
1479 net = lchan->ts->trx->bts->network;
1480 llist_for_each_entry(trans, &net->trans_list, entry) {
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001481 if (trans->conn && trans->conn->lchan == lchan && trans->tch_recv) {
Harald Welte3971ad52009-12-19 22:23:05 +01001482 DEBUGP(DCC, "pending tch_recv_mncc request\n");
1483 tch_recv_mncc(net, trans->callref, 1);
1484 }
1485 }
Holger Hans Peter Freytherc3649d22012-12-26 10:17:42 +01001486
1487 /*
1488 * TODO: this appears to be too early? Why not until after
1489 * the handover detect or the handover complete?
1490 *
1491 * Do we have a handover pending for this new lchan? In that
1492 * case re-route the audio from the old channel to the new one.
1493 */
1494 old_lchan = bsc_handover_pending(lchan);
1495 if (old_lchan)
1496 switch_for_handover(old_lchan, lchan);
Harald Welte3c062072009-07-28 18:25:29 +02001497 break;
Holger Hans Peter Freyther02fca862011-01-06 13:31:41 +01001498 case S_ABISIP_DLCX_IND:
1499 /* the BTS tells us a RTP stream has been disconnected */
1500 if (lchan->abis_ip.rtp_socket) {
1501 rtp_socket_free(lchan->abis_ip.rtp_socket);
1502 lchan->abis_ip.rtp_socket = NULL;
1503 }
1504
1505 break;
Harald Welte3c062072009-07-28 18:25:29 +02001506 }
1507
1508 return 0;
Harald Welte3c062072009-07-28 18:25:29 +02001509}
1510
Harald Welte59b04682009-06-10 05:40:52 +08001511/* map two ipaccess RTP streams onto each other */
1512static int tch_map(struct gsm_lchan *lchan, struct gsm_lchan *remote_lchan)
1513{
1514 struct gsm_bts *bts = lchan->ts->trx->bts;
1515 struct gsm_bts *remote_bts = remote_lchan->ts->trx->bts;
Harald Welte3c062072009-07-28 18:25:29 +02001516 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001517
1518 DEBUGP(DCC, "Setting up TCH map between (bts=%u,trx=%u,ts=%u) and (bts=%u,trx=%u,ts=%u)\n",
1519 bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
1520 remote_bts->nr, remote_lchan->ts->trx->nr, remote_lchan->ts->nr);
1521
1522 if (bts->type != remote_bts->type) {
Harald Welte8099a712011-08-09 21:53:20 +02001523 LOGP(DCC, LOGL_ERROR, "Cannot switch calls between different BTS types yet\n");
Harald Welte59b04682009-06-10 05:40:52 +08001524 return -EINVAL;
1525 }
Harald Welte3971ad52009-12-19 22:23:05 +01001526
1527 // todo: map between different bts types
Harald Welte59b04682009-06-10 05:40:52 +08001528 switch (bts->type) {
Mike Haben66e0ba02009-10-02 12:19:34 +01001529 case GSM_BTS_TYPE_NANOBTS:
Harald Welte35ac0e42012-07-02 19:51:55 +02001530 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte3c062072009-07-28 18:25:29 +02001531 if (!ipacc_rtp_direct) {
1532 /* connect the TCH's to our RTP proxy */
Harald Welte9947d9f2009-12-20 16:51:09 +01001533 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welte3c062072009-07-28 18:25:29 +02001534 if (rc < 0)
1535 return rc;
Harald Welte9947d9f2009-12-20 16:51:09 +01001536 rc = rsl_ipacc_mdcx_to_rtpsock(remote_lchan);
Harald Welte30f93fb2011-02-19 16:48:17 +01001537 if (rc < 0)
1538 return rc;
Harald Welte3c062072009-07-28 18:25:29 +02001539 /* connect them with each other */
Harald Welte87504212009-12-02 01:56:49 +05301540 rtp_socket_proxy(lchan->abis_ip.rtp_socket,
1541 remote_lchan->abis_ip.rtp_socket);
Harald Welte3c062072009-07-28 18:25:29 +02001542 } else {
1543 /* directly connect TCH RTP streams to each other */
Harald Welte87504212009-12-02 01:56:49 +05301544 rc = rsl_ipacc_mdcx(lchan, remote_lchan->abis_ip.bound_ip,
1545 remote_lchan->abis_ip.bound_port,
Harald Welte87504212009-12-02 01:56:49 +05301546 remote_lchan->abis_ip.rtp_payload2);
Harald Welte3c062072009-07-28 18:25:29 +02001547 if (rc < 0)
1548 return rc;
Harald Welte87504212009-12-02 01:56:49 +05301549 rc = rsl_ipacc_mdcx(remote_lchan, lchan->abis_ip.bound_ip,
1550 lchan->abis_ip.bound_port,
Harald Welte87504212009-12-02 01:56:49 +05301551 lchan->abis_ip.rtp_payload2);
Harald Welte3c062072009-07-28 18:25:29 +02001552 }
Harald Welte59b04682009-06-10 05:40:52 +08001553 break;
1554 case GSM_BTS_TYPE_BS11:
Harald Weltef39e3b52011-03-20 06:27:31 -03001555 case GSM_BTS_TYPE_RBS2000:
Dieter Spaar49c843e2011-07-28 00:01:50 +02001556 case GSM_BTS_TYPE_NOKIA_SITE:
Harald Welte59b04682009-06-10 05:40:52 +08001557 trau_mux_map_lchan(lchan, remote_lchan);
1558 break;
1559 default:
Harald Welte8099a712011-08-09 21:53:20 +02001560 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welte3971ad52009-12-19 22:23:05 +01001561 return -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08001562 }
1563
1564 return 0;
1565}
1566
Harald Welte03740842009-06-10 23:11:52 +08001567/* bridge channels of two transactions */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001568static int tch_bridge(struct gsm_network *net, uint32_t *refs)
Harald Welte59b04682009-06-10 05:40:52 +08001569{
Harald Weltec2189a62009-07-23 18:56:43 +02001570 struct gsm_trans *trans1 = trans_find_by_callref(net, refs[0]);
1571 struct gsm_trans *trans2 = trans_find_by_callref(net, refs[1]);
Harald Welte59b04682009-06-10 05:40:52 +08001572
Harald Welte03740842009-06-10 23:11:52 +08001573 if (!trans1 || !trans2)
Harald Welte59b04682009-06-10 05:40:52 +08001574 return -EIO;
1575
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001576 if (!trans1->conn || !trans2->conn)
Harald Welte03740842009-06-10 23:11:52 +08001577 return -EIO;
1578
1579 /* through-connect channel */
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001580 return tch_map(trans1->conn->lchan, trans2->conn->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001581}
1582
Harald Welte3971ad52009-12-19 22:23:05 +01001583/* enable receive of channels to MNCC upqueue */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001584static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable)
Harald Welte03740842009-06-10 23:11:52 +08001585{
1586 struct gsm_trans *trans;
Harald Welte3971ad52009-12-19 22:23:05 +01001587 struct gsm_lchan *lchan;
1588 struct gsm_bts *bts;
1589 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001590
Harald Welte03740842009-06-10 23:11:52 +08001591 /* Find callref */
Harald Welte3971ad52009-12-19 22:23:05 +01001592 trans = trans_find_by_callref(net, callref);
Harald Welte03740842009-06-10 23:11:52 +08001593 if (!trans)
1594 return -EIO;
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001595 if (!trans->conn)
Harald Welte03740842009-06-10 23:11:52 +08001596 return 0;
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01001597 lchan = trans->conn->lchan;
Harald Welte3971ad52009-12-19 22:23:05 +01001598 bts = lchan->ts->trx->bts;
Harald Welte03740842009-06-10 23:11:52 +08001599
Harald Welte3971ad52009-12-19 22:23:05 +01001600 switch (bts->type) {
1601 case GSM_BTS_TYPE_NANOBTS:
Harald Welte35ac0e42012-07-02 19:51:55 +02001602 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte3971ad52009-12-19 22:23:05 +01001603 if (ipacc_rtp_direct) {
Harald Welte8099a712011-08-09 21:53:20 +02001604 LOGP(DCC, LOGL_ERROR, "Error: RTP proxy is disabled\n");
Harald Welte3971ad52009-12-19 22:23:05 +01001605 return -EINVAL;
1606 }
1607 /* in case, we don't have a RTP socket yet, we note this
1608 * in the transaction and try later */
1609 if (!lchan->abis_ip.rtp_socket) {
1610 trans->tch_recv = enable;
1611 DEBUGP(DCC, "queue tch_recv_mncc request (%d)\n", enable);
1612 return 0;
1613 }
1614 if (enable) {
1615 /* connect the TCH's to our RTP proxy */
Harald Welte9947d9f2009-12-20 16:51:09 +01001616 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welte3971ad52009-12-19 22:23:05 +01001617 if (rc < 0)
1618 return rc;
1619 /* assign socket to application interface */
1620 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1621 net, callref);
1622 } else
1623 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1624 net, 0);
1625 break;
1626 case GSM_BTS_TYPE_BS11:
Harald Weltef39e3b52011-03-20 06:27:31 -03001627 case GSM_BTS_TYPE_RBS2000:
Harald Weltec0cf0022011-08-05 20:11:18 +02001628 case GSM_BTS_TYPE_NOKIA_SITE:
Harald Welte3971ad52009-12-19 22:23:05 +01001629 if (enable)
1630 return trau_recv_lchan(lchan, callref);
1631 return trau_mux_unmap(NULL, callref);
1632 break;
1633 default:
Harald Welte8099a712011-08-09 21:53:20 +02001634 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welte3971ad52009-12-19 22:23:05 +01001635 return -EINVAL;
1636 }
1637
1638 return 0;
Harald Welte03740842009-06-10 23:11:52 +08001639}
1640
Harald Welte03740842009-06-10 23:11:52 +08001641static int gsm48_cc_rx_status_enq(struct gsm_trans *trans, struct msgb *msg)
1642{
1643 DEBUGP(DCC, "-> STATUS ENQ\n");
1644 return gsm48_cc_tx_status(trans, msg);
1645}
1646
1647static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg);
1648static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg);
1649
1650static void gsm48_cc_timeout(void *arg)
1651{
1652 struct gsm_trans *trans = arg;
1653 int disconnect = 0, release = 0;
Harald Weltebbc636a2009-06-11 14:23:20 +08001654 int mo_cause = GSM48_CC_CAUSE_RECOVERY_TIMER;
1655 int mo_location = GSM48_CAUSE_LOC_USER;
1656 int l4_cause = GSM48_CC_CAUSE_NORMAL_UNSPEC;
1657 int l4_location = GSM48_CAUSE_LOC_PRN_S_LU;
Harald Welte03740842009-06-10 23:11:52 +08001658 struct gsm_mncc mo_rel, l4_rel;
1659
1660 memset(&mo_rel, 0, sizeof(struct gsm_mncc));
1661 mo_rel.callref = trans->callref;
1662 memset(&l4_rel, 0, sizeof(struct gsm_mncc));
1663 l4_rel.callref = trans->callref;
1664
Harald Weltec2189a62009-07-23 18:56:43 +02001665 switch(trans->cc.Tcurrent) {
Harald Welte03740842009-06-10 23:11:52 +08001666 case 0x303:
1667 release = 1;
Harald Weltebbc636a2009-06-11 14:23:20 +08001668 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte03740842009-06-10 23:11:52 +08001669 break;
1670 case 0x310:
1671 disconnect = 1;
Harald Weltebbc636a2009-06-11 14:23:20 +08001672 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte03740842009-06-10 23:11:52 +08001673 break;
1674 case 0x313:
1675 disconnect = 1;
1676 /* unknown, did not find it in the specs */
1677 break;
1678 case 0x301:
1679 disconnect = 1;
Harald Weltebbc636a2009-06-11 14:23:20 +08001680 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte03740842009-06-10 23:11:52 +08001681 break;
1682 case 0x308:
Harald Weltec2189a62009-07-23 18:56:43 +02001683 if (!trans->cc.T308_second) {
Harald Welte03740842009-06-10 23:11:52 +08001684 /* restart T308 a second time */
Harald Weltec2189a62009-07-23 18:56:43 +02001685 gsm48_cc_tx_release(trans, &trans->cc.msg);
1686 trans->cc.T308_second = 1;
Harald Welte03740842009-06-10 23:11:52 +08001687 break; /* stay in release state */
1688 }
Harald Weltec2189a62009-07-23 18:56:43 +02001689 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08001690 return;
1691// release = 1;
1692// l4_cause = 14;
1693// break;
1694 case 0x306:
1695 release = 1;
Harald Weltec2189a62009-07-23 18:56:43 +02001696 mo_cause = trans->cc.msg.cause.value;
1697 mo_location = trans->cc.msg.cause.location;
Harald Welte03740842009-06-10 23:11:52 +08001698 break;
1699 case 0x323:
1700 disconnect = 1;
1701 break;
1702 default:
1703 release = 1;
1704 }
1705
1706 if (release && trans->callref) {
1707 /* process release towards layer 4 */
Harald Welte0abe5a62009-07-23 19:06:52 +02001708 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Harald Welte03740842009-06-10 23:11:52 +08001709 l4_location, l4_cause);
1710 trans->callref = 0;
1711 }
1712
1713 if (disconnect && trans->callref) {
1714 /* process disconnect towards layer 4 */
1715 mncc_set_cause(&l4_rel, l4_location, l4_cause);
Harald Welte0abe5a62009-07-23 19:06:52 +02001716 mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &l4_rel);
Harald Welte03740842009-06-10 23:11:52 +08001717 }
1718
1719 /* process disconnect towards mobile station */
1720 if (disconnect || release) {
1721 mncc_set_cause(&mo_rel, mo_location, mo_cause);
Harald Weltec2189a62009-07-23 18:56:43 +02001722 mo_rel.cause.diag[0] = ((trans->cc.Tcurrent & 0xf00) >> 8) + '0';
1723 mo_rel.cause.diag[1] = ((trans->cc.Tcurrent & 0x0f0) >> 4) + '0';
1724 mo_rel.cause.diag[2] = (trans->cc.Tcurrent & 0x00f) + '0';
Harald Welte03740842009-06-10 23:11:52 +08001725 mo_rel.cause.diag_len = 3;
1726
1727 if (disconnect)
1728 gsm48_cc_tx_disconnect(trans, &mo_rel);
1729 if (release)
1730 gsm48_cc_tx_release(trans, &mo_rel);
1731 }
1732
1733}
1734
1735static void gsm48_start_cc_timer(struct gsm_trans *trans, int current,
1736 int sec, int micro)
1737{
1738 DEBUGP(DCC, "starting timer T%x with %d seconds\n", current, sec);
Harald Weltec2189a62009-07-23 18:56:43 +02001739 trans->cc.timer.cb = gsm48_cc_timeout;
1740 trans->cc.timer.data = trans;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001741 osmo_timer_schedule(&trans->cc.timer, sec, micro);
Harald Weltec2189a62009-07-23 18:56:43 +02001742 trans->cc.Tcurrent = current;
Harald Welte03740842009-06-10 23:11:52 +08001743}
1744
1745static int gsm48_cc_rx_setup(struct gsm_trans *trans, struct msgb *msg)
1746{
1747 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001748 uint8_t msg_type = gh->msg_type & 0xbf;
Harald Welte03740842009-06-10 23:11:52 +08001749 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1750 struct tlv_parsed tp;
1751 struct gsm_mncc setup;
1752
1753 memset(&setup, 0, sizeof(struct gsm_mncc));
1754 setup.callref = trans->callref;
Harald Welte1ed89d42011-09-01 18:18:43 +02001755 if (trans->conn && trans->conn->lchan)
1756 setup.lchan_type = trans->conn->lchan->type;
Harald Welte705f2942010-03-02 23:18:30 +01001757 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08001758 /* emergency setup is identified by msg_type */
1759 if (msg_type == GSM48_MT_CC_EMERG_SETUP)
1760 setup.emergency = 1;
1761
1762 /* use subscriber as calling party number */
Holger Hans Peter Freytherac009e52013-07-06 11:45:38 +02001763 setup.fields |= MNCC_F_CALLING;
1764 strncpy(setup.calling.number, trans->subscr->extension,
1765 sizeof(setup.calling.number)-1);
1766 strncpy(setup.imsi, trans->subscr->imsi,
1767 sizeof(setup.imsi)-1);
1768
Harald Welte03740842009-06-10 23:11:52 +08001769 /* bearer capability */
1770 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
1771 setup.fields |= MNCC_F_BEARER_CAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01001772 gsm48_decode_bearer_cap(&setup.bearer_cap,
Harald Welte03740842009-06-10 23:11:52 +08001773 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
1774 }
1775 /* facility */
1776 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
1777 setup.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01001778 gsm48_decode_facility(&setup.facility,
Harald Welte03740842009-06-10 23:11:52 +08001779 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
1780 }
1781 /* called party bcd number */
1782 if (TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) {
1783 setup.fields |= MNCC_F_CALLED;
Harald Weltefdc93d92010-03-07 23:40:35 +01001784 gsm48_decode_called(&setup.called,
Harald Welte03740842009-06-10 23:11:52 +08001785 TLVP_VAL(&tp, GSM48_IE_CALLED_BCD)-1);
1786 }
1787 /* user-user */
1788 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
1789 setup.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01001790 gsm48_decode_useruser(&setup.useruser,
Harald Welte03740842009-06-10 23:11:52 +08001791 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
1792 }
1793 /* ss-version */
1794 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
1795 setup.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01001796 gsm48_decode_ssversion(&setup.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08001797 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
1798 }
1799 /* CLIR suppression */
1800 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_SUPP))
1801 setup.clir.sup = 1;
1802 /* CLIR invocation */
1803 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_INVOC))
1804 setup.clir.inv = 1;
1805 /* cc cap */
1806 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
1807 setup.fields |= MNCC_F_CCCAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01001808 gsm48_decode_cccap(&setup.cccap,
Harald Welte03740842009-06-10 23:11:52 +08001809 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
1810 }
1811
Harald Welte03740842009-06-10 23:11:52 +08001812 new_cc_state(trans, GSM_CSTATE_INITIATED);
1813
Harald Welte (local)5b722d42009-12-26 19:45:03 +01001814 LOGP(DCC, LOGL_INFO, "Subscriber %s (%s) sends SETUP to %s\n",
1815 subscr_name(trans->subscr), trans->subscr->extension,
1816 setup.called.number);
1817
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001818 osmo_counter_inc(trans->subscr->net->stats.call.mo_setup);
Harald Weltec56006b2010-12-24 16:06:33 +01001819
Harald Welte03740842009-06-10 23:11:52 +08001820 /* indicate setup to MNCC */
Harald Welte0abe5a62009-07-23 19:06:52 +02001821 mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_IND, &setup);
Harald Welte03740842009-06-10 23:11:52 +08001822
Harald Welteca745e22009-07-29 12:10:35 +02001823 /* MNCC code will modify the channel asynchronously, we should
1824 * ipaccess-bind only after the modification has been made to the
1825 * lchan->tch_mode */
Harald Welte03740842009-06-10 23:11:52 +08001826 return 0;
1827}
1828
1829static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg)
Harald Welte59b04682009-06-10 05:40:52 +08001830{
1831 struct msgb *msg = gsm48_msgb_alloc();
1832 struct gsm48_hdr *gh;
Harald Welte03740842009-06-10 23:11:52 +08001833 struct gsm_mncc *setup = arg;
Harald Welte165fc332009-07-23 21:36:44 +02001834 int rc, trans_id;
Harald Welte59b04682009-06-10 05:40:52 +08001835
1836 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1837
Harald Welte03740842009-06-10 23:11:52 +08001838 /* transaction id must not be assigned */
1839 if (trans->transaction_id != 0xff) { /* unasssigned */
1840 DEBUGP(DCC, "TX Setup with assigned transaction. "
1841 "This is not allowed!\n");
1842 /* Temporarily out of order */
Harald Welte0abe5a62009-07-23 19:06:52 +02001843 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08001844 GSM48_CAUSE_LOC_PRN_S_LU,
1845 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte03740842009-06-10 23:11:52 +08001846 trans->callref = 0;
Harald Weltec2189a62009-07-23 18:56:43 +02001847 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08001848 return rc;
1849 }
1850
1851 /* Get free transaction_id */
Harald Welte165fc332009-07-23 21:36:44 +02001852 trans_id = trans_assign_trans_id(trans->subscr, GSM48_PDISC_CC, 0);
1853 if (trans_id < 0) {
Harald Welte03740842009-06-10 23:11:52 +08001854 /* no free transaction ID */
Harald Welte0abe5a62009-07-23 19:06:52 +02001855 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08001856 GSM48_CAUSE_LOC_PRN_S_LU,
1857 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte03740842009-06-10 23:11:52 +08001858 trans->callref = 0;
Harald Weltec2189a62009-07-23 18:56:43 +02001859 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08001860 return rc;
1861 }
Harald Welte165fc332009-07-23 21:36:44 +02001862 trans->transaction_id = trans_id;
Harald Welte59b04682009-06-10 05:40:52 +08001863
Harald Welte59b04682009-06-10 05:40:52 +08001864 gh->msg_type = GSM48_MT_CC_SETUP;
1865
Harald Welte03740842009-06-10 23:11:52 +08001866 gsm48_start_cc_timer(trans, 0x303, GSM48_T303);
Harald Welte59b04682009-06-10 05:40:52 +08001867
Harald Welte03740842009-06-10 23:11:52 +08001868 /* bearer capability */
1869 if (setup->fields & MNCC_F_BEARER_CAP)
Harald Weltefdc93d92010-03-07 23:40:35 +01001870 gsm48_encode_bearer_cap(msg, 0, &setup->bearer_cap);
Harald Welte03740842009-06-10 23:11:52 +08001871 /* facility */
1872 if (setup->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01001873 gsm48_encode_facility(msg, 0, &setup->facility);
Harald Welte03740842009-06-10 23:11:52 +08001874 /* progress */
1875 if (setup->fields & MNCC_F_PROGRESS)
Harald Weltefdc93d92010-03-07 23:40:35 +01001876 gsm48_encode_progress(msg, 0, &setup->progress);
Harald Welte03740842009-06-10 23:11:52 +08001877 /* calling party BCD number */
1878 if (setup->fields & MNCC_F_CALLING)
Harald Weltefdc93d92010-03-07 23:40:35 +01001879 gsm48_encode_calling(msg, &setup->calling);
Harald Welte03740842009-06-10 23:11:52 +08001880 /* called party BCD number */
1881 if (setup->fields & MNCC_F_CALLED)
Harald Weltefdc93d92010-03-07 23:40:35 +01001882 gsm48_encode_called(msg, &setup->called);
Harald Welte03740842009-06-10 23:11:52 +08001883 /* user-user */
1884 if (setup->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01001885 gsm48_encode_useruser(msg, 0, &setup->useruser);
Harald Welte03740842009-06-10 23:11:52 +08001886 /* redirecting party BCD number */
1887 if (setup->fields & MNCC_F_REDIRECTING)
Harald Weltefdc93d92010-03-07 23:40:35 +01001888 gsm48_encode_redirecting(msg, &setup->redirecting);
Harald Welte03740842009-06-10 23:11:52 +08001889 /* signal */
1890 if (setup->fields & MNCC_F_SIGNAL)
Harald Weltefdc93d92010-03-07 23:40:35 +01001891 gsm48_encode_signal(msg, setup->signal);
Harald Welte03740842009-06-10 23:11:52 +08001892
1893 new_cc_state(trans, GSM_CSTATE_CALL_PRESENT);
Harald Welte59b04682009-06-10 05:40:52 +08001894
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001895 osmo_counter_inc(trans->subscr->net->stats.call.mt_setup);
Harald Weltec56006b2010-12-24 16:06:33 +01001896
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08001897 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte59b04682009-06-10 05:40:52 +08001898}
1899
Harald Welte03740842009-06-10 23:11:52 +08001900static int gsm48_cc_rx_call_conf(struct gsm_trans *trans, struct msgb *msg)
1901{
1902 struct gsm48_hdr *gh = msgb_l3(msg);
1903 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1904 struct tlv_parsed tp;
1905 struct gsm_mncc call_conf;
1906
1907 gsm48_stop_cc_timer(trans);
1908 gsm48_start_cc_timer(trans, 0x310, GSM48_T310);
1909
1910 memset(&call_conf, 0, sizeof(struct gsm_mncc));
1911 call_conf.callref = trans->callref;
Harald Welte1ed89d42011-09-01 18:18:43 +02001912 if (trans->conn && trans->conn->lchan)
1913 call_conf.lchan_type = trans->conn->lchan->type;
Harald Welte705f2942010-03-02 23:18:30 +01001914 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08001915#if 0
1916 /* repeat */
1917 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_CIR))
1918 call_conf.repeat = 1;
1919 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_SEQ))
1920 call_conf.repeat = 2;
1921#endif
1922 /* bearer capability */
1923 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
1924 call_conf.fields |= MNCC_F_BEARER_CAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01001925 gsm48_decode_bearer_cap(&call_conf.bearer_cap,
Harald Welte03740842009-06-10 23:11:52 +08001926 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
1927 }
1928 /* cause */
1929 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
1930 call_conf.fields |= MNCC_F_CAUSE;
Harald Weltefdc93d92010-03-07 23:40:35 +01001931 gsm48_decode_cause(&call_conf.cause,
Harald Welte03740842009-06-10 23:11:52 +08001932 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
1933 }
1934 /* cc cap */
1935 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
1936 call_conf.fields |= MNCC_F_CCCAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01001937 gsm48_decode_cccap(&call_conf.cccap,
Harald Welte03740842009-06-10 23:11:52 +08001938 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
1939 }
1940
1941 new_cc_state(trans, GSM_CSTATE_MO_TERM_CALL_CONF);
1942
Harald Welte0abe5a62009-07-23 19:06:52 +02001943 return mncc_recvmsg(trans->subscr->net, trans, MNCC_CALL_CONF_IND,
1944 &call_conf);
Harald Welte03740842009-06-10 23:11:52 +08001945}
1946
1947static int gsm48_cc_tx_call_proc(struct gsm_trans *trans, void *arg)
1948{
1949 struct gsm_mncc *proceeding = arg;
1950 struct msgb *msg = gsm48_msgb_alloc();
1951 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1952
Harald Welte03740842009-06-10 23:11:52 +08001953 gh->msg_type = GSM48_MT_CC_CALL_PROC;
1954
1955 new_cc_state(trans, GSM_CSTATE_MO_CALL_PROC);
1956
1957 /* bearer capability */
1958 if (proceeding->fields & MNCC_F_BEARER_CAP)
Harald Weltefdc93d92010-03-07 23:40:35 +01001959 gsm48_encode_bearer_cap(msg, 0, &proceeding->bearer_cap);
Harald Welte03740842009-06-10 23:11:52 +08001960 /* facility */
1961 if (proceeding->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01001962 gsm48_encode_facility(msg, 0, &proceeding->facility);
Harald Welte03740842009-06-10 23:11:52 +08001963 /* progress */
1964 if (proceeding->fields & MNCC_F_PROGRESS)
Harald Weltefdc93d92010-03-07 23:40:35 +01001965 gsm48_encode_progress(msg, 0, &proceeding->progress);
Harald Welte03740842009-06-10 23:11:52 +08001966
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08001967 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08001968}
1969
1970static int gsm48_cc_rx_alerting(struct gsm_trans *trans, struct msgb *msg)
1971{
1972 struct gsm48_hdr *gh = msgb_l3(msg);
1973 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1974 struct tlv_parsed tp;
1975 struct gsm_mncc alerting;
1976
1977 gsm48_stop_cc_timer(trans);
1978 gsm48_start_cc_timer(trans, 0x301, GSM48_T301);
1979
1980 memset(&alerting, 0, sizeof(struct gsm_mncc));
1981 alerting.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01001982 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08001983 /* facility */
1984 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
1985 alerting.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01001986 gsm48_decode_facility(&alerting.facility,
Harald Welte03740842009-06-10 23:11:52 +08001987 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
1988 }
1989
1990 /* progress */
1991 if (TLVP_PRESENT(&tp, GSM48_IE_PROGR_IND)) {
1992 alerting.fields |= MNCC_F_PROGRESS;
Harald Weltefdc93d92010-03-07 23:40:35 +01001993 gsm48_decode_progress(&alerting.progress,
Harald Welte03740842009-06-10 23:11:52 +08001994 TLVP_VAL(&tp, GSM48_IE_PROGR_IND)-1);
1995 }
1996 /* ss-version */
1997 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
1998 alerting.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01001999 gsm48_decode_ssversion(&alerting.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002000 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2001 }
2002
2003 new_cc_state(trans, GSM_CSTATE_CALL_RECEIVED);
2004
Harald Welte0abe5a62009-07-23 19:06:52 +02002005 return mncc_recvmsg(trans->subscr->net, trans, MNCC_ALERT_IND,
2006 &alerting);
Harald Welte03740842009-06-10 23:11:52 +08002007}
2008
2009static int gsm48_cc_tx_alerting(struct gsm_trans *trans, void *arg)
2010{
2011 struct gsm_mncc *alerting = arg;
2012 struct msgb *msg = gsm48_msgb_alloc();
2013 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2014
Harald Welte03740842009-06-10 23:11:52 +08002015 gh->msg_type = GSM48_MT_CC_ALERTING;
2016
2017 /* facility */
2018 if (alerting->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01002019 gsm48_encode_facility(msg, 0, &alerting->facility);
Harald Welte03740842009-06-10 23:11:52 +08002020 /* progress */
2021 if (alerting->fields & MNCC_F_PROGRESS)
Harald Weltefdc93d92010-03-07 23:40:35 +01002022 gsm48_encode_progress(msg, 0, &alerting->progress);
Harald Welte03740842009-06-10 23:11:52 +08002023 /* user-user */
2024 if (alerting->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002025 gsm48_encode_useruser(msg, 0, &alerting->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002026
2027 new_cc_state(trans, GSM_CSTATE_CALL_DELIVERED);
2028
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002029 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002030}
2031
2032static int gsm48_cc_tx_progress(struct gsm_trans *trans, void *arg)
2033{
2034 struct gsm_mncc *progress = arg;
2035 struct msgb *msg = gsm48_msgb_alloc();
2036 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2037
Harald Welte03740842009-06-10 23:11:52 +08002038 gh->msg_type = GSM48_MT_CC_PROGRESS;
2039
2040 /* progress */
Harald Weltefdc93d92010-03-07 23:40:35 +01002041 gsm48_encode_progress(msg, 1, &progress->progress);
Harald Welte03740842009-06-10 23:11:52 +08002042 /* user-user */
2043 if (progress->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002044 gsm48_encode_useruser(msg, 0, &progress->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002045
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002046 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002047}
2048
2049static int gsm48_cc_tx_connect(struct gsm_trans *trans, void *arg)
2050{
2051 struct gsm_mncc *connect = arg;
2052 struct msgb *msg = gsm48_msgb_alloc();
2053 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2054
Harald Welte03740842009-06-10 23:11:52 +08002055 gh->msg_type = GSM48_MT_CC_CONNECT;
2056
2057 gsm48_stop_cc_timer(trans);
2058 gsm48_start_cc_timer(trans, 0x313, GSM48_T313);
2059
2060 /* facility */
2061 if (connect->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01002062 gsm48_encode_facility(msg, 0, &connect->facility);
Harald Welte03740842009-06-10 23:11:52 +08002063 /* progress */
2064 if (connect->fields & MNCC_F_PROGRESS)
Harald Weltefdc93d92010-03-07 23:40:35 +01002065 gsm48_encode_progress(msg, 0, &connect->progress);
Harald Welte03740842009-06-10 23:11:52 +08002066 /* connected number */
2067 if (connect->fields & MNCC_F_CONNECTED)
Harald Weltefdc93d92010-03-07 23:40:35 +01002068 gsm48_encode_connected(msg, &connect->connected);
Harald Welte03740842009-06-10 23:11:52 +08002069 /* user-user */
2070 if (connect->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002071 gsm48_encode_useruser(msg, 0, &connect->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002072
2073 new_cc_state(trans, GSM_CSTATE_CONNECT_IND);
2074
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002075 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002076}
2077
2078static int gsm48_cc_rx_connect(struct gsm_trans *trans, struct msgb *msg)
2079{
2080 struct gsm48_hdr *gh = msgb_l3(msg);
2081 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2082 struct tlv_parsed tp;
2083 struct gsm_mncc connect;
2084
2085 gsm48_stop_cc_timer(trans);
2086
2087 memset(&connect, 0, sizeof(struct gsm_mncc));
2088 connect.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002089 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08002090 /* use subscriber as connected party number */
Holger Hans Peter Freytherac009e52013-07-06 11:45:38 +02002091 connect.fields |= MNCC_F_CONNECTED;
2092 strncpy(connect.connected.number, trans->subscr->extension,
2093 sizeof(connect.connected.number)-1);
2094 strncpy(connect.imsi, trans->subscr->imsi,
2095 sizeof(connect.imsi)-1);
2096
Harald Welte03740842009-06-10 23:11:52 +08002097 /* facility */
2098 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2099 connect.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01002100 gsm48_decode_facility(&connect.facility,
Harald Welte03740842009-06-10 23:11:52 +08002101 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2102 }
2103 /* user-user */
2104 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2105 connect.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01002106 gsm48_decode_useruser(&connect.useruser,
Harald Welte03740842009-06-10 23:11:52 +08002107 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2108 }
2109 /* ss-version */
2110 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2111 connect.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01002112 gsm48_decode_ssversion(&connect.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002113 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2114 }
2115
2116 new_cc_state(trans, GSM_CSTATE_CONNECT_REQUEST);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02002117 osmo_counter_inc(trans->subscr->net->stats.call.mt_connect);
Harald Welte03740842009-06-10 23:11:52 +08002118
Harald Welte0abe5a62009-07-23 19:06:52 +02002119 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_CNF, &connect);
Harald Welte03740842009-06-10 23:11:52 +08002120}
2121
2122
2123static int gsm48_cc_rx_connect_ack(struct gsm_trans *trans, struct msgb *msg)
2124{
2125 struct gsm_mncc connect_ack;
2126
2127 gsm48_stop_cc_timer(trans);
2128
2129 new_cc_state(trans, GSM_CSTATE_ACTIVE);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02002130 osmo_counter_inc(trans->subscr->net->stats.call.mo_connect_ack);
Harald Welte03740842009-06-10 23:11:52 +08002131
2132 memset(&connect_ack, 0, sizeof(struct gsm_mncc));
2133 connect_ack.callref = trans->callref;
Harald Weltec56006b2010-12-24 16:06:33 +01002134
Harald Welte0abe5a62009-07-23 19:06:52 +02002135 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_COMPL_IND,
Harald Welte03740842009-06-10 23:11:52 +08002136 &connect_ack);
2137}
2138
2139static int gsm48_cc_tx_connect_ack(struct gsm_trans *trans, void *arg)
2140{
2141 struct msgb *msg = gsm48_msgb_alloc();
2142 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2143
Harald Welte03740842009-06-10 23:11:52 +08002144 gh->msg_type = GSM48_MT_CC_CONNECT_ACK;
2145
2146 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2147
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002148 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002149}
2150
2151static int gsm48_cc_rx_disconnect(struct gsm_trans *trans, struct msgb *msg)
2152{
2153 struct gsm48_hdr *gh = msgb_l3(msg);
2154 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2155 struct tlv_parsed tp;
2156 struct gsm_mncc disc;
2157
2158 gsm48_stop_cc_timer(trans);
2159
2160 new_cc_state(trans, GSM_CSTATE_DISCONNECT_REQ);
2161
2162 memset(&disc, 0, sizeof(struct gsm_mncc));
2163 disc.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002164 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_CAUSE, 0);
Harald Welte03740842009-06-10 23:11:52 +08002165 /* cause */
2166 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2167 disc.fields |= MNCC_F_CAUSE;
Harald Weltefdc93d92010-03-07 23:40:35 +01002168 gsm48_decode_cause(&disc.cause,
Harald Welte03740842009-06-10 23:11:52 +08002169 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2170 }
2171 /* facility */
2172 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2173 disc.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01002174 gsm48_decode_facility(&disc.facility,
Harald Welte03740842009-06-10 23:11:52 +08002175 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2176 }
2177 /* user-user */
2178 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2179 disc.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01002180 gsm48_decode_useruser(&disc.useruser,
Harald Welte03740842009-06-10 23:11:52 +08002181 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2182 }
2183 /* ss-version */
2184 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2185 disc.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01002186 gsm48_decode_ssversion(&disc.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002187 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2188 }
2189
Harald Welte0abe5a62009-07-23 19:06:52 +02002190 return mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &disc);
Harald Welte03740842009-06-10 23:11:52 +08002191
2192}
2193
Harald Weltebbc636a2009-06-11 14:23:20 +08002194static struct gsm_mncc_cause default_cause = {
2195 .location = GSM48_CAUSE_LOC_PRN_S_LU,
2196 .coding = 0,
2197 .rec = 0,
2198 .rec_val = 0,
2199 .value = GSM48_CC_CAUSE_NORMAL_UNSPEC,
2200 .diag_len = 0,
2201 .diag = { 0 },
2202};
Harald Welte03740842009-06-10 23:11:52 +08002203
2204static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg)
2205{
2206 struct gsm_mncc *disc = arg;
2207 struct msgb *msg = gsm48_msgb_alloc();
2208 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2209
Harald Welte03740842009-06-10 23:11:52 +08002210 gh->msg_type = GSM48_MT_CC_DISCONNECT;
2211
2212 gsm48_stop_cc_timer(trans);
2213 gsm48_start_cc_timer(trans, 0x306, GSM48_T306);
2214
2215 /* cause */
2216 if (disc->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002217 gsm48_encode_cause(msg, 1, &disc->cause);
Harald Welte03740842009-06-10 23:11:52 +08002218 else
Harald Weltefdc93d92010-03-07 23:40:35 +01002219 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte03740842009-06-10 23:11:52 +08002220
2221 /* facility */
2222 if (disc->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01002223 gsm48_encode_facility(msg, 0, &disc->facility);
Harald Welte03740842009-06-10 23:11:52 +08002224 /* progress */
2225 if (disc->fields & MNCC_F_PROGRESS)
Harald Weltefdc93d92010-03-07 23:40:35 +01002226 gsm48_encode_progress(msg, 0, &disc->progress);
Harald Welte03740842009-06-10 23:11:52 +08002227 /* user-user */
2228 if (disc->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002229 gsm48_encode_useruser(msg, 0, &disc->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002230
2231 /* store disconnect cause for T306 expiry */
Harald Weltec2189a62009-07-23 18:56:43 +02002232 memcpy(&trans->cc.msg, disc, sizeof(struct gsm_mncc));
Harald Welte03740842009-06-10 23:11:52 +08002233
2234 new_cc_state(trans, GSM_CSTATE_DISCONNECT_IND);
2235
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002236 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002237}
2238
2239static int gsm48_cc_rx_release(struct gsm_trans *trans, struct msgb *msg)
2240{
2241 struct gsm48_hdr *gh = msgb_l3(msg);
2242 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2243 struct tlv_parsed tp;
2244 struct gsm_mncc rel;
2245 int rc;
2246
2247 gsm48_stop_cc_timer(trans);
2248
2249 memset(&rel, 0, sizeof(struct gsm_mncc));
2250 rel.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002251 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08002252 /* cause */
2253 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2254 rel.fields |= MNCC_F_CAUSE;
Harald Weltefdc93d92010-03-07 23:40:35 +01002255 gsm48_decode_cause(&rel.cause,
Harald Welte03740842009-06-10 23:11:52 +08002256 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2257 }
2258 /* facility */
2259 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2260 rel.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01002261 gsm48_decode_facility(&rel.facility,
Harald Welte03740842009-06-10 23:11:52 +08002262 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2263 }
2264 /* user-user */
2265 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2266 rel.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01002267 gsm48_decode_useruser(&rel.useruser,
Harald Welte03740842009-06-10 23:11:52 +08002268 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2269 }
2270 /* ss-version */
2271 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2272 rel.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01002273 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002274 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2275 }
2276
Harald Weltec2189a62009-07-23 18:56:43 +02002277 if (trans->cc.state == GSM_CSTATE_RELEASE_REQ) {
Harald Welte03740842009-06-10 23:11:52 +08002278 /* release collision 5.4.5 */
Harald Welte0abe5a62009-07-23 19:06:52 +02002279 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_CNF, &rel);
Harald Welte03740842009-06-10 23:11:52 +08002280 } else {
Holger Hans Peter Freyther5a38f922010-06-16 12:30:50 +08002281 rc = gsm48_tx_simple(trans->conn,
Harald Welte4861c822009-07-23 21:21:14 +02002282 GSM48_PDISC_CC | (trans->transaction_id << 4),
Harald Welte0abe5a62009-07-23 19:06:52 +02002283 GSM48_MT_CC_RELEASE_COMPL);
2284 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_IND, &rel);
Harald Welte03740842009-06-10 23:11:52 +08002285 }
2286
2287 new_cc_state(trans, GSM_CSTATE_NULL);
2288
2289 trans->callref = 0;
Harald Weltec2189a62009-07-23 18:56:43 +02002290 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08002291
2292 return rc;
2293}
2294
2295static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg)
2296{
2297 struct gsm_mncc *rel = arg;
2298 struct msgb *msg = gsm48_msgb_alloc();
2299 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2300
Harald Welte03740842009-06-10 23:11:52 +08002301 gh->msg_type = GSM48_MT_CC_RELEASE;
2302
Harald Welte03740842009-06-10 23:11:52 +08002303 gsm48_stop_cc_timer(trans);
2304 gsm48_start_cc_timer(trans, 0x308, GSM48_T308);
2305
2306 /* cause */
2307 if (rel->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002308 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte03740842009-06-10 23:11:52 +08002309 /* facility */
2310 if (rel->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01002311 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte03740842009-06-10 23:11:52 +08002312 /* user-user */
2313 if (rel->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002314 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002315
Harald Weltec2189a62009-07-23 18:56:43 +02002316 trans->cc.T308_second = 0;
2317 memcpy(&trans->cc.msg, rel, sizeof(struct gsm_mncc));
Harald Welte03740842009-06-10 23:11:52 +08002318
Harald Weltec2189a62009-07-23 18:56:43 +02002319 if (trans->cc.state != GSM_CSTATE_RELEASE_REQ)
Harald Welte03740842009-06-10 23:11:52 +08002320 new_cc_state(trans, GSM_CSTATE_RELEASE_REQ);
2321
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002322 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002323}
2324
2325static int gsm48_cc_rx_release_compl(struct gsm_trans *trans, struct msgb *msg)
2326{
2327 struct gsm48_hdr *gh = msgb_l3(msg);
2328 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2329 struct tlv_parsed tp;
2330 struct gsm_mncc rel;
2331 int rc = 0;
2332
2333 gsm48_stop_cc_timer(trans);
2334
2335 memset(&rel, 0, sizeof(struct gsm_mncc));
2336 rel.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002337 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08002338 /* cause */
2339 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2340 rel.fields |= MNCC_F_CAUSE;
Harald Weltefdc93d92010-03-07 23:40:35 +01002341 gsm48_decode_cause(&rel.cause,
Harald Welte03740842009-06-10 23:11:52 +08002342 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2343 }
2344 /* facility */
2345 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2346 rel.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01002347 gsm48_decode_facility(&rel.facility,
Harald Welte03740842009-06-10 23:11:52 +08002348 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2349 }
2350 /* user-user */
2351 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2352 rel.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01002353 gsm48_decode_useruser(&rel.useruser,
Harald Welte03740842009-06-10 23:11:52 +08002354 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2355 }
2356 /* ss-version */
2357 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2358 rel.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01002359 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002360 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2361 }
2362
2363 if (trans->callref) {
Harald Weltec2189a62009-07-23 18:56:43 +02002364 switch (trans->cc.state) {
Harald Welte03740842009-06-10 23:11:52 +08002365 case GSM_CSTATE_CALL_PRESENT:
Harald Welte0abe5a62009-07-23 19:06:52 +02002366 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte03740842009-06-10 23:11:52 +08002367 MNCC_REJ_IND, &rel);
2368 break;
2369 case GSM_CSTATE_RELEASE_REQ:
Harald Welte0abe5a62009-07-23 19:06:52 +02002370 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte03740842009-06-10 23:11:52 +08002371 MNCC_REL_CNF, &rel);
2372 break;
2373 default:
Harald Welte0abe5a62009-07-23 19:06:52 +02002374 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte03740842009-06-10 23:11:52 +08002375 MNCC_REL_IND, &rel);
2376 }
2377 }
2378
2379 trans->callref = 0;
Harald Weltec2189a62009-07-23 18:56:43 +02002380 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08002381
2382 return rc;
2383}
2384
2385static int gsm48_cc_tx_release_compl(struct gsm_trans *trans, void *arg)
2386{
2387 struct gsm_mncc *rel = arg;
2388 struct msgb *msg = gsm48_msgb_alloc();
2389 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Welte4a6d4ab2010-12-21 19:31:41 +01002390 int ret;
Harald Welte03740842009-06-10 23:11:52 +08002391
Harald Welte03740842009-06-10 23:11:52 +08002392 gh->msg_type = GSM48_MT_CC_RELEASE_COMPL;
2393
2394 trans->callref = 0;
2395
2396 gsm48_stop_cc_timer(trans);
2397
2398 /* cause */
2399 if (rel->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002400 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte03740842009-06-10 23:11:52 +08002401 /* facility */
2402 if (rel->fields & MNCC_F_FACILITY)
Harald Weltefdc93d92010-03-07 23:40:35 +01002403 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte03740842009-06-10 23:11:52 +08002404 /* user-user */
2405 if (rel->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002406 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002407
Harald Welte4a6d4ab2010-12-21 19:31:41 +01002408 ret = gsm48_conn_sendmsg(msg, trans->conn, trans);
2409
Harald Weltec2189a62009-07-23 18:56:43 +02002410 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08002411
Harald Welte4a6d4ab2010-12-21 19:31:41 +01002412 return ret;
Harald Welte03740842009-06-10 23:11:52 +08002413}
2414
2415static int gsm48_cc_rx_facility(struct gsm_trans *trans, struct msgb *msg)
2416{
2417 struct gsm48_hdr *gh = msgb_l3(msg);
2418 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2419 struct tlv_parsed tp;
2420 struct gsm_mncc fac;
2421
2422 memset(&fac, 0, sizeof(struct gsm_mncc));
2423 fac.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002424 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_FACILITY, 0);
Harald Welte03740842009-06-10 23:11:52 +08002425 /* facility */
2426 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2427 fac.fields |= MNCC_F_FACILITY;
Harald Weltefdc93d92010-03-07 23:40:35 +01002428 gsm48_decode_facility(&fac.facility,
Harald Welte03740842009-06-10 23:11:52 +08002429 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2430 }
2431 /* ss-version */
2432 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2433 fac.fields |= MNCC_F_SSVERSION;
Harald Weltefdc93d92010-03-07 23:40:35 +01002434 gsm48_decode_ssversion(&fac.ssversion,
Harald Welte03740842009-06-10 23:11:52 +08002435 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2436 }
2437
Harald Welte0abe5a62009-07-23 19:06:52 +02002438 return mncc_recvmsg(trans->subscr->net, trans, MNCC_FACILITY_IND, &fac);
Harald Welte03740842009-06-10 23:11:52 +08002439}
2440
2441static int gsm48_cc_tx_facility(struct gsm_trans *trans, void *arg)
2442{
2443 struct gsm_mncc *fac = arg;
2444 struct msgb *msg = gsm48_msgb_alloc();
2445 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2446
Harald Welte03740842009-06-10 23:11:52 +08002447 gh->msg_type = GSM48_MT_CC_FACILITY;
2448
2449 /* facility */
Harald Weltefdc93d92010-03-07 23:40:35 +01002450 gsm48_encode_facility(msg, 1, &fac->facility);
Harald Welte03740842009-06-10 23:11:52 +08002451
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002452 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002453}
2454
2455static int gsm48_cc_rx_hold(struct gsm_trans *trans, struct msgb *msg)
2456{
2457 struct gsm_mncc hold;
2458
2459 memset(&hold, 0, sizeof(struct gsm_mncc));
2460 hold.callref = trans->callref;
Harald Welte0abe5a62009-07-23 19:06:52 +02002461 return mncc_recvmsg(trans->subscr->net, trans, MNCC_HOLD_IND, &hold);
Harald Welte03740842009-06-10 23:11:52 +08002462}
2463
2464static int gsm48_cc_tx_hold_ack(struct gsm_trans *trans, void *arg)
2465{
2466 struct msgb *msg = gsm48_msgb_alloc();
2467 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2468
Harald Welte03740842009-06-10 23:11:52 +08002469 gh->msg_type = GSM48_MT_CC_HOLD_ACK;
2470
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002471 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002472}
2473
2474static int gsm48_cc_tx_hold_rej(struct gsm_trans *trans, void *arg)
2475{
2476 struct gsm_mncc *hold_rej = arg;
2477 struct msgb *msg = gsm48_msgb_alloc();
2478 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2479
Harald Welte03740842009-06-10 23:11:52 +08002480 gh->msg_type = GSM48_MT_CC_HOLD_REJ;
2481
2482 /* cause */
2483 if (hold_rej->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002484 gsm48_encode_cause(msg, 1, &hold_rej->cause);
Harald Welte03740842009-06-10 23:11:52 +08002485 else
Harald Weltefdc93d92010-03-07 23:40:35 +01002486 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte03740842009-06-10 23:11:52 +08002487
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002488 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002489}
2490
2491static int gsm48_cc_rx_retrieve(struct gsm_trans *trans, struct msgb *msg)
2492{
2493 struct gsm_mncc retrieve;
2494
2495 memset(&retrieve, 0, sizeof(struct gsm_mncc));
2496 retrieve.callref = trans->callref;
Harald Welte0abe5a62009-07-23 19:06:52 +02002497 return mncc_recvmsg(trans->subscr->net, trans, MNCC_RETRIEVE_IND,
2498 &retrieve);
Harald Welte03740842009-06-10 23:11:52 +08002499}
2500
2501static int gsm48_cc_tx_retrieve_ack(struct gsm_trans *trans, void *arg)
2502{
2503 struct msgb *msg = gsm48_msgb_alloc();
2504 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2505
Harald Welte03740842009-06-10 23:11:52 +08002506 gh->msg_type = GSM48_MT_CC_RETR_ACK;
2507
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002508 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002509}
2510
2511static int gsm48_cc_tx_retrieve_rej(struct gsm_trans *trans, void *arg)
2512{
2513 struct gsm_mncc *retrieve_rej = arg;
2514 struct msgb *msg = gsm48_msgb_alloc();
2515 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2516
Harald Welte03740842009-06-10 23:11:52 +08002517 gh->msg_type = GSM48_MT_CC_RETR_REJ;
2518
2519 /* cause */
2520 if (retrieve_rej->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002521 gsm48_encode_cause(msg, 1, &retrieve_rej->cause);
Harald Welte03740842009-06-10 23:11:52 +08002522 else
Harald Weltefdc93d92010-03-07 23:40:35 +01002523 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte03740842009-06-10 23:11:52 +08002524
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002525 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002526}
2527
2528static int gsm48_cc_rx_start_dtmf(struct gsm_trans *trans, struct msgb *msg)
2529{
2530 struct gsm48_hdr *gh = msgb_l3(msg);
2531 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2532 struct tlv_parsed tp;
2533 struct gsm_mncc dtmf;
2534
2535 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2536 dtmf.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002537 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte03740842009-06-10 23:11:52 +08002538 /* keypad facility */
2539 if (TLVP_PRESENT(&tp, GSM48_IE_KPD_FACILITY)) {
2540 dtmf.fields |= MNCC_F_KEYPAD;
Harald Weltefdc93d92010-03-07 23:40:35 +01002541 gsm48_decode_keypad(&dtmf.keypad,
Harald Welte03740842009-06-10 23:11:52 +08002542 TLVP_VAL(&tp, GSM48_IE_KPD_FACILITY)-1);
2543 }
2544
Harald Welte0abe5a62009-07-23 19:06:52 +02002545 return mncc_recvmsg(trans->subscr->net, trans, MNCC_START_DTMF_IND, &dtmf);
Harald Welte03740842009-06-10 23:11:52 +08002546}
2547
2548static int gsm48_cc_tx_start_dtmf_ack(struct gsm_trans *trans, void *arg)
2549{
2550 struct gsm_mncc *dtmf = arg;
2551 struct msgb *msg = gsm48_msgb_alloc();
2552 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2553
Harald Welte03740842009-06-10 23:11:52 +08002554 gh->msg_type = GSM48_MT_CC_START_DTMF_ACK;
2555
2556 /* keypad */
2557 if (dtmf->fields & MNCC_F_KEYPAD)
Harald Weltefdc93d92010-03-07 23:40:35 +01002558 gsm48_encode_keypad(msg, dtmf->keypad);
Harald Welte03740842009-06-10 23:11:52 +08002559
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002560 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002561}
2562
2563static int gsm48_cc_tx_start_dtmf_rej(struct gsm_trans *trans, void *arg)
2564{
2565 struct gsm_mncc *dtmf = arg;
2566 struct msgb *msg = gsm48_msgb_alloc();
2567 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2568
Harald Welte03740842009-06-10 23:11:52 +08002569 gh->msg_type = GSM48_MT_CC_START_DTMF_REJ;
2570
2571 /* cause */
2572 if (dtmf->fields & MNCC_F_CAUSE)
Harald Weltefdc93d92010-03-07 23:40:35 +01002573 gsm48_encode_cause(msg, 1, &dtmf->cause);
Harald Welte03740842009-06-10 23:11:52 +08002574 else
Harald Weltefdc93d92010-03-07 23:40:35 +01002575 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte03740842009-06-10 23:11:52 +08002576
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002577 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002578}
2579
2580static int gsm48_cc_tx_stop_dtmf_ack(struct gsm_trans *trans, void *arg)
2581{
2582 struct msgb *msg = gsm48_msgb_alloc();
2583 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2584
Harald Welte03740842009-06-10 23:11:52 +08002585 gh->msg_type = GSM48_MT_CC_STOP_DTMF_ACK;
2586
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002587 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002588}
2589
2590static int gsm48_cc_rx_stop_dtmf(struct gsm_trans *trans, struct msgb *msg)
2591{
2592 struct gsm_mncc dtmf;
2593
2594 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2595 dtmf.callref = trans->callref;
2596
Harald Welte0abe5a62009-07-23 19:06:52 +02002597 return mncc_recvmsg(trans->subscr->net, trans, MNCC_STOP_DTMF_IND, &dtmf);
Harald Welte03740842009-06-10 23:11:52 +08002598}
2599
2600static int gsm48_cc_rx_modify(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 modify;
2606
2607 memset(&modify, 0, sizeof(struct gsm_mncc));
2608 modify.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002609 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte03740842009-06-10 23:11:52 +08002610 /* bearer capability */
2611 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2612 modify.fields |= MNCC_F_BEARER_CAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01002613 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte03740842009-06-10 23:11:52 +08002614 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2615 }
2616
2617 new_cc_state(trans, GSM_CSTATE_MO_ORIG_MODIFY);
2618
Harald Welte0abe5a62009-07-23 19:06:52 +02002619 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_IND, &modify);
Harald Welte03740842009-06-10 23:11:52 +08002620}
2621
2622static int gsm48_cc_tx_modify(struct gsm_trans *trans, void *arg)
2623{
2624 struct gsm_mncc *modify = arg;
2625 struct msgb *msg = gsm48_msgb_alloc();
2626 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2627
Harald Welte03740842009-06-10 23:11:52 +08002628 gh->msg_type = GSM48_MT_CC_MODIFY;
2629
2630 gsm48_start_cc_timer(trans, 0x323, GSM48_T323);
2631
2632 /* bearer capability */
Harald Weltefdc93d92010-03-07 23:40:35 +01002633 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte03740842009-06-10 23:11:52 +08002634
2635 new_cc_state(trans, GSM_CSTATE_MO_TERM_MODIFY);
2636
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002637 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002638}
2639
2640static int gsm48_cc_rx_modify_complete(struct gsm_trans *trans, struct msgb *msg)
2641{
2642 struct gsm48_hdr *gh = msgb_l3(msg);
2643 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2644 struct tlv_parsed tp;
2645 struct gsm_mncc modify;
2646
2647 gsm48_stop_cc_timer(trans);
2648
2649 memset(&modify, 0, sizeof(struct gsm_mncc));
2650 modify.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002651 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte03740842009-06-10 23:11:52 +08002652 /* bearer capability */
2653 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2654 modify.fields |= MNCC_F_BEARER_CAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01002655 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte03740842009-06-10 23:11:52 +08002656 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2657 }
2658
2659 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2660
Harald Welte0abe5a62009-07-23 19:06:52 +02002661 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_CNF, &modify);
Harald Welte03740842009-06-10 23:11:52 +08002662}
2663
2664static int gsm48_cc_tx_modify_complete(struct gsm_trans *trans, void *arg)
2665{
2666 struct gsm_mncc *modify = arg;
2667 struct msgb *msg = gsm48_msgb_alloc();
2668 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2669
Harald Welte03740842009-06-10 23:11:52 +08002670 gh->msg_type = GSM48_MT_CC_MODIFY_COMPL;
2671
2672 /* bearer capability */
Harald Weltefdc93d92010-03-07 23:40:35 +01002673 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte03740842009-06-10 23:11:52 +08002674
2675 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2676
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002677 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002678}
2679
2680static int gsm48_cc_rx_modify_reject(struct gsm_trans *trans, struct msgb *msg)
2681{
2682 struct gsm48_hdr *gh = msgb_l3(msg);
2683 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2684 struct tlv_parsed tp;
2685 struct gsm_mncc modify;
2686
2687 gsm48_stop_cc_timer(trans);
2688
2689 memset(&modify, 0, sizeof(struct gsm_mncc));
2690 modify.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002691 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, GSM48_IE_CAUSE);
Harald Welte03740842009-06-10 23:11:52 +08002692 /* bearer capability */
2693 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2694 modify.fields |= GSM48_IE_BEARER_CAP;
Harald Weltefdc93d92010-03-07 23:40:35 +01002695 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte03740842009-06-10 23:11:52 +08002696 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2697 }
2698 /* cause */
2699 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2700 modify.fields |= MNCC_F_CAUSE;
Harald Weltefdc93d92010-03-07 23:40:35 +01002701 gsm48_decode_cause(&modify.cause,
Harald Welte03740842009-06-10 23:11:52 +08002702 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2703 }
2704
2705 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2706
Harald Welte0abe5a62009-07-23 19:06:52 +02002707 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_REJ, &modify);
Harald Welte03740842009-06-10 23:11:52 +08002708}
2709
2710static int gsm48_cc_tx_modify_reject(struct gsm_trans *trans, void *arg)
2711{
2712 struct gsm_mncc *modify = arg;
2713 struct msgb *msg = gsm48_msgb_alloc();
2714 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2715
Harald Welte03740842009-06-10 23:11:52 +08002716 gh->msg_type = GSM48_MT_CC_MODIFY_REJECT;
2717
2718 /* bearer capability */
Harald Weltefdc93d92010-03-07 23:40:35 +01002719 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte03740842009-06-10 23:11:52 +08002720 /* cause */
Harald Weltefdc93d92010-03-07 23:40:35 +01002721 gsm48_encode_cause(msg, 1, &modify->cause);
Harald Welte03740842009-06-10 23:11:52 +08002722
2723 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2724
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002725 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002726}
2727
2728static int gsm48_cc_tx_notify(struct gsm_trans *trans, void *arg)
2729{
2730 struct gsm_mncc *notify = arg;
2731 struct msgb *msg = gsm48_msgb_alloc();
2732 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2733
Harald Welte03740842009-06-10 23:11:52 +08002734 gh->msg_type = GSM48_MT_CC_NOTIFY;
2735
2736 /* notify */
Harald Weltefdc93d92010-03-07 23:40:35 +01002737 gsm48_encode_notify(msg, notify->notify);
Harald Welte03740842009-06-10 23:11:52 +08002738
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002739 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002740}
2741
2742static int gsm48_cc_rx_notify(struct gsm_trans *trans, struct msgb *msg)
2743{
2744 struct gsm48_hdr *gh = msgb_l3(msg);
2745 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2746// struct tlv_parsed tp;
2747 struct gsm_mncc notify;
2748
2749 memset(&notify, 0, sizeof(struct gsm_mncc));
2750 notify.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002751// tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len);
Harald Welte03740842009-06-10 23:11:52 +08002752 if (payload_len >= 1)
Harald Weltefdc93d92010-03-07 23:40:35 +01002753 gsm48_decode_notify(&notify.notify, gh->data);
Harald Welte03740842009-06-10 23:11:52 +08002754
Harald Welte0abe5a62009-07-23 19:06:52 +02002755 return mncc_recvmsg(trans->subscr->net, trans, MNCC_NOTIFY_IND, &notify);
Harald Welte03740842009-06-10 23:11:52 +08002756}
2757
2758static int gsm48_cc_tx_userinfo(struct gsm_trans *trans, void *arg)
2759{
2760 struct gsm_mncc *user = arg;
2761 struct msgb *msg = gsm48_msgb_alloc();
2762 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2763
Harald Welte03740842009-06-10 23:11:52 +08002764 gh->msg_type = GSM48_MT_CC_USER_INFO;
2765
2766 /* user-user */
2767 if (user->fields & MNCC_F_USERUSER)
Harald Weltefdc93d92010-03-07 23:40:35 +01002768 gsm48_encode_useruser(msg, 1, &user->useruser);
Harald Welte03740842009-06-10 23:11:52 +08002769 /* more data */
2770 if (user->more)
Harald Weltefdc93d92010-03-07 23:40:35 +01002771 gsm48_encode_more(msg);
Harald Welte03740842009-06-10 23:11:52 +08002772
Holger Hans Peter Freyther5bc4d1d2010-06-15 13:57:40 +08002773 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte03740842009-06-10 23:11:52 +08002774}
2775
2776static int gsm48_cc_rx_userinfo(struct gsm_trans *trans, struct msgb *msg)
2777{
2778 struct gsm48_hdr *gh = msgb_l3(msg);
2779 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2780 struct tlv_parsed tp;
2781 struct gsm_mncc user;
2782
2783 memset(&user, 0, sizeof(struct gsm_mncc));
2784 user.callref = trans->callref;
Harald Welte705f2942010-03-02 23:18:30 +01002785 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_USER_USER, 0);
Harald Welte03740842009-06-10 23:11:52 +08002786 /* user-user */
2787 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2788 user.fields |= MNCC_F_USERUSER;
Harald Weltefdc93d92010-03-07 23:40:35 +01002789 gsm48_decode_useruser(&user.useruser,
Harald Welte03740842009-06-10 23:11:52 +08002790 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2791 }
2792 /* more data */
2793 if (TLVP_PRESENT(&tp, GSM48_IE_MORE_DATA))
2794 user.more = 1;
2795
Harald Welte0abe5a62009-07-23 19:06:52 +02002796 return mncc_recvmsg(trans->subscr->net, trans, MNCC_USERINFO_IND, &user);
Harald Welte03740842009-06-10 23:11:52 +08002797}
2798
Holger Hans Peter Freythercf0f3362009-10-22 15:13:00 +02002799static int _gsm48_lchan_modify(struct gsm_trans *trans, void *arg)
Harald Welte03740842009-06-10 23:11:52 +08002800{
2801 struct gsm_mncc *mode = arg;
2802
Holger Hans Peter Freyther3f6430d2011-01-16 18:17:04 +01002803 return gsm0808_assign_req(trans->conn, mode->lchan_mode, 1);
Harald Welte03740842009-06-10 23:11:52 +08002804}
2805
2806static struct downstate {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02002807 uint32_t states;
Harald Welte03740842009-06-10 23:11:52 +08002808 int type;
2809 int (*rout) (struct gsm_trans *trans, void *arg);
2810} downstatelist[] = {
2811 /* mobile originating call establishment */
2812 {SBIT(GSM_CSTATE_INITIATED), /* 5.2.1.2 */
2813 MNCC_CALL_PROC_REQ, gsm48_cc_tx_call_proc},
2814 {SBIT(GSM_CSTATE_INITIATED) | SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.2 | 5.2.1.5 */
2815 MNCC_ALERT_REQ, gsm48_cc_tx_alerting},
2816 {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 */
2817 MNCC_SETUP_RSP, gsm48_cc_tx_connect},
2818 {SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.4.2 */
2819 MNCC_PROGRESS_REQ, gsm48_cc_tx_progress},
2820 /* mobile terminating call establishment */
2821 {SBIT(GSM_CSTATE_NULL), /* 5.2.2.1 */
2822 MNCC_SETUP_REQ, gsm48_cc_tx_setup},
2823 {SBIT(GSM_CSTATE_CONNECT_REQUEST),
2824 MNCC_SETUP_COMPL_REQ, gsm48_cc_tx_connect_ack},
2825 /* signalling during call */
2826 {SBIT(GSM_CSTATE_ACTIVE),
2827 MNCC_NOTIFY_REQ, gsm48_cc_tx_notify},
2828 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ),
2829 MNCC_FACILITY_REQ, gsm48_cc_tx_facility},
2830 {ALL_STATES,
2831 MNCC_START_DTMF_RSP, gsm48_cc_tx_start_dtmf_ack},
2832 {ALL_STATES,
2833 MNCC_START_DTMF_REJ, gsm48_cc_tx_start_dtmf_rej},
2834 {ALL_STATES,
2835 MNCC_STOP_DTMF_RSP, gsm48_cc_tx_stop_dtmf_ack},
2836 {SBIT(GSM_CSTATE_ACTIVE),
2837 MNCC_HOLD_CNF, gsm48_cc_tx_hold_ack},
2838 {SBIT(GSM_CSTATE_ACTIVE),
2839 MNCC_HOLD_REJ, gsm48_cc_tx_hold_rej},
2840 {SBIT(GSM_CSTATE_ACTIVE),
2841 MNCC_RETRIEVE_CNF, gsm48_cc_tx_retrieve_ack},
2842 {SBIT(GSM_CSTATE_ACTIVE),
2843 MNCC_RETRIEVE_REJ, gsm48_cc_tx_retrieve_rej},
2844 {SBIT(GSM_CSTATE_ACTIVE),
2845 MNCC_MODIFY_REQ, gsm48_cc_tx_modify},
2846 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
2847 MNCC_MODIFY_RSP, gsm48_cc_tx_modify_complete},
2848 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
2849 MNCC_MODIFY_REJ, gsm48_cc_tx_modify_reject},
2850 {SBIT(GSM_CSTATE_ACTIVE),
2851 MNCC_USERINFO_REQ, gsm48_cc_tx_userinfo},
2852 /* clearing */
2853 {SBIT(GSM_CSTATE_INITIATED),
2854 MNCC_REJ_REQ, gsm48_cc_tx_release_compl},
2855 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_DISCONNECT_IND) - SBIT(GSM_CSTATE_RELEASE_REQ) - SBIT(GSM_CSTATE_DISCONNECT_REQ), /* 5.4.4 */
2856 MNCC_DISC_REQ, gsm48_cc_tx_disconnect},
2857 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
2858 MNCC_REL_REQ, gsm48_cc_tx_release},
2859 /* special */
2860 {ALL_STATES,
Holger Hans Peter Freythercf0f3362009-10-22 15:13:00 +02002861 MNCC_LCHAN_MODIFY, _gsm48_lchan_modify},
Harald Welte03740842009-06-10 23:11:52 +08002862};
2863
2864#define DOWNSLLEN \
2865 (sizeof(downstatelist) / sizeof(struct downstate))
2866
2867
Harald Weltef4e4b8a2010-12-22 23:57:45 +01002868int mncc_tx_to_cc(struct gsm_network *net, int msg_type, void *arg)
Harald Welte03740842009-06-10 23:11:52 +08002869{
Harald Welteaa60edb2009-08-09 18:52:33 +02002870 int i, rc = 0;
Harald Welte03740842009-06-10 23:11:52 +08002871 struct gsm_trans *trans = NULL, *transt;
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08002872 struct gsm_subscriber_connection *conn = NULL;
Holger Hans Peter Freyther50366f22010-12-27 16:02:25 +01002873 struct gsm_bts *bts = NULL;
Harald Welte03740842009-06-10 23:11:52 +08002874 struct gsm_mncc *data = arg, rel;
2875
Harald Welte17b56522010-12-22 21:45:05 +01002876 DEBUGP(DMNCC, "receive message %s\n", get_mncc_name(msg_type));
2877
Harald Welte03740842009-06-10 23:11:52 +08002878 /* handle special messages */
2879 switch(msg_type) {
2880 case MNCC_BRIDGE:
2881 return tch_bridge(net, arg);
2882 case MNCC_FRAME_DROP:
Harald Welte3971ad52009-12-19 22:23:05 +01002883 return tch_recv_mncc(net, data->callref, 0);
Harald Welte03740842009-06-10 23:11:52 +08002884 case MNCC_FRAME_RECV:
Harald Welte3971ad52009-12-19 22:23:05 +01002885 return tch_recv_mncc(net, data->callref, 1);
2886 case GSM_TCHF_FRAME:
2887 /* Find callref */
2888 trans = trans_find_by_callref(net, data->callref);
Harald Welte17b56522010-12-22 21:45:05 +01002889 if (!trans) {
2890 LOGP(DMNCC, LOGL_ERROR, "TCH frame for non-existing trans\n");
Harald Welte3971ad52009-12-19 22:23:05 +01002891 return -EIO;
Harald Welte17b56522010-12-22 21:45:05 +01002892 }
2893 if (!trans->conn) {
2894 LOGP(DMNCC, LOGL_NOTICE, "TCH frame for trans without conn\n");
Harald Welte3971ad52009-12-19 22:23:05 +01002895 return 0;
Harald Welte17b56522010-12-22 21:45:05 +01002896 }
2897 if (trans->conn->lchan->type != GSM_LCHAN_TCH_F) {
2898 /* This should be LOGL_ERROR or NOTICE, but
2899 * unfortuantely it happens for a couple of frames at
2900 * the beginning of every RTP connection */
2901 LOGP(DMNCC, LOGL_DEBUG, "TCH frame for lchan != TCH_F\n");
Harald Welte3971ad52009-12-19 22:23:05 +01002902 return 0;
Harald Welte17b56522010-12-22 21:45:05 +01002903 }
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01002904 bts = trans->conn->lchan->ts->trx->bts;
Harald Welte3971ad52009-12-19 22:23:05 +01002905 switch (bts->type) {
2906 case GSM_BTS_TYPE_NANOBTS:
Harald Welte35ac0e42012-07-02 19:51:55 +02002907 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte17b56522010-12-22 21:45:05 +01002908 if (!trans->conn->lchan->abis_ip.rtp_socket) {
Harald Welte45d6e4d2010-12-24 12:40:21 +01002909 DEBUGP(DMNCC, "TCH frame to lchan without RTP connection\n");
Harald Welte3971ad52009-12-19 22:23:05 +01002910 return 0;
Harald Welte17b56522010-12-22 21:45:05 +01002911 }
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01002912 return rtp_send_frame(trans->conn->lchan->abis_ip.rtp_socket, arg);
Harald Welte3971ad52009-12-19 22:23:05 +01002913 case GSM_BTS_TYPE_BS11:
Harald Weltef39e3b52011-03-20 06:27:31 -03002914 case GSM_BTS_TYPE_RBS2000:
Harald Weltec0cf0022011-08-05 20:11:18 +02002915 case GSM_BTS_TYPE_NOKIA_SITE:
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01002916 return trau_send_frame(trans->conn->lchan, arg);
Harald Welte3971ad52009-12-19 22:23:05 +01002917 default:
Harald Welte8099a712011-08-09 21:53:20 +02002918 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welte3971ad52009-12-19 22:23:05 +01002919 }
2920 return -EINVAL;
Harald Welte03740842009-06-10 23:11:52 +08002921 }
2922
2923 memset(&rel, 0, sizeof(struct gsm_mncc));
2924 rel.callref = data->callref;
2925
2926 /* Find callref */
Harald Weltec2189a62009-07-23 18:56:43 +02002927 trans = trans_find_by_callref(net, data->callref);
Harald Welte03740842009-06-10 23:11:52 +08002928
2929 /* Callref unknown */
2930 if (!trans) {
Holger Hans Peter Freythere2a3c9f2009-10-27 14:21:14 +01002931 struct gsm_subscriber *subscr;
2932
Harald Welte6e1536e2009-07-04 10:11:24 +02002933 if (msg_type != MNCC_SETUP_REQ) {
Harald Welte03740842009-06-10 23:11:52 +08002934 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2935 "Received '%s' from MNCC with "
2936 "unknown callref %d\n", data->called.number,
2937 get_mncc_name(msg_type), data->callref);
2938 /* Invalid call reference */
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08002939 return mncc_release_ind(net, NULL, data->callref,
2940 GSM48_CAUSE_LOC_PRN_S_LU,
2941 GSM48_CC_CAUSE_INVAL_TRANS_ID);
Harald Welte03740842009-06-10 23:11:52 +08002942 }
Andreas Eversberg9eaa5da2009-06-15 23:22:09 +02002943 if (!data->called.number[0] && !data->imsi[0]) {
2944 DEBUGP(DCC, "(bts - trx - ts - ti) "
2945 "Received '%s' from MNCC with "
2946 "no number or IMSI\n", get_mncc_name(msg_type));
2947 /* Invalid number */
2948 return mncc_release_ind(net, NULL, data->callref,
2949 GSM48_CAUSE_LOC_PRN_S_LU,
2950 GSM48_CC_CAUSE_INV_NR_FORMAT);
2951 }
Harald Welte03740842009-06-10 23:11:52 +08002952 /* New transaction due to setup, find subscriber */
Andreas Eversberg9eaa5da2009-06-15 23:22:09 +02002953 if (data->called.number[0])
Harald Welte75350412009-07-23 18:46:00 +02002954 subscr = subscr_get_by_extension(net,
2955 data->called.number);
Andreas Eversberg9eaa5da2009-06-15 23:22:09 +02002956 else
Harald Welte75350412009-07-23 18:46:00 +02002957 subscr = subscr_get_by_imsi(net, data->imsi);
Harald Welte03740842009-06-10 23:11:52 +08002958 /* If subscriber is not found */
2959 if (!subscr) {
2960 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2961 "Received '%s' from MNCC with "
2962 "unknown subscriber %s\n", data->called.number,
2963 get_mncc_name(msg_type), data->called.number);
2964 /* Unknown subscriber */
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08002965 return mncc_release_ind(net, NULL, data->callref,
2966 GSM48_CAUSE_LOC_PRN_S_LU,
2967 GSM48_CC_CAUSE_UNASSIGNED_NR);
Harald Welte03740842009-06-10 23:11:52 +08002968 }
2969 /* If subscriber is not "attached" */
2970 if (!subscr->lac) {
2971 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2972 "Received '%s' from MNCC with "
2973 "detached subscriber %s\n", data->called.number,
2974 get_mncc_name(msg_type), data->called.number);
2975 subscr_put(subscr);
2976 /* Temporarily out of order */
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08002977 return mncc_release_ind(net, NULL, data->callref,
2978 GSM48_CAUSE_LOC_PRN_S_LU,
2979 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte03740842009-06-10 23:11:52 +08002980 }
2981 /* Create transaction */
Harald Weltec2189a62009-07-23 18:56:43 +02002982 trans = trans_alloc(subscr, GSM48_PDISC_CC, 0xff, data->callref);
2983 if (!trans) {
Harald Welte03740842009-06-10 23:11:52 +08002984 DEBUGP(DCC, "No memory for trans.\n");
2985 subscr_put(subscr);
2986 /* Ressource unavailable */
Andreas Eversbergb992a8a2009-06-14 22:14:12 +08002987 mncc_release_ind(net, NULL, data->callref,
2988 GSM48_CAUSE_LOC_PRN_S_LU,
2989 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte03740842009-06-10 23:11:52 +08002990 return -ENOMEM;
2991 }
Harald Welte03740842009-06-10 23:11:52 +08002992 /* Find lchan */
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08002993 conn = connection_for_subscr(subscr);
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +01002994
Harald Welte03740842009-06-10 23:11:52 +08002995 /* If subscriber has no lchan */
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08002996 if (!conn) {
Harald Welte03740842009-06-10 23:11:52 +08002997 /* find transaction with this subscriber already paging */
2998 llist_for_each_entry(transt, &net->trans_list, entry) {
2999 /* Transaction of our lchan? */
3000 if (transt == trans ||
3001 transt->subscr != subscr)
3002 continue;
Holger Hans Peter Freyther346074d2010-12-27 16:08:34 +01003003 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Harald Welte03740842009-06-10 23:11:52 +08003004 "Received '%s' from MNCC with "
3005 "unallocated channel, paging already "
Holger Hans Peter Freyther346074d2010-12-27 16:08:34 +01003006 "started for lac %d.\n",
Harald Welte03740842009-06-10 23:11:52 +08003007 data->called.number,
Holger Hans Peter Freyther346074d2010-12-27 16:08:34 +01003008 get_mncc_name(msg_type), subscr->lac);
Holger Hans Peter Freythere2a3c9f2009-10-27 14:21:14 +01003009 subscr_put(subscr);
3010 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08003011 return 0;
3012 }
3013 /* store setup informations until paging was successfull */
Harald Weltec2189a62009-07-23 18:56:43 +02003014 memcpy(&trans->cc.msg, data, sizeof(struct gsm_mncc));
Sylvain Munaut892f6952010-12-01 22:17:36 +01003015
3016 /* Get a channel */
Holger Hans Peter Freyther02539b12010-12-29 17:09:07 +01003017 trans->paging_request = talloc_zero(subscr->net, struct gsm_network*);
3018 if (!trans->paging_request) {
3019 LOGP(DCC, LOGL_ERROR, "Failed to allocate paging token.\n");
3020 subscr_put(subscr);
3021 trans_free(trans);
3022 return 0;
3023 }
3024
3025 *trans->paging_request = subscr->net;
3026 subscr_get_channel(subscr, RSL_CHANNEED_TCH_F, setup_trig_pag_evt, trans->paging_request);
Sylvain Munaut892f6952010-12-01 22:17:36 +01003027
Holger Hans Peter Freythere2a3c9f2009-10-27 14:21:14 +01003028 subscr_put(subscr);
Harald Welte03740842009-06-10 23:11:52 +08003029 return 0;
3030 }
3031 /* Assign lchan */
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08003032 trans->conn = conn;
Holger Hans Peter Freythere2a3c9f2009-10-27 14:21:14 +01003033 subscr_put(subscr);
Harald Welte03740842009-06-10 23:11:52 +08003034 }
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01003035
3036 if (trans->conn)
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08003037 conn = trans->conn;
Harald Welte03740842009-06-10 23:11:52 +08003038
3039 /* if paging did not respond yet */
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08003040 if (!conn) {
Harald Welte03740842009-06-10 23:11:52 +08003041 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02003042 "Received '%s' from MNCC in paging state\n",
Harald Welte03740842009-06-10 23:11:52 +08003043 (trans->subscr)?(trans->subscr->extension):"-",
3044 get_mncc_name(msg_type));
Harald Weltebbc636a2009-06-11 14:23:20 +08003045 mncc_set_cause(&rel, GSM48_CAUSE_LOC_PRN_S_LU,
3046 GSM48_CC_CAUSE_NORM_CALL_CLEAR);
Harald Welte03740842009-06-10 23:11:52 +08003047 if (msg_type == MNCC_REL_REQ)
3048 rc = mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
3049 else
3050 rc = mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
3051 trans->callref = 0;
Harald Weltec2189a62009-07-23 18:56:43 +02003052 trans_free(trans);
Harald Welte03740842009-06-10 23:11:52 +08003053 return rc;
3054 }
3055
3056 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x sub %s) "
3057 "Received '%s' from MNCC in state %d (%s)\n",
Holger Hans Peter Freyther2f4af772010-06-16 13:23:55 +08003058 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Harald Welte03740842009-06-10 23:11:52 +08003059 trans->transaction_id,
Holger Hans Peter Freyther4009da42010-03-23 07:00:22 +01003060 (trans->conn->subscr)?(trans->conn->subscr->extension):"-",
Harald Weltec2189a62009-07-23 18:56:43 +02003061 get_mncc_name(msg_type), trans->cc.state,
Harald Welteb30935e2010-03-25 12:13:02 +08003062 gsm48_cc_state_name(trans->cc.state));
Harald Welte03740842009-06-10 23:11:52 +08003063
3064 /* Find function for current state and message */
3065 for (i = 0; i < DOWNSLLEN; i++)
3066 if ((msg_type == downstatelist[i].type)
Harald Weltec2189a62009-07-23 18:56:43 +02003067 && ((1 << trans->cc.state) & downstatelist[i].states))
Harald Welte03740842009-06-10 23:11:52 +08003068 break;
3069 if (i == DOWNSLLEN) {
3070 DEBUGP(DCC, "Message unhandled at this state.\n");
3071 return 0;
3072 }
3073
3074 rc = downstatelist[i].rout(trans, arg);
3075
3076 return rc;
3077}
3078
3079
3080static struct datastate {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02003081 uint32_t states;
Harald Welte03740842009-06-10 23:11:52 +08003082 int type;
3083 int (*rout) (struct gsm_trans *trans, struct msgb *msg);
3084} datastatelist[] = {
3085 /* mobile originating call establishment */
3086 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3087 GSM48_MT_CC_SETUP, gsm48_cc_rx_setup},
3088 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3089 GSM48_MT_CC_EMERG_SETUP, gsm48_cc_rx_setup},
3090 {SBIT(GSM_CSTATE_CONNECT_IND), /* 5.2.1.2 */
3091 GSM48_MT_CC_CONNECT_ACK, gsm48_cc_rx_connect_ack},
3092 /* mobile terminating call establishment */
3093 {SBIT(GSM_CSTATE_CALL_PRESENT), /* 5.2.2.3.2 */
3094 GSM48_MT_CC_CALL_CONF, gsm48_cc_rx_call_conf},
3095 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF), /* ???? | 5.2.2.3.2 */
3096 GSM48_MT_CC_ALERTING, gsm48_cc_rx_alerting},
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02003097 {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 Welte03740842009-06-10 23:11:52 +08003098 GSM48_MT_CC_CONNECT, gsm48_cc_rx_connect},
3099 /* signalling during call */
3100 {ALL_STATES - SBIT(GSM_CSTATE_NULL),
3101 GSM48_MT_CC_FACILITY, gsm48_cc_rx_facility},
3102 {SBIT(GSM_CSTATE_ACTIVE),
3103 GSM48_MT_CC_NOTIFY, gsm48_cc_rx_notify},
3104 {ALL_STATES,
3105 GSM48_MT_CC_START_DTMF, gsm48_cc_rx_start_dtmf},
3106 {ALL_STATES,
3107 GSM48_MT_CC_STOP_DTMF, gsm48_cc_rx_stop_dtmf},
3108 {ALL_STATES,
3109 GSM48_MT_CC_STATUS_ENQ, gsm48_cc_rx_status_enq},
3110 {SBIT(GSM_CSTATE_ACTIVE),
3111 GSM48_MT_CC_HOLD, gsm48_cc_rx_hold},
3112 {SBIT(GSM_CSTATE_ACTIVE),
3113 GSM48_MT_CC_RETR, gsm48_cc_rx_retrieve},
3114 {SBIT(GSM_CSTATE_ACTIVE),
3115 GSM48_MT_CC_MODIFY, gsm48_cc_rx_modify},
3116 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3117 GSM48_MT_CC_MODIFY_COMPL, gsm48_cc_rx_modify_complete},
3118 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3119 GSM48_MT_CC_MODIFY_REJECT, gsm48_cc_rx_modify_reject},
3120 {SBIT(GSM_CSTATE_ACTIVE),
3121 GSM48_MT_CC_USER_INFO, gsm48_cc_rx_userinfo},
3122 /* clearing */
3123 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3124 GSM48_MT_CC_DISCONNECT, gsm48_cc_rx_disconnect},
3125 {ALL_STATES - SBIT(GSM_CSTATE_NULL), /* 5.4.4.1.2.2 */
3126 GSM48_MT_CC_RELEASE, gsm48_cc_rx_release},
3127 {ALL_STATES, /* 5.4.3.4 */
3128 GSM48_MT_CC_RELEASE_COMPL, gsm48_cc_rx_release_compl},
3129};
3130
3131#define DATASLLEN \
3132 (sizeof(datastatelist) / sizeof(struct datastate))
3133
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003134static int gsm0408_rcv_cc(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08003135{
3136 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02003137 uint8_t msg_type = gh->msg_type & 0xbf;
3138 uint8_t transaction_id = ((gh->proto_discr & 0xf0) ^ 0x80) >> 4; /* flip */
Harald Weltec2189a62009-07-23 18:56:43 +02003139 struct gsm_trans *trans = NULL;
Harald Welte03740842009-06-10 23:11:52 +08003140 int i, rc = 0;
Harald Welte59b04682009-06-10 05:40:52 +08003141
Harald Welte03740842009-06-10 23:11:52 +08003142 if (msg_type & 0x80) {
3143 DEBUGP(DCC, "MSG 0x%2x not defined for PD error\n", msg_type);
3144 return -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08003145 }
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +01003146
Harald Welte03740842009-06-10 23:11:52 +08003147 /* Find transaction */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +01003148 trans = trans_find_by_id(conn->subscr, GSM48_PDISC_CC, transaction_id);
Harald Weltec2189a62009-07-23 18:56:43 +02003149
Harald Welte4861c822009-07-23 21:21:14 +02003150 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte03740842009-06-10 23:11:52 +08003151 "Received '%s' from MS in state %d (%s)\n",
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003152 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +01003153 transaction_id, (conn->subscr)?(conn->subscr->extension):"-",
Harald Welteb30935e2010-03-25 12:13:02 +08003154 gsm48_cc_msg_name(msg_type), trans?(trans->cc.state):0,
3155 gsm48_cc_state_name(trans?(trans->cc.state):0));
Harald Welte03740842009-06-10 23:11:52 +08003156
3157 /* Create transaction */
3158 if (!trans) {
Harald Welte4861c822009-07-23 21:21:14 +02003159 DEBUGP(DCC, "Unknown transaction ID %x, "
Harald Welte03740842009-06-10 23:11:52 +08003160 "creating new trans.\n", transaction_id);
3161 /* Create transaction */
Holger Hans Peter Freyther065b8112010-03-23 06:41:45 +01003162 trans = trans_alloc(conn->subscr, GSM48_PDISC_CC,
Harald Weltec2189a62009-07-23 18:56:43 +02003163 transaction_id, new_callref++);
3164 if (!trans) {
Harald Welte03740842009-06-10 23:11:52 +08003165 DEBUGP(DCC, "No memory for trans.\n");
Holger Hans Peter Freyther3f6430d2011-01-16 18:17:04 +01003166 rc = gsm48_tx_simple(conn,
Harald Welte4861c822009-07-23 21:21:14 +02003167 GSM48_PDISC_CC | (transaction_id << 4),
Harald Welte03740842009-06-10 23:11:52 +08003168 GSM48_MT_CC_RELEASE_COMPL);
3169 return -ENOMEM;
3170 }
Harald Welte03740842009-06-10 23:11:52 +08003171 /* Assign transaction */
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003172 trans->conn = conn;
Harald Welte03740842009-06-10 23:11:52 +08003173 }
3174
3175 /* find function for current state and message */
3176 for (i = 0; i < DATASLLEN; i++)
3177 if ((msg_type == datastatelist[i].type)
Harald Weltec2189a62009-07-23 18:56:43 +02003178 && ((1 << trans->cc.state) & datastatelist[i].states))
Harald Welte03740842009-06-10 23:11:52 +08003179 break;
3180 if (i == DATASLLEN) {
3181 DEBUGP(DCC, "Message unhandled at this state.\n");
3182 return 0;
3183 }
3184
Holger Hans Peter Freytherac009e52013-07-06 11:45:38 +02003185 assert(trans->subscr);
3186
Harald Welte03740842009-06-10 23:11:52 +08003187 rc = datastatelist[i].rout(trans, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003188
3189 return rc;
3190}
3191
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003192/* Create a dummy to wait five seconds */
3193static void release_anchor(struct gsm_subscriber_connection *conn)
3194{
3195 if (!conn->anch_operation)
3196 return;
3197
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02003198 osmo_timer_del(&conn->anch_operation->timeout);
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003199 talloc_free(conn->anch_operation);
3200 conn->anch_operation = NULL;
3201}
3202
3203static void anchor_timeout(void *_data)
3204{
3205 struct gsm_subscriber_connection *con = _data;
3206
3207 release_anchor(con);
3208 msc_release_connection(con);
3209}
3210
3211int gsm0408_new_conn(struct gsm_subscriber_connection *conn)
3212{
3213 conn->anch_operation = talloc_zero(conn, struct gsm_anchor_operation);
3214 if (!conn->anch_operation)
3215 return -1;
3216
3217 conn->anch_operation->timeout.data = conn;
3218 conn->anch_operation->timeout.cb = anchor_timeout;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02003219 osmo_timer_schedule(&conn->anch_operation->timeout, 5, 0);
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003220 return 0;
3221}
3222
Holger Hans Peter Freytherb9795792010-06-17 16:41:25 +08003223/* here we get data from the BSC level... */
3224int gsm0408_dispatch(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08003225{
3226 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02003227 uint8_t pdisc = gh->proto_discr & 0x0f;
Harald Welte59b04682009-06-10 05:40:52 +08003228 int rc = 0;
Harald Weltef6a38ec2009-12-29 11:49:12 +01003229
Holger Hans Peter Freyther48549392010-06-21 10:34:03 +08003230 if (silent_call_reroute(conn, msg))
3231 return silent_call_rx(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003232
3233 switch (pdisc) {
3234 case GSM48_PDISC_CC:
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003235 release_anchor(conn);
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003236 rc = gsm0408_rcv_cc(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003237 break;
3238 case GSM48_PDISC_MM:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003239 rc = gsm0408_rcv_mm(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003240 break;
3241 case GSM48_PDISC_RR:
Holger Hans Peter Freyther96aeb2b2010-06-17 17:14:35 +08003242 rc = gsm0408_rcv_rr(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003243 break;
3244 case GSM48_PDISC_SMS:
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003245 release_anchor(conn);
Holger Hans Peter Freytherb9795792010-06-17 16:41:25 +08003246 rc = gsm0411_rcv_sms(conn, msg);
Harald Welte59b04682009-06-10 05:40:52 +08003247 break;
3248 case GSM48_PDISC_MM_GPRS:
3249 case GSM48_PDISC_SM_GPRS:
Harald Welte60e5f4f2009-12-24 12:13:17 +01003250 LOGP(DRLL, LOGL_NOTICE, "Unimplemented "
3251 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Harald Welte59b04682009-06-10 05:40:52 +08003252 break;
Harald Welte03115042009-10-16 08:32:58 +02003253 case GSM48_PDISC_NC_SS:
Holger Hans Peter Freyther425cfc42010-07-05 15:34:16 +08003254 release_anchor(conn);
Holger Hans Peter Freyther320c5e12010-06-17 17:35:57 +08003255 rc = handle_rcv_ussd(conn, msg);
Harald Welte03115042009-10-16 08:32:58 +02003256 break;
Harald Welte59b04682009-06-10 05:40:52 +08003257 default:
Harald Welte60e5f4f2009-12-24 12:13:17 +01003258 LOGP(DRLL, LOGL_NOTICE, "Unknown "
3259 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Harald Welte59b04682009-06-10 05:40:52 +08003260 break;
3261 }
3262
3263 return rc;
3264}
3265
Harald Welte3c062072009-07-28 18:25:29 +02003266/*
3267 * This will be ran by the linker when loading the DSO. We use it to
3268 * do system initialization, e.g. registration of signal handlers.
3269 */
3270static __attribute__((constructor)) void on_dso_load_0408(void)
3271{
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02003272 osmo_signal_register_handler(SS_ABISIP, handle_abisip_signal, NULL);
Harald Welte3c062072009-07-28 18:25:29 +02003273}