blob: 65e6fcc994779033174093e68f8c1587f4d98cbf [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Mobile Radio Interface Layer 3 messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 04.08 version 7.21.0 Release 1998 / ETSI TS 100 940 V7.21.0 */
3
Harald Weltebf5e8df2009-02-03 12:59:45 +00004/* (C) 2008-2009 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01005 * (C) 2008-2012 by Holger Hans Peter Freyther <zecke@selfish.org>
Harald Welte8470bf22008-12-25 23:28:35 +00006 *
Harald Welte52b1f982008-12-23 20:25:15 +00007 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +010010 * it under the terms of the GNU Affero General Public License as published by
11 * the Free Software Foundation; either version 3 of the License, or
Harald Welte52b1f982008-12-23 20:25:15 +000012 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010017 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000018 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010019 * You should have received a copy of the GNU Affero General Public License
20 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte52b1f982008-12-23 20:25:15 +000021 *
22 */
23
24
25#include <stdio.h>
26#include <stdlib.h>
27#include <string.h>
28#include <errno.h>
Harald Weltedb253af2008-12-30 17:56:55 +000029#include <time.h>
Harald Welte4b634542008-12-27 01:55:51 +000030#include <netinet/in.h>
Harald Welte52b1f982008-12-23 20:25:15 +000031
Harald Welte9c3dc902012-04-08 16:59:24 +020032#include "bscconfig.h"
33
Sylvain Munaut30a15382009-12-24 00:27:26 +010034#include <openbsc/auth.h>
Harald Welte75a983f2008-12-27 21:34:06 +000035#include <openbsc/db.h>
Harald Welte8470bf22008-12-25 23:28:35 +000036#include <openbsc/debug.h>
37#include <openbsc/gsm_data.h>
38#include <openbsc/gsm_subscriber.h>
Daniel Willmann8b3390e2008-12-28 00:31:09 +000039#include <openbsc/gsm_04_11.h>
Harald Welte8470bf22008-12-25 23:28:35 +000040#include <openbsc/gsm_04_08.h>
Holger Hans Peter Freythere0009f12010-08-12 01:41:57 +080041#include <openbsc/gsm_04_80.h>
Harald Welte8470bf22008-12-25 23:28:35 +000042#include <openbsc/abis_rsl.h>
Holger Freytherca362a62009-01-04 21:05:01 +000043#include <openbsc/chan_alloc.h>
Harald Welte0b4c34e2009-02-09 17:54:43 +000044#include <openbsc/paging.h>
Holger Freyther053e09d2009-02-14 22:51:06 +000045#include <openbsc/signal.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020046#include <osmocom/abis/trau_frame.h>
Harald Welte11fa29c2009-02-19 17:24:39 +000047#include <openbsc/trau_mux.h>
Harald Welte805f6442009-07-28 18:25:29 +020048#include <openbsc/rtp_proxy.h>
Harald Weltedcaf5652009-07-23 18:56:43 +020049#include <openbsc/transaction.h>
Harald Welte6eafe912009-10-16 08:32:58 +020050#include <openbsc/ussd.h>
Harald Welte51008772009-12-29 11:49:12 +010051#include <openbsc/silent_call.h>
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080052#include <openbsc/bsc_api.h>
Holger Hans Peter Freyther88519ea2010-06-30 12:44:07 +080053#include <openbsc/osmo_msc.h>
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +010054#include <openbsc/handover.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020055#include <osmocom/abis/e1_input.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010056#include <osmocom/core/bitvec.h>
Holger Hans Peter Freyther841c2002010-09-30 18:52:23 +080057
Pablo Neira Ayuso136f4532011-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 Welte52b1f982008-12-23 20:25:15 +000064
Harald Welte (local)d19e58b2009-08-15 02:30:58 +020065void *tall_locop_ctx;
Sylvain Munaut30a15382009-12-24 00:27:26 +010066void *tall_authciphop_ctx;
Harald Welte2cf161b2009-06-20 22:36:41 +020067
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020068int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn, uint32_t tmsi);
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +080069static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020070 uint8_t pdisc, uint8_t msg_type);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +010071static void schedule_reject(struct gsm_subscriber_connection *conn);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +080072static void release_anchor(struct gsm_subscriber_connection *conn);
Harald Welte65e74cc2008-12-29 01:55:35 +000073
Harald Welte52b1f982008-12-23 20:25:15 +000074struct gsm_lai {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020075 uint16_t mcc;
76 uint16_t mnc;
77 uint16_t lac;
Harald Welte52b1f982008-12-23 20:25:15 +000078};
79
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020080static uint32_t new_callref = 0x80000001;
Harald Welte4bfdfe72009-06-10 23:11:52 +080081
Harald Welte31c00f72011-03-03 23:29:05 +010082void cc_tx_to_mncc(struct gsm_network *net, struct msgb *msg)
83{
84 net->mncc_recv(net, msg);
85}
86
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080087static int gsm48_conn_sendmsg(struct msgb *msg, struct gsm_subscriber_connection *conn,
88 struct gsm_trans *trans)
89{
90 struct gsm48_hdr *gh = (struct gsm48_hdr *) msg->data;
91
92 /* if we get passed a transaction reference, do some common
93 * work that the caller no longer has to do */
94 if (trans) {
95 gh->proto_discr = trans->protocol | (trans->transaction_id << 4);
96 msg->lchan = trans->conn->lchan;
97 }
98
99
100 if (msg->lchan) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200101 struct e1inp_sign_link *sign_link =
102 msg->lchan->ts->trx->rsl_link;
103
104 msg->dst = sign_link;
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800105 if ((gh->proto_discr & GSM48_PDISC_MASK) == GSM48_PDISC_CC)
106 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x) "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200107 "Sending '%s' to MS.\n",
108 sign_link->trx->bts->nr,
109 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800110 gh->proto_discr & 0xf0,
111 gsm48_cc_msg_name(gh->msg_type));
112 else
113 DEBUGP(DCC, "(bts %d trx %d ts %d pd %02x) "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200114 "Sending 0x%02x to MS.\n",
115 sign_link->trx->bts->nr,
116 sign_link->trx->nr, msg->lchan->ts->nr,
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800117 gh->proto_discr, gh->msg_type);
118 }
119
Holger Hans Peter Freyther8d380dc2010-11-10 10:16:02 +0100120 return gsm0808_submit_dtap(conn, msg, 0, 0);
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800121}
Sylvain Munaut30a15382009-12-24 00:27:26 +0100122
Holger Hans Peter Freythere0009f12010-08-12 01:41:57 +0800123int gsm48_cc_tx_notify_ss(struct gsm_trans *trans, const char *message)
124{
125 struct gsm48_hdr *gh;
126 struct msgb *ss_notify;
127
128 ss_notify = gsm0480_create_notifySS(message);
129 if (!ss_notify)
130 return -1;
131
132 gsm0480_wrap_invoke(ss_notify, GSM0480_OP_CODE_NOTIFY_SS, 0);
133 uint8_t *data = msgb_push(ss_notify, 1);
134 data[0] = ss_notify->len - 1;
135 gh = (struct gsm48_hdr *) msgb_push(ss_notify, sizeof(*gh));
136 gh->msg_type = GSM48_MT_CC_FACILITY;
137 return gsm48_conn_sendmsg(ss_notify, trans->conn, trans);
138}
139
Harald Weltecf149ee2012-01-23 16:40:24 +0100140void release_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100141{
142 if (!conn->sec_operation)
143 return;
144
145 talloc_free(conn->sec_operation);
146 conn->sec_operation = NULL;
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800147 msc_release_connection(conn);
Sylvain Munaut30a15382009-12-24 00:27:26 +0100148}
149
Harald Weltecf149ee2012-01-23 16:40:24 +0100150void allocate_security_operation(struct gsm_subscriber_connection *conn)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100151{
Sylvain Munaut30a15382009-12-24 00:27:26 +0100152 conn->sec_operation = talloc_zero(tall_authciphop_ctx,
153 struct gsm_security_operation);
154}
155
Sylvain Munaut0fbfd1b2010-12-01 22:37:05 +0100156int gsm48_secure_channel(struct gsm_subscriber_connection *conn, int key_seq,
157 gsm_cbfn *cb, void *cb_data)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100158{
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800159 struct gsm_network *net = conn->bts->network;
160 struct gsm_subscriber *subscr = conn->subscr;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100161 struct gsm_security_operation *op;
162 struct gsm_auth_tuple atuple;
163 int status = -1, rc;
164
165 /* Check if we _can_ enable encryption. Cases where we can't:
166 * - Encryption disabled in config
167 * - Channel already secured (nothing to do)
168 * - Subscriber equipment doesn't support configured encryption
169 */
170 if (!net->a5_encryption) {
171 status = GSM_SECURITY_NOAVAIL;
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800172 } else if (conn->lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100173 DEBUGP(DMM, "Requesting to secure an already secure channel");
174 status = GSM_SECURITY_SUCCEEDED;
175 } else if (!ms_cm2_a5n_support(subscr->equipment.classmark2,
176 net->a5_encryption)) {
177 DEBUGP(DMM, "Subscriber equipment doesn't support requested encryption");
178 status = GSM_SECURITY_NOAVAIL;
179 }
180
181 /* If not done yet, try to get info for this user */
182 if (status < 0) {
183 rc = auth_get_tuple_for_subscr(&atuple, subscr, key_seq);
184 if (rc <= 0)
185 status = GSM_SECURITY_NOAVAIL;
186 }
187
188 /* Are we done yet ? */
189 if (status >= 0)
190 return cb ?
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800191 cb(GSM_HOOK_RR_SECURITY, status, NULL, conn, cb_data) :
Sylvain Munaut30a15382009-12-24 00:27:26 +0100192 0;
193
194 /* Start an operation (can't have more than one pending !!!) */
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800195 if (conn->sec_operation)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100196 return -EBUSY;
197
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800198 allocate_security_operation(conn);
199 op = conn->sec_operation;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100200 op->cb = cb;
201 op->cb_data = cb_data;
202 memcpy(&op->atuple, &atuple, sizeof(struct gsm_auth_tuple));
203
204 /* FIXME: Should start a timer for completion ... */
205
206 /* Then do whatever is needed ... */
Harald Welte86dda082010-12-23 18:07:49 +0100207 if (rc == AUTH_DO_AUTH_THAN_CIPH) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100208 /* Start authentication */
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800209 return gsm48_tx_mm_auth_req(conn, op->atuple.rand, op->atuple.key_seq);
Harald Welte86dda082010-12-23 18:07:49 +0100210 } else if (rc == AUTH_DO_CIPH) {
Sylvain Munaut30a15382009-12-24 00:27:26 +0100211 /* Start ciphering directly */
Sylvain Munaut67706df2010-11-29 08:19:04 +0100212 return gsm0808_cipher_mode(conn, net->a5_encryption,
213 op->atuple.kc, 8, 0);
Sylvain Munaut30a15382009-12-24 00:27:26 +0100214 }
215
216 return -EINVAL; /* not reached */
217}
218
Holger Freyther73487a22008-12-31 18:53:57 +0000219static int authorize_subscriber(struct gsm_loc_updating_operation *loc,
220 struct gsm_subscriber *subscriber)
Holger Freyther89824fc2008-12-30 16:18:18 +0000221{
222 if (!subscriber)
223 return 0;
224
Holger Freyther73487a22008-12-31 18:53:57 +0000225 /*
226 * Do not send accept yet as more information should arrive. Some
227 * phones will not send us the information and we will have to check
228 * what we want to do with that.
229 */
230 if (loc && (loc->waiting_for_imsi || loc->waiting_for_imei))
231 return 0;
232
Jan Luebbe06513f22009-08-12 12:48:00 +0200233 switch (subscriber->net->auth_policy) {
234 case GSM_AUTH_POLICY_CLOSED:
235 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200236 case GSM_AUTH_POLICY_TOKEN:
Harald Welte (local)ee9afe32009-08-13 20:44:23 +0200237 if (subscriber->authorized)
238 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200239 return (subscriber->flags & GSM_SUBSCRIBER_FIRST_CONTACT);
Jan Luebbe06513f22009-08-12 12:48:00 +0200240 case GSM_AUTH_POLICY_ACCEPT_ALL:
Holger Freyther89824fc2008-12-30 16:18:18 +0000241 return 1;
Jan Luebbe06513f22009-08-12 12:48:00 +0200242 default:
243 return 0;
244 }
Holger Freyther89824fc2008-12-30 16:18:18 +0000245}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000246
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100247static void release_loc_updating_req(struct gsm_subscriber_connection *conn)
Holger Freyther73487a22008-12-31 18:53:57 +0000248{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100249 if (!conn->loc_operation)
Holger Freyther73487a22008-12-31 18:53:57 +0000250 return;
251
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +0800252 /* No need to keep the connection up */
253 release_anchor(conn);
254
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200255 osmo_timer_del(&conn->loc_operation->updating_timer);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100256 talloc_free(conn->loc_operation);
Holger Hans Peter Freytherf93e8fa2010-12-22 08:53:28 +0100257 conn->loc_operation = NULL;
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800258 msc_release_connection(conn);
Holger Freyther73487a22008-12-31 18:53:57 +0000259}
260
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100261static void allocate_loc_updating_req(struct gsm_subscriber_connection *conn)
Holger Freyther73487a22008-12-31 18:53:57 +0000262{
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800263 if (conn->loc_operation)
264 LOGP(DMM, LOGL_ERROR, "Connection already had operation.\n");
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100265 release_loc_updating_req(conn);
Holger Freyther73487a22008-12-31 18:53:57 +0000266
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100267 conn->loc_operation = talloc_zero(tall_locop_ctx,
Harald Welte470ec292009-06-26 20:25:23 +0200268 struct gsm_loc_updating_operation);
Holger Freyther73487a22008-12-31 18:53:57 +0000269}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000270
Sylvain Munaut267fba02009-12-24 00:28:01 +0100271static int _gsm0408_authorize_sec_cb(unsigned int hooknum, unsigned int event,
272 struct msgb *msg, void *data, void *param)
273{
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800274 struct gsm_subscriber_connection *conn = data;
Sylvain Munaut267fba02009-12-24 00:28:01 +0100275 int rc = 0;
276
277 switch (event) {
278 case GSM_SECURITY_AUTH_FAILED:
279 release_loc_updating_req(conn);
280 break;
281
282 case GSM_SECURITY_NOAVAIL:
283 case GSM_SECURITY_SUCCEEDED:
284 /* We're all good */
285 db_subscriber_alloc_tmsi(conn->subscr);
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800286 rc = gsm0408_loc_upd_acc(conn, conn->subscr->tmsi);
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800287 if (conn->bts->network->send_mm_info) {
Sylvain Munaut267fba02009-12-24 00:28:01 +0100288 /* send MM INFO with network name */
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800289 rc = gsm48_tx_mm_info(conn);
Sylvain Munaut267fba02009-12-24 00:28:01 +0100290 }
291
292 /* call subscr_update after putting the loc_upd_acc
293 * in the transmit queue, since S_SUBSCR_ATTACHED might
294 * trigger further action like SMS delivery */
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800295 subscr_update(conn->subscr, conn->bts,
Sylvain Munaut267fba02009-12-24 00:28:01 +0100296 GSM_SUBSCRIBER_UPDATE_ATTACHED);
297
Holger Hans Peter Freytherd4e68722010-12-22 12:11:01 +0100298 /*
299 * The gsm0408_loc_upd_acc sends a MI with the TMSI. The
300 * MS needs to respond with a TMSI REALLOCATION COMPLETE
301 * (even if the TMSI is the same).
302 */
Sylvain Munaut267fba02009-12-24 00:28:01 +0100303 break;
304
305 default:
306 rc = -EINVAL;
307 };
308
309 return rc;
310}
311
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100312static int gsm0408_authorize(struct gsm_subscriber_connection *conn, struct msgb *msg)
Holger Freytherd51524f2009-06-09 08:27:07 +0000313{
Sylvain Munaut267fba02009-12-24 00:28:01 +0100314 if (authorize_subscriber(conn->loc_operation, conn->subscr))
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800315 return gsm48_secure_channel(conn,
Sylvain Munaut267fba02009-12-24 00:28:01 +0100316 conn->loc_operation->key_seq,
317 _gsm0408_authorize_sec_cb, NULL);
Holger Freytherd51524f2009-06-09 08:27:07 +0000318 return 0;
319}
320
Holger Hans Peter Freytheradb6e1c2010-09-18 06:44:24 +0800321void gsm0408_clear_request(struct gsm_subscriber_connection *conn, uint32_t cause)
Holger Freyther7c19f742009-06-06 13:54:35 +0000322{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800323 struct gsm_trans *trans, *temp;
Holger Hans Peter Freyther40494552010-06-28 17:09:29 +0800324
325 /* avoid someone issuing a clear */
326 conn->in_release = 1;
327
Holger Freyther7c19f742009-06-06 13:54:35 +0000328 /*
329 * Cancel any outstanding location updating request
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800330 * operation taking place on the subscriber connection.
Holger Freyther7c19f742009-06-06 13:54:35 +0000331 */
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800332 release_loc_updating_req(conn);
Holger Hans Peter Freytherc29043e2010-12-28 14:57:20 +0100333
334 /* We might need to cancel the paging response or such. */
335 if (conn->sec_operation && conn->sec_operation->cb) {
336 conn->sec_operation->cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
337 NULL, conn, conn->sec_operation->cb_data);
338 }
339
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800340 release_security_operation(conn);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +0800341 release_anchor(conn);
Holger Freyther7c19f742009-06-06 13:54:35 +0000342
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100343 /*
344 * Free all transactions that are associated with the released
345 * connection. The transaction code will inform the CC or SMS
346 * facilities that will send the release indications. As part of
347 * the CC REL_IND the remote leg might be released and this will
348 * trigger the call to trans_free. This is something the llist
349 * macro can not handle and we will need to re-iterate the list.
350 *
351 * TODO: Move the trans_list into the subscriber connection and
352 * create a pending list for MT transactions. These exist before
353 * we have a subscriber connection.
354 */
355restart:
Holger Hans Peter Freytherf6fb3ef2010-06-15 13:16:52 +0800356 llist_for_each_entry_safe(trans, temp, &conn->bts->network->trans_list, entry) {
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100357 if (trans->conn == conn) {
Harald Weltedcaf5652009-07-23 18:56:43 +0200358 trans_free(trans);
Holger Hans Peter Freyther3e9b2ec2012-12-22 18:45:27 +0100359 goto restart;
360 }
Harald Welte4bfdfe72009-06-10 23:11:52 +0800361 }
Holger Freyther7c19f742009-06-06 13:54:35 +0000362}
363
Harald Welte371efe52010-12-22 23:17:50 +0100364void gsm0408_clear_all_trans(struct gsm_network *net, int protocol)
365{
366 struct gsm_trans *trans, *temp;
367
368 LOGP(DCC, LOGL_NOTICE, "Clearing all currently active transactions!!!\n");
369
370 llist_for_each_entry_safe(trans, temp, &net->trans_list, entry) {
Harald Welteeb76c7a2010-12-23 02:47:53 +0100371 if (trans->protocol == protocol) {
372 trans->callref = 0;
Harald Welte371efe52010-12-22 23:17:50 +0100373 trans_free(trans);
Harald Welteeb76c7a2010-12-23 02:47:53 +0100374 }
Harald Welte371efe52010-12-22 23:17:50 +0100375 }
376}
377
Holger Freyther429e7762008-12-30 13:28:30 +0000378/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200379int gsm0408_loc_upd_rej(struct gsm_subscriber_connection *conn, uint8_t cause)
Harald Welte52b1f982008-12-23 20:25:15 +0000380{
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800381 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800382 struct msgb *msg;
383
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200384 osmo_counter_inc(bts->network->stats.loc_upd_resp.reject);
Holger Hans Peter Freyther230a4d82010-06-15 19:40:05 +0800385
386 msg = gsm48_create_loc_upd_rej(cause);
387 if (!msg) {
388 LOGP(DMM, LOGL_ERROR, "Failed to create msg for LOCATION UPDATING REJECT.\n");
389 return -1;
390 }
Harald Welte52b1f982008-12-23 20:25:15 +0000391
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800392 msg->lchan = conn->lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000393
Harald Welte (local)198d5ad2009-12-26 22:15:28 +0100394 LOGP(DMM, LOGL_INFO, "Subscriber %s: LOCATION UPDATING REJECT "
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100395 "LAC=%u BTS=%u\n", conn->subscr ?
396 subscr_name(conn->subscr) : "unknown",
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800397 bts->location_area_code, bts->nr);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100398
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800399 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000400}
401
402/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200403int gsm0408_loc_upd_acc(struct gsm_subscriber_connection *conn, uint32_t tmsi)
Harald Welte52b1f982008-12-23 20:25:15 +0000404{
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800405 struct gsm_bts *bts = conn->bts;
Harald Welte8470bf22008-12-25 23:28:35 +0000406 struct msgb *msg = gsm48_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000407 struct gsm48_hdr *gh;
408 struct gsm48_loc_area_id *lai;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200409 uint8_t *mid;
Harald Welte52b1f982008-12-23 20:25:15 +0000410
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800411 msg->lchan = conn->lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000412
413 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
414 gh->proto_discr = GSM48_PDISC_MM;
415 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
416
417 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Harald Welteafedeab2010-03-04 10:55:40 +0100418 gsm48_generate_lai(lai, bts->network->country_code,
Harald Welte52b1f982008-12-23 20:25:15 +0000419 bts->network->network_code, bts->location_area_code);
420
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200421 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
Holger Hans Peter Freyther5d0e56f2009-08-20 08:41:24 +0200422 gsm48_generate_mid_from_tmsi(mid, tmsi);
Harald Welte52b1f982008-12-23 20:25:15 +0000423
424 DEBUGP(DMM, "-> LOCATION UPDATE ACCEPT\n");
425
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200426 osmo_counter_inc(bts->network->stats.loc_upd_resp.accept);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100427
Holger Hans Peter Freytherdc5db242010-06-15 14:07:27 +0800428 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000429}
430
Harald Weltebf5e8df2009-02-03 12:59:45 +0000431/* Transmit Chapter 9.2.10 Identity Request */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200432static int mm_tx_identity_req(struct gsm_subscriber_connection *conn, uint8_t id_type)
Harald Welte231ad4f2008-12-27 11:15:38 +0000433{
434 struct msgb *msg = gsm48_msgb_alloc();
435 struct gsm48_hdr *gh;
Harald Weltefc977a82008-12-27 10:19:37 +0000436
Holger Hans Peter Freytherd521d972010-06-15 14:11:01 +0800437 msg->lchan = conn->lchan;
Harald Welte231ad4f2008-12-27 11:15:38 +0000438
439 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
440 gh->proto_discr = GSM48_PDISC_MM;
441 gh->msg_type = GSM48_MT_MM_ID_REQ;
442 gh->data[0] = id_type;
443
Holger Hans Peter Freytherd521d972010-06-15 14:11:01 +0800444 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte231ad4f2008-12-27 11:15:38 +0000445}
446
Harald Welte231ad4f2008-12-27 11:15:38 +0000447
Harald Weltebf5e8df2009-02-03 12:59:45 +0000448/* Parse Chapter 9.2.11 Identity Response */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800449static int mm_rx_id_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte231ad4f2008-12-27 11:15:38 +0000450{
451 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte75a983f2008-12-27 21:34:06 +0000452 struct gsm_lchan *lchan = msg->lchan;
Harald Welte9176bd42009-07-23 18:46:00 +0200453 struct gsm_bts *bts = lchan->ts->trx->bts;
454 struct gsm_network *net = bts->network;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200455 uint8_t mi_type = gh->data[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200456 char mi_string[GSM48_MI_SIZE];
Harald Welte231ad4f2008-12-27 11:15:38 +0000457
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200458 gsm48_mi_to_string(mi_string, sizeof(mi_string), &gh->data[1], gh->data[0]);
Harald Welte61253062008-12-27 11:25:50 +0000459 DEBUGP(DMM, "IDENTITY RESPONSE: mi_type=0x%02x MI(%s)\n",
Harald Welte231ad4f2008-12-27 11:15:38 +0000460 mi_type, mi_string);
461
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200462 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
Harald Welte7659de12009-12-13 12:39:18 +0100463
Harald Welte75a983f2008-12-27 21:34:06 +0000464 switch (mi_type) {
465 case GSM_MI_TYPE_IMSI:
Jan Luebbe370b41d2009-08-12 10:19:34 +0200466 /* look up subscriber based on IMSI, create if not found */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100467 if (!conn->subscr) {
468 conn->subscr = subscr_get_by_imsi(net, mi_string);
469 if (!conn->subscr)
470 conn->subscr = db_create_subscriber(net, mi_string);
Jan Luebbeb0dfc312009-08-12 10:12:52 +0200471 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100472 if (conn->loc_operation)
473 conn->loc_operation->waiting_for_imsi = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000474 break;
475 case GSM_MI_TYPE_IMEI:
Harald Welte255539c2008-12-28 02:26:27 +0000476 case GSM_MI_TYPE_IMEISV:
Harald Welte75a983f2008-12-27 21:34:06 +0000477 /* update subscribe <-> IMEI mapping */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100478 if (conn->subscr) {
479 db_subscriber_assoc_imei(conn->subscr, mi_string);
480 db_sync_equipment(&conn->subscr->equipment);
Harald Welte (local)ee4410a2009-08-17 09:39:55 +0200481 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100482 if (conn->loc_operation)
483 conn->loc_operation->waiting_for_imei = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000484 break;
485 }
Holger Freyther73487a22008-12-31 18:53:57 +0000486
487 /* Check if we can let the mobile station enter */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100488 return gsm0408_authorize(conn, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +0000489}
490
Harald Welte255539c2008-12-28 02:26:27 +0000491
492static void loc_upd_rej_cb(void *data)
493{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100494 struct gsm_subscriber_connection *conn = data;
495 struct gsm_lchan *lchan = conn->lchan;
Harald Welte1085c092009-11-18 20:33:19 +0100496 struct gsm_bts *bts = lchan->ts->trx->bts;
Harald Welte255539c2008-12-28 02:26:27 +0000497
Holger Hans Peter Freyther2692e3b2011-11-07 12:26:29 +0100498 LOGP(DMM, LOGL_DEBUG, "Location Updating Request procedure timedout.\n");
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800499 gsm0408_loc_upd_rej(conn, bts->network->reject_cause);
Holger Hans Peter Freyther01288432010-06-16 12:52:28 +0800500 release_loc_updating_req(conn);
Harald Welte255539c2008-12-28 02:26:27 +0000501}
502
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100503static void schedule_reject(struct gsm_subscriber_connection *conn)
Holger Freytherb7193e42008-12-29 17:44:08 +0000504{
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100505 conn->loc_operation->updating_timer.cb = loc_upd_rej_cb;
506 conn->loc_operation->updating_timer.data = conn;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200507 osmo_timer_schedule(&conn->loc_operation->updating_timer, 5, 0);
Holger Freytherb7193e42008-12-29 17:44:08 +0000508}
509
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200510static const char *lupd_name(uint8_t type)
Harald Welte2a139372009-02-22 21:14:55 +0000511{
512 switch (type) {
513 case GSM48_LUPD_NORMAL:
514 return "NORMAL";
515 case GSM48_LUPD_PERIODIC:
516 return "PEROIDOC";
517 case GSM48_LUPD_IMSI_ATT:
518 return "IMSI ATTACH";
519 default:
520 return "UNKNOWN";
521 }
522}
523
Harald Weltebf5e8df2009-02-03 12:59:45 +0000524/* Chapter 9.2.15: Receive Location Updating Request */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800525static int mm_rx_loc_upd_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +0000526{
Harald Welte8470bf22008-12-25 23:28:35 +0000527 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000528 struct gsm48_loc_upd_req *lu;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800529 struct gsm_subscriber *subscr = NULL;
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800530 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200531 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200532 char mi_string[GSM48_MI_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000533
Harald Welte8470bf22008-12-25 23:28:35 +0000534 lu = (struct gsm48_loc_upd_req *) gh->data;
535
536 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
Harald Welte52b1f982008-12-23 20:25:15 +0000537
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200538 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Weltefc977a82008-12-27 10:19:37 +0000539
Harald Weltea0368542009-06-27 02:58:43 +0200540 DEBUGPC(DMM, "mi_type=0x%02x MI(%s) type=%s ", mi_type, mi_string,
Harald Welte2a139372009-02-22 21:14:55 +0000541 lupd_name(lu->type));
Holger Freyther73487a22008-12-31 18:53:57 +0000542
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200543 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
Harald Welte7659de12009-12-13 12:39:18 +0100544
Harald Welte24ff6ee2009-12-22 00:41:05 +0100545 switch (lu->type) {
546 case GSM48_LUPD_NORMAL:
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200547 osmo_counter_inc(bts->network->stats.loc_upd_type.normal);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100548 break;
549 case GSM48_LUPD_IMSI_ATT:
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200550 osmo_counter_inc(bts->network->stats.loc_upd_type.attach);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100551 break;
552 case GSM48_LUPD_PERIODIC:
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200553 osmo_counter_inc(bts->network->stats.loc_upd_type.periodic);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100554 break;
555 }
556
Holger Freythereaf04692009-06-06 13:54:44 +0000557 /*
558 * Pseudo Spoof detection: Just drop a second/concurrent
559 * location updating request.
560 */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100561 if (conn->loc_operation) {
Harald Weltea0368542009-06-27 02:58:43 +0200562 DEBUGPC(DMM, "ignoring request due an existing one: %p.\n",
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100563 conn->loc_operation);
Holger Hans Peter Freyther7bc5ba32010-06-15 14:09:34 +0800564 gsm0408_loc_upd_rej(conn, GSM48_REJECT_PROTOCOL_ERROR);
Holger Freythereaf04692009-06-06 13:54:44 +0000565 return 0;
566 }
567
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800568 allocate_loc_updating_req(conn);
Holger Freyther73487a22008-12-31 18:53:57 +0000569
Sylvain Munaut2030a2a2010-06-10 13:36:59 +0200570 conn->loc_operation->key_seq = lu->key_seq;
571
Harald Welte52b1f982008-12-23 20:25:15 +0000572 switch (mi_type) {
573 case GSM_MI_TYPE_IMSI:
Harald Weltea0368542009-06-27 02:58:43 +0200574 DEBUGPC(DMM, "\n");
Harald Welte231ad4f2008-12-27 11:15:38 +0000575 /* we always want the IMEI, too */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200576 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100577 conn->loc_operation->waiting_for_imei = 1;
Holger Freytherc6ea9db2008-12-30 19:18:21 +0000578
Jan Luebbe370b41d2009-08-12 10:19:34 +0200579 /* look up subscriber based on IMSI, create if not found */
580 subscr = subscr_get_by_imsi(bts->network, mi_string);
581 if (!subscr) {
582 subscr = db_create_subscriber(bts->network, mi_string);
583 }
Harald Welte4b634542008-12-27 01:55:51 +0000584 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000585 case GSM_MI_TYPE_TMSI:
Harald Weltea0368542009-06-27 02:58:43 +0200586 DEBUGPC(DMM, "\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000587 /* look up the subscriber based on TMSI, request IMSI if it fails */
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +0200588 subscr = subscr_get_by_tmsi(bts->network,
589 tmsi_from_string(mi_string));
Harald Welte52b1f982008-12-23 20:25:15 +0000590 if (!subscr) {
Harald Welte231ad4f2008-12-27 11:15:38 +0000591 /* send IDENTITY REQUEST message to get IMSI */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200592 mm_tx_identity_req(conn, GSM_MI_TYPE_IMSI);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100593 conn->loc_operation->waiting_for_imsi = 1;
Harald Welte52b1f982008-12-23 20:25:15 +0000594 }
Harald Weltef5f512c2010-06-07 17:56:32 +0200595 /* we always want the IMEI, too */
Holger Hans Peter Freythera5050b12012-09-11 11:55:03 +0200596 mm_tx_identity_req(conn, GSM_MI_TYPE_IMEI);
Harald Weltef5f512c2010-06-07 17:56:32 +0200597 conn->loc_operation->waiting_for_imei = 1;
Harald Welte52b1f982008-12-23 20:25:15 +0000598 break;
599 case GSM_MI_TYPE_IMEI:
600 case GSM_MI_TYPE_IMEISV:
601 /* no sim card... FIXME: what to do ? */
Harald Weltea0368542009-06-27 02:58:43 +0200602 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000603 break;
604 default:
Harald Weltea0368542009-06-27 02:58:43 +0200605 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000606 break;
607 }
608
Harald Welte24516ea2009-07-04 10:18:00 +0200609 /* schedule the reject timer */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100610 schedule_reject(conn);
Harald Welte24516ea2009-07-04 10:18:00 +0200611
Harald Welte4bfdfe72009-06-10 23:11:52 +0800612 if (!subscr) {
Harald Weltea0368542009-06-27 02:58:43 +0200613 DEBUGPC(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte4bfdfe72009-06-10 23:11:52 +0800614 /* FIXME: request id? close channel? */
615 return -EINVAL;
616 }
617
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100618 conn->subscr = subscr;
619 conn->subscr->equipment.classmark1 = lu->classmark1;
Harald Welte255539c2008-12-28 02:26:27 +0000620
Harald Welte24516ea2009-07-04 10:18:00 +0200621 /* check if we can let the subscriber into our network immediately
622 * or if we need to wait for identity responses. */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100623 return gsm0408_authorize(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000624}
625
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100626/* Turn int into semi-octet representation: 98 => 0x89 */
627static uint8_t bcdify(uint8_t value)
Harald Welte4bfdfe72009-06-10 23:11:52 +0800628{
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100629 uint8_t ret;
630
631 ret = value / 10;
632 ret |= (value % 10) << 4;
633
634 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800635}
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100636
Harald Welte4bfdfe72009-06-10 23:11:52 +0800637
Harald Weltedb253af2008-12-30 17:56:55 +0000638/* Section 9.2.15a */
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800639int gsm48_tx_mm_info(struct gsm_subscriber_connection *conn)
Harald Weltedb253af2008-12-30 17:56:55 +0000640{
641 struct msgb *msg = gsm48_msgb_alloc();
642 struct gsm48_hdr *gh;
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800643 struct gsm_network *net = conn->bts->network;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100644 struct gsm_bts *bts = conn->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200645 uint8_t *ptr8;
Daniel Willmanneea93372009-08-13 03:42:07 +0200646 int name_len, name_pad;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100647
Harald Welte4bfdfe72009-06-10 23:11:52 +0800648 time_t cur_t;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100649 struct tm* gmt_time;
650 struct tm* local_time;
651 int tzunits;
Harald Weltedb253af2008-12-30 17:56:55 +0000652
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800653 msg->lchan = conn->lchan;
Harald Weltedb253af2008-12-30 17:56:55 +0000654
655 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
656 gh->proto_discr = GSM48_PDISC_MM;
657 gh->msg_type = GSM48_MT_MM_INFO;
658
659 if (net->name_long) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200660#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000661 name_len = strlen(net->name_long);
662 /* 10.5.3.5a */
663 ptr8 = msgb_put(msg, 3);
664 ptr8[0] = GSM48_IE_NAME_LONG;
665 ptr8[1] = name_len*2 +1;
666 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
667
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200668 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000669 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000670 ptr16[i] = htons(net->name_long[i]);
Harald Weltedb253af2008-12-30 17:56:55 +0000671
672 /* FIXME: Use Cell Broadcast, not UCS-2, since
673 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmanneea93372009-08-13 03:42:07 +0200674#endif
675 name_len = (strlen(net->name_long)*7)/8;
676 name_pad = (8 - strlen(net->name_long)*7)%8;
677 if (name_pad > 0)
678 name_len++;
679 /* 10.5.3.5a */
680 ptr8 = msgb_put(msg, 3);
681 ptr8[0] = GSM48_IE_NAME_LONG;
682 ptr8[1] = name_len +1;
683 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
684
685 ptr8 = msgb_put(msg, name_len);
686 gsm_7bit_encode(ptr8, net->name_long);
687
Harald Weltedb253af2008-12-30 17:56:55 +0000688 }
689
690 if (net->name_short) {
Daniel Willmanneea93372009-08-13 03:42:07 +0200691#if 0
Harald Weltedb253af2008-12-30 17:56:55 +0000692 name_len = strlen(net->name_short);
693 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200694 ptr8 = (uint8_t *) msgb_put(msg, 3);
Harald Welte7543eb72009-07-19 17:51:36 +0200695 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Weltedb253af2008-12-30 17:56:55 +0000696 ptr8[1] = name_len*2 + 1;
697 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
698
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200699 ptr16 = (uint16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +0000700 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +0000701 ptr16[i] = htons(net->name_short[i]);
Daniel Willmanneea93372009-08-13 03:42:07 +0200702#endif
703 name_len = (strlen(net->name_short)*7)/8;
704 name_pad = (8 - strlen(net->name_short)*7)%8;
705 if (name_pad > 0)
706 name_len++;
707 /* 10.5.3.5a */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200708 ptr8 = (uint8_t *) msgb_put(msg, 3);
Daniel Willmanneea93372009-08-13 03:42:07 +0200709 ptr8[0] = GSM48_IE_NAME_SHORT;
710 ptr8[1] = name_len +1;
711 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
712
713 ptr8 = msgb_put(msg, name_len);
714 gsm_7bit_encode(ptr8, net->name_short);
715
Harald Weltedb253af2008-12-30 17:56:55 +0000716 }
717
Harald Weltedb253af2008-12-30 17:56:55 +0000718 /* Section 10.5.3.9 */
719 cur_t = time(NULL);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100720 gmt_time = gmtime(&cur_t);
721
Harald Weltedb253af2008-12-30 17:56:55 +0000722 ptr8 = msgb_put(msg, 8);
723 ptr8[0] = GSM48_IE_NET_TIME_TZ;
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100724 ptr8[1] = bcdify(gmt_time->tm_year % 100);
725 ptr8[2] = bcdify(gmt_time->tm_mon + 1);
726 ptr8[3] = bcdify(gmt_time->tm_mday);
727 ptr8[4] = bcdify(gmt_time->tm_hour);
728 ptr8[5] = bcdify(gmt_time->tm_min);
729 ptr8[6] = bcdify(gmt_time->tm_sec);
730
Harald Welte45f91712012-07-08 16:48:11 +0200731 if (bts->tz.override) {
732 /* Convert tz.hr and tz.mn to units */
733 if (bts->tz.hr < 0) {
734 tzunits = ((bts->tz.hr/-1)*4);
735 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100736 ptr8[7] = bcdify(tzunits);
737 /* Set negative time */
738 ptr8[7] |= 0x08;
739 }
740 else {
Harald Welte45f91712012-07-08 16:48:11 +0200741 tzunits = bts->tz.hr*4;
742 tzunits = tzunits + (bts->tz.mn/15);
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100743 ptr8[7] = bcdify(tzunits);
744 }
745 }
746 else {
747 /* Need to get GSM offset and convert into 15 min units */
748 /* This probably breaks if gmtoff returns a value not evenly divisible by 15? */
749 local_time = localtime(&cur_t);
Harald Welte9c3dc902012-04-08 16:59:24 +0200750#ifdef HAVE_TM_GMTOFF_IN_TM
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100751 tzunits = (local_time->tm_gmtoff/60)/15;
Harald Welte9c3dc902012-04-08 16:59:24 +0200752#else
753#warning find a portable way to obtain the timezone offset
754 tzunits = 0;
755#endif
Gus Bourg1c5dd2c2011-12-02 10:18:17 +0100756 if (tzunits < 0) {
757 tzunits = tzunits/-1;
758 ptr8[7] = bcdify(tzunits);
759 /* Flip it to negative */
760 ptr8[7] |= 0x08;
761 }
762 else
763 ptr8[7] = bcdify(tzunits);
764 }
Harald Weltedb253af2008-12-30 17:56:55 +0000765
Daniel Willmanneea93372009-08-13 03:42:07 +0200766 DEBUGP(DMM, "-> MM INFO\n");
767
Holger Hans Peter Freyther91401742010-06-15 14:16:02 +0800768 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Weltedb253af2008-12-30 17:56:55 +0000769}
770
Harald Welte7984d5c2009-08-12 22:56:50 +0200771/* Section 9.2.2 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200772int gsm48_tx_mm_auth_req(struct gsm_subscriber_connection *conn, uint8_t *rand, int key_seq)
Harald Welte7984d5c2009-08-12 22:56:50 +0200773{
774 struct msgb *msg = gsm48_msgb_alloc();
775 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut849f5542009-09-27 11:10:17 +0200776 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte7984d5c2009-08-12 22:56:50 +0200777
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +0200778 DEBUGP(DMM, "-> AUTH REQ (rand = %s)\n", osmo_hexdump(rand, 16));
Harald Welte7984d5c2009-08-12 22:56:50 +0200779
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800780 msg->lchan = conn->lchan;
Harald Welte7984d5c2009-08-12 22:56:50 +0200781 gh->proto_discr = GSM48_PDISC_MM;
782 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
783
Sylvain Munautbd55a6d2009-12-24 00:23:46 +0100784 ar->key_seq = key_seq;
Sylvain Munaut849f5542009-09-27 11:10:17 +0200785
Harald Welte7984d5c2009-08-12 22:56:50 +0200786 /* 16 bytes RAND parameters */
Harald Welte7984d5c2009-08-12 22:56:50 +0200787 if (rand)
Sylvain Munaut849f5542009-09-27 11:10:17 +0200788 memcpy(ar->rand, rand, 16);
Harald Welte7984d5c2009-08-12 22:56:50 +0200789
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800790 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte7984d5c2009-08-12 22:56:50 +0200791}
792
793/* Section 9.2.1 */
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800794int gsm48_tx_mm_auth_rej(struct gsm_subscriber_connection *conn)
Harald Welte7984d5c2009-08-12 22:56:50 +0200795{
796 DEBUGP(DMM, "-> AUTH REJECT\n");
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800797 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
Harald Welte7984d5c2009-08-12 22:56:50 +0200798}
799
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800800static int gsm48_tx_mm_serv_ack(struct gsm_subscriber_connection *conn)
Harald Welte4b634542008-12-27 01:55:51 +0000801{
Harald Welte4b634542008-12-27 01:55:51 +0000802 DEBUGP(DMM, "-> CM SERVICE ACK\n");
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +0800803 return gsm48_tx_simple(conn, GSM48_PDISC_MM, GSM48_MT_MM_CM_SERV_ACC);
Harald Welte4b634542008-12-27 01:55:51 +0000804}
Harald Welteba4cf162009-01-10 01:49:35 +0000805
806/* 9.2.6 CM service reject */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100807static int gsm48_tx_mm_serv_rej(struct gsm_subscriber_connection *conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000808 enum gsm48_reject_value value)
809{
Holger Hans Peter Freyther2c0f1662010-06-15 19:39:27 +0800810 struct msgb *msg;
Harald Welteba4cf162009-01-10 01:49:35 +0000811
Holger Hans Peter Freyther2c0f1662010-06-15 19:39:27 +0800812 msg = gsm48_create_mm_serv_rej(value);
813 if (!msg) {
814 LOGP(DMM, LOGL_ERROR, "Failed to allocate CM Service Reject.\n");
815 return -1;
816 }
Harald Welteba4cf162009-01-10 01:49:35 +0000817
Holger Hans Peter Freyther2c0f1662010-06-15 19:39:27 +0800818 DEBUGP(DMM, "-> CM SERVICE Reject cause: %d\n", value);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +0100819 msg->lchan = conn->lchan;
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800820 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welteba4cf162009-01-10 01:49:35 +0000821}
822
Sylvain Munautba87f452009-12-24 00:28:46 +0100823static int _gsm48_rx_mm_serv_req_sec_cb(
824 unsigned int hooknum, unsigned int event,
825 struct msgb *msg, void *data, void *param)
826{
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800827 struct gsm_subscriber_connection *conn = data;
Sylvain Munautba87f452009-12-24 00:28:46 +0100828 int rc = 0;
829
830 switch (event) {
831 case GSM_SECURITY_AUTH_FAILED:
832 /* Nothing to do */
833 break;
834
835 case GSM_SECURITY_NOAVAIL:
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800836 rc = gsm48_tx_mm_serv_ack(conn);
Sylvain Munautba87f452009-12-24 00:28:46 +0100837 break;
838
839 case GSM_SECURITY_SUCCEEDED:
840 /* nothing to do. CIPHER MODE COMMAND is
841 * implicit CM SERV ACK */
842 break;
843
844 default:
845 rc = -EINVAL;
846 };
847
848 return rc;
849}
850
Harald Welte4ed0e922009-01-10 03:17:30 +0000851/*
852 * Handle CM Service Requests
853 * a) Verify that the packet is long enough to contain the information
854 * we require otherwsie reject with INCORRECT_MESSAGE
855 * b) Try to parse the TMSI. If we do not have one reject
856 * c) Check that we know the subscriber with the TMSI otherwise reject
857 * with a HLR cause
858 * d) Set the subscriber on the gsm_lchan and accept
859 */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800860static int gsm48_rx_mm_serv_req(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte4b634542008-12-27 01:55:51 +0000861{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200862 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200863 char mi_string[GSM48_MI_SIZE];
Harald Welte4b634542008-12-27 01:55:51 +0000864
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800865 struct gsm_bts *bts = conn->bts;
Harald Welteba4cf162009-01-10 01:49:35 +0000866 struct gsm_subscriber *subscr;
867 struct gsm48_hdr *gh = msgb_l3(msg);
868 struct gsm48_service_request *req =
869 (struct gsm48_service_request *)gh->data;
Holger Hans Peter Freyther5d658062010-05-14 08:02:08 +0800870 /* unfortunately in Phase1 the classmark2 length is variable */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200871 uint8_t classmark2_len = gh->data[1];
872 uint8_t *classmark2 = gh->data+2;
873 uint8_t mi_len = *(classmark2 + classmark2_len);
874 uint8_t *mi = (classmark2 + classmark2_len + 1);
Harald Welteba4cf162009-01-10 01:49:35 +0000875
Harald Weltec9e02182009-05-01 19:07:53 +0000876 DEBUGP(DMM, "<- CM SERVICE REQUEST ");
Harald Welteba4cf162009-01-10 01:49:35 +0000877 if (msg->data_len < sizeof(struct gsm48_service_request*)) {
Harald Weltec9e02182009-05-01 19:07:53 +0000878 DEBUGPC(DMM, "wrong sized message\n");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800879 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000880 GSM48_REJECT_INCORRECT_MESSAGE);
881 }
882
883 if (msg->data_len < req->mi_len + 6) {
Harald Weltec9e02182009-05-01 19:07:53 +0000884 DEBUGPC(DMM, "does not fit in packet\n");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800885 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000886 GSM48_REJECT_INCORRECT_MESSAGE);
887 }
888
Harald Weltec9e02182009-05-01 19:07:53 +0000889 mi_type = mi[0] & GSM_MI_TYPE_MASK;
Harald Welteba4cf162009-01-10 01:49:35 +0000890 if (mi_type != GSM_MI_TYPE_TMSI) {
Harald Weltec9e02182009-05-01 19:07:53 +0000891 DEBUGPC(DMM, "mi_type is not TMSI: %d\n", mi_type);
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800892 return gsm48_tx_mm_serv_rej(conn,
Harald Welteba4cf162009-01-10 01:49:35 +0000893 GSM48_REJECT_INCORRECT_MESSAGE);
894 }
895
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200896 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
Harald Weltec9e02182009-05-01 19:07:53 +0000897 DEBUGPC(DMM, "serv_type=0x%02x mi_type=0x%02x M(%s)\n",
Harald Welte4ed0e922009-01-10 03:17:30 +0000898 req->cm_service_type, mi_type, mi_string);
Harald Weltebcae43f2008-12-27 21:45:37 +0000899
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +0200900 osmo_signal_dispatch(SS_SUBSCR, S_SUBSCR_IDENTITY, (classmark2 + classmark2_len));
Harald Welte7659de12009-12-13 12:39:18 +0100901
Harald Welte3ac7f102009-08-10 10:12:45 +0200902 if (is_siemens_bts(bts))
903 send_siemens_mrpci(msg->lchan, classmark2-1);
904
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +0200905 subscr = subscr_get_by_tmsi(bts->network,
906 tmsi_from_string(mi_string));
Holger Freythereb443982009-06-04 13:58:42 +0000907
Harald Welte2a139372009-02-22 21:14:55 +0000908 /* FIXME: if we don't know the TMSI, inquire abit IMSI and allocate new TMSI */
Harald Welte4ed0e922009-01-10 03:17:30 +0000909 if (!subscr)
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800910 return gsm48_tx_mm_serv_rej(conn,
Harald Welte4ed0e922009-01-10 03:17:30 +0000911 GSM48_REJECT_IMSI_UNKNOWN_IN_HLR);
912
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800913 if (!conn->subscr)
914 conn->subscr = subscr;
915 else if (conn->subscr == subscr)
Sylvain Munautea3f6742009-12-18 18:28:10 +0100916 subscr_put(subscr); /* lchan already has a ref, don't need another one */
917 else {
Harald Welte9bb7c702009-01-10 03:21:41 +0000918 DEBUGP(DMM, "<- CM Channel already owned by someone else?\n");
919 subscr_put(subscr);
920 }
921
Harald Weltec2e302d2009-07-05 14:08:13 +0200922 subscr->equipment.classmark2_len = classmark2_len;
923 memcpy(subscr->equipment.classmark2, classmark2, classmark2_len);
924 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +0000925
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800926 return gsm48_secure_channel(conn, req->cipher_key_seq,
Sylvain Munautba87f452009-12-24 00:28:46 +0100927 _gsm48_rx_mm_serv_req_sec_cb, NULL);
Harald Welte4b634542008-12-27 01:55:51 +0000928}
929
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +0200930static int gsm48_rx_mm_imsi_detach_ind(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte2a139372009-02-22 21:14:55 +0000931{
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +0200932 struct gsm_bts *bts = conn->bts;
Harald Welte2a139372009-02-22 21:14:55 +0000933 struct gsm48_hdr *gh = msgb_l3(msg);
934 struct gsm48_imsi_detach_ind *idi =
935 (struct gsm48_imsi_detach_ind *) gh->data;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200936 uint8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200937 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +0800938 struct gsm_subscriber *subscr = NULL;
Harald Welte2a139372009-02-22 21:14:55 +0000939
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200940 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Harald Welte2a139372009-02-22 21:14:55 +0000941 DEBUGP(DMM, "IMSI DETACH INDICATION: mi_type=0x%02x MI(%s): ",
942 mi_type, mi_string);
943
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200944 osmo_counter_inc(bts->network->stats.loc_upd_type.detach);
Harald Welte24ff6ee2009-12-22 00:41:05 +0100945
Harald Welte2a139372009-02-22 21:14:55 +0000946 switch (mi_type) {
947 case GSM_MI_TYPE_TMSI:
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +0200948 subscr = subscr_get_by_tmsi(bts->network,
949 tmsi_from_string(mi_string));
Harald Welte2a139372009-02-22 21:14:55 +0000950 break;
951 case GSM_MI_TYPE_IMSI:
Harald Welte9176bd42009-07-23 18:46:00 +0200952 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Welte2a139372009-02-22 21:14:55 +0000953 break;
954 case GSM_MI_TYPE_IMEI:
955 case GSM_MI_TYPE_IMEISV:
956 /* no sim card... FIXME: what to do ? */
Holger Freyther79f4ae62009-06-02 03:25:04 +0000957 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +0000958 break;
959 default:
Holger Freyther79f4ae62009-06-02 03:25:04 +0000960 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +0000961 break;
962 }
963
Holger Freyther4a49e772009-04-12 05:37:29 +0000964 if (subscr) {
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +0200965 subscr_update(subscr, bts,
Holger Freyther4a49e772009-04-12 05:37:29 +0000966 GSM_SUBSCRIBER_UPDATE_DETACHED);
Harald Welte2e6d4682009-12-24 14:50:24 +0100967 DEBUGP(DMM, "Subscriber: %s\n", subscr_name(subscr));
Harald Welte (local)ee4410a2009-08-17 09:39:55 +0200968
969 subscr->equipment.classmark1 = idi->classmark1;
970 db_sync_equipment(&subscr->equipment);
971
Holger Freytherc21cfbc2009-06-02 02:54:57 +0000972 subscr_put(subscr);
Holger Freyther4a49e772009-04-12 05:37:29 +0000973 } else
Harald Welte2a139372009-02-22 21:14:55 +0000974 DEBUGP(DMM, "Unknown Subscriber ?!?\n");
975
Harald Welte31981a02009-12-20 09:58:40 +0100976 /* FIXME: iterate over all transactions and release them,
977 * imagine an IMSI DETACH happening during an active call! */
978
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +0200979 release_anchor(conn);
Harald Welte2a139372009-02-22 21:14:55 +0000980 return 0;
981}
982
Harald Welted2a7f5a2009-06-05 20:08:20 +0000983static int gsm48_rx_mm_status(struct msgb *msg)
984{
985 struct gsm48_hdr *gh = msgb_l3(msg);
986
987 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
988
989 return 0;
990}
991
Sylvain Munaut30a15382009-12-24 00:27:26 +0100992/* Chapter 9.2.3: Authentication Response */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +0800993static int gsm48_rx_mm_auth_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Sylvain Munaut30a15382009-12-24 00:27:26 +0100994{
995 struct gsm48_hdr *gh = msgb_l3(msg);
996 struct gsm48_auth_resp *ar = (struct gsm48_auth_resp*) gh->data;
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +0800997 struct gsm_network *net = conn->bts->network;
Sylvain Munaut30a15382009-12-24 00:27:26 +0100998
Sylvain Munautc593cf12010-06-10 23:51:41 +0200999 DEBUGP(DMM, "MM AUTHENTICATION RESPONSE (sres = %s): ",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001000 osmo_hexdump(ar->sres, 4));
Sylvain Munaut30a15382009-12-24 00:27:26 +01001001
1002 /* Safety check */
1003 if (!conn->sec_operation) {
1004 DEBUGP(DMM, "No authentication/cipher operation in progress !!!\n");
1005 return -EIO;
1006 }
1007
1008 /* Validate SRES */
1009 if (memcmp(conn->sec_operation->atuple.sres, ar->sres,4)) {
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001010 int rc;
Sylvain Munaut30a15382009-12-24 00:27:26 +01001011 gsm_cbfn *cb = conn->sec_operation->cb;
Sylvain Munautc593cf12010-06-10 23:51:41 +02001012
1013 DEBUGPC(DMM, "Invalid (expected %s)\n",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001014 osmo_hexdump(conn->sec_operation->atuple.sres, 4));
Sylvain Munautc593cf12010-06-10 23:51:41 +02001015
Sylvain Munaut30a15382009-12-24 00:27:26 +01001016 if (cb)
1017 cb(GSM_HOOK_RR_SECURITY, GSM_SECURITY_AUTH_FAILED,
Holger Hans Peter Freyther228c1052010-06-16 12:47:59 +08001018 NULL, conn, conn->sec_operation->cb_data);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001019
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001020 rc = gsm48_tx_mm_auth_rej(conn);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001021 release_security_operation(conn);
Holger Hans Peter Freyther59f787a2010-12-27 10:57:56 +01001022 return rc;
Sylvain Munaut30a15382009-12-24 00:27:26 +01001023 }
1024
Sylvain Munautc593cf12010-06-10 23:51:41 +02001025 DEBUGPC(DMM, "OK\n");
1026
Sylvain Munaut30a15382009-12-24 00:27:26 +01001027 /* Start ciphering */
Sylvain Munaut67706df2010-11-29 08:19:04 +01001028 return gsm0808_cipher_mode(conn, net->a5_encryption,
1029 conn->sec_operation->atuple.kc, 8, 0);
Sylvain Munaut30a15382009-12-24 00:27:26 +01001030}
1031
Harald Weltebf5e8df2009-02-03 12:59:45 +00001032/* Receive a GSM 04.08 Mobility Management (MM) message */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001033static int gsm0408_rcv_mm(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001034{
1035 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001036 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001037
1038 switch (gh->msg_type & 0xbf) {
1039 case GSM48_MT_MM_LOC_UPD_REQUEST:
Harald Weltea0368542009-06-27 02:58:43 +02001040 DEBUGP(DMM, "LOCATION UPDATING REQUEST: ");
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001041 rc = mm_rx_loc_upd_req(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001042 break;
1043 case GSM48_MT_MM_ID_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001044 rc = mm_rx_id_resp(conn, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001045 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001046 case GSM48_MT_MM_CM_SERV_REQ:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001047 rc = gsm48_rx_mm_serv_req(conn, msg);
Harald Welte4b634542008-12-27 01:55:51 +00001048 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001049 case GSM48_MT_MM_STATUS:
Harald Welted2a7f5a2009-06-05 20:08:20 +00001050 rc = gsm48_rx_mm_status(msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001051 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001052 case GSM48_MT_MM_TMSI_REALL_COMPL:
Harald Welte69b2af22009-01-06 19:47:00 +00001053 DEBUGP(DMM, "TMSI Reallocation Completed. Subscriber: %s\n",
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001054 conn->subscr ?
1055 subscr_name(conn->subscr) :
Harald Welte69b2af22009-01-06 19:47:00 +00001056 "unknown subscriber");
Holger Hans Peter Freytherd4e68722010-12-22 12:11:01 +01001057 release_loc_updating_req(conn);
Harald Welte69b2af22009-01-06 19:47:00 +00001058 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001059 case GSM48_MT_MM_IMSI_DETACH_IND:
Holger Hans Peter Freyther153b13b2012-07-10 08:53:27 +02001060 rc = gsm48_rx_mm_imsi_detach_ind(conn, msg);
Harald Welte2a139372009-02-22 21:14:55 +00001061 break;
1062 case GSM48_MT_MM_CM_REEST_REQ:
1063 DEBUGP(DMM, "CM REESTABLISH REQUEST: Not implemented\n");
1064 break;
1065 case GSM48_MT_MM_AUTH_RESP:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001066 rc = gsm48_rx_mm_auth_resp(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001067 break;
1068 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01001069 LOGP(DMM, LOGL_NOTICE, "Unknown GSM 04.08 MM msg type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001070 gh->msg_type);
1071 break;
1072 }
1073
1074 return rc;
1075}
Harald Weltebf5e8df2009-02-03 12:59:45 +00001076
Harald Welte2d35ae62009-02-06 12:02:13 +00001077/* Receive a PAGING RESPONSE message from the MS */
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001078static int gsm48_rx_rr_pag_resp(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte2d35ae62009-02-06 12:02:13 +00001079{
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001080 struct gsm_bts *bts = conn->bts;
Harald Welte2d35ae62009-02-06 12:02:13 +00001081 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherf6903de2010-05-16 01:51:14 +08001082 struct gsm48_pag_resp *resp;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001083 uint8_t *classmark2_lv = gh->data + 1;
1084 uint8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001085 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +08001086 struct gsm_subscriber *subscr = NULL;
Harald Welte2d35ae62009-02-06 12:02:13 +00001087 int rc = 0;
1088
Holger Hans Peter Freytherf6903de2010-05-16 01:51:14 +08001089 resp = (struct gsm48_pag_resp *) &gh->data[0];
1090 gsm48_paging_extract_mi(resp, msgb_l3len(msg) - sizeof(*gh),
1091 mi_string, &mi_type);
Harald Welte2d35ae62009-02-06 12:02:13 +00001092 DEBUGP(DRR, "PAGING RESPONSE: mi_type=0x%02x MI(%s)\n",
1093 mi_type, mi_string);
Harald Welte3ac7f102009-08-10 10:12:45 +02001094
Harald Weltefe18d8f2009-02-22 21:14:24 +00001095 switch (mi_type) {
1096 case GSM_MI_TYPE_TMSI:
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001097 subscr = subscr_get_by_tmsi(bts->network,
1098 tmsi_from_string(mi_string));
Harald Weltefe18d8f2009-02-22 21:14:24 +00001099 break;
1100 case GSM_MI_TYPE_IMSI:
Harald Welte9176bd42009-07-23 18:46:00 +02001101 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Weltefe18d8f2009-02-22 21:14:24 +00001102 break;
1103 }
Harald Welte2d35ae62009-02-06 12:02:13 +00001104
1105 if (!subscr) {
1106 DEBUGP(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte09e38af2009-02-16 22:52:23 +00001107 /* FIXME: request id? close channel? */
Harald Welte2d35ae62009-02-06 12:02:13 +00001108 return -EINVAL;
1109 }
1110 DEBUGP(DRR, "<- Channel was requested by %s\n",
Harald Welte76042182009-08-08 16:03:15 +02001111 subscr->name && strlen(subscr->name) ? subscr->name : subscr->imsi);
Holger Freyther053e09d2009-02-14 22:51:06 +00001112
Harald Weltec2e302d2009-07-05 14:08:13 +02001113 subscr->equipment.classmark2_len = *classmark2_lv;
1114 memcpy(subscr->equipment.classmark2, classmark2_lv+1, *classmark2_lv);
1115 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001116
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001117 rc = gsm48_handle_paging_resp(conn, msg, subscr);
Harald Welte2d35ae62009-02-06 12:02:13 +00001118 return rc;
1119}
1120
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001121static int gsm48_rx_rr_app_info(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001122{
1123 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001124 uint8_t apdu_id_flags;
1125 uint8_t apdu_len;
1126 uint8_t *apdu_data;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001127
1128 apdu_id_flags = gh->data[0];
1129 apdu_len = gh->data[1];
1130 apdu_data = gh->data+2;
1131
Harald Welte70f92052012-07-16 13:22:19 +02001132 DEBUGP(DRR, "RX APPLICATION INFO id/flags=0x%02x apdu_len=%u apdu=%s",
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +02001133 apdu_id_flags, apdu_len, osmo_hexdump(apdu_data, apdu_len));
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001134
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001135 return db_apdu_blob_store(conn->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001136}
1137
Harald Weltebf5e8df2009-02-03 12:59:45 +00001138/* Receive a GSM 04.08 Radio Resource (RR) message */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001139static int gsm0408_rcv_rr(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001140{
1141 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001142 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001143
1144 switch (gh->msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001145 case GSM48_MT_RR_PAG_RESP:
Holger Hans Peter Freytherdb4ef0d2010-06-21 10:46:44 +08001146 rc = gsm48_rx_rr_pag_resp(conn, msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001147 break;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001148 case GSM48_MT_RR_APP_INFO:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08001149 rc = gsm48_rx_rr_app_info(conn, msg);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001150 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001151 default:
Harald Weltecf149ee2012-01-23 16:40:24 +01001152 LOGP(DRR, LOGL_NOTICE, "MSC: Unimplemented "
Harald Welte5d24ba12009-12-24 12:13:17 +01001153 "GSM 04.08 RR msg type 0x%02x\n", gh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001154 break;
1155 }
1156
Harald Welte2d35ae62009-02-06 12:02:13 +00001157 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001158}
1159
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001160int gsm48_send_rr_app_info(struct gsm_subscriber_connection *conn, uint8_t apdu_id,
1161 uint8_t apdu_len, const uint8_t *apdu)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001162{
1163 struct msgb *msg = gsm48_msgb_alloc();
1164 struct gsm48_hdr *gh;
1165
Holger Hans Peter Freyther9ce1b272010-06-16 13:52:55 +08001166 msg->lchan = conn->lchan;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001167
1168 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1169 apdu_id, apdu_len);
1170
1171 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1172 gh->proto_discr = GSM48_PDISC_RR;
1173 gh->msg_type = GSM48_MT_RR_APP_INFO;
1174 gh->data[0] = apdu_id;
1175 gh->data[1] = apdu_len;
1176 memcpy(gh->data+2, apdu, apdu_len);
1177
Holger Hans Peter Freyther9ce1b272010-06-16 13:52:55 +08001178 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001179}
1180
Harald Welte4bc90a12008-12-27 16:32:52 +00001181/* Call Control */
1182
Harald Welte7584aea2009-02-11 11:44:12 +00001183/* The entire call control code is written in accordance with Figure 7.10c
1184 * for 'very early assignment', i.e. we allocate a TCH/F during IMMEDIATE
1185 * ASSIGN, then first use that TCH/F for signalling and later MODE MODIFY
1186 * it for voice */
1187
Harald Welte4bfdfe72009-06-10 23:11:52 +08001188static void new_cc_state(struct gsm_trans *trans, int state)
1189{
1190 if (state > 31 || state < 0)
1191 return;
1192
1193 DEBUGP(DCC, "new state %s -> %s\n",
Harald Weltee95daf12010-03-25 12:13:02 +08001194 gsm48_cc_state_name(trans->cc.state),
1195 gsm48_cc_state_name(state));
Harald Welte4bfdfe72009-06-10 23:11:52 +08001196
Harald Weltedcaf5652009-07-23 18:56:43 +02001197 trans->cc.state = state;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001198}
1199
1200static int gsm48_cc_tx_status(struct gsm_trans *trans, void *arg)
Harald Welte4bc90a12008-12-27 16:32:52 +00001201{
1202 struct msgb *msg = gsm48_msgb_alloc();
1203 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001204 uint8_t *cause, *call_state;
Harald Welte4bc90a12008-12-27 16:32:52 +00001205
Harald Welte4bc90a12008-12-27 16:32:52 +00001206 gh->msg_type = GSM48_MT_CC_STATUS;
1207
1208 cause = msgb_put(msg, 3);
1209 cause[0] = 2;
1210 cause[1] = GSM48_CAUSE_CS_GSM | GSM48_CAUSE_LOC_USER;
1211 cause[2] = 0x80 | 30; /* response to status inquiry */
1212
1213 call_state = msgb_put(msg, 1);
1214 call_state[0] = 0xc0 | 0x00;
1215
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08001216 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bc90a12008-12-27 16:32:52 +00001217}
1218
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001219static int gsm48_tx_simple(struct gsm_subscriber_connection *conn,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001220 uint8_t pdisc, uint8_t msg_type)
Harald Welte4bc90a12008-12-27 16:32:52 +00001221{
1222 struct msgb *msg = gsm48_msgb_alloc();
1223 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1224
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001225 msg->lchan = conn->lchan;
Harald Welte4bc90a12008-12-27 16:32:52 +00001226
Harald Welte6f4b7532008-12-29 00:39:37 +00001227 gh->proto_discr = pdisc;
Harald Welte4bc90a12008-12-27 16:32:52 +00001228 gh->msg_type = msg_type;
1229
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08001230 return gsm48_conn_sendmsg(msg, conn, NULL);
Harald Welte4bc90a12008-12-27 16:32:52 +00001231}
1232
Harald Welte4bfdfe72009-06-10 23:11:52 +08001233static void gsm48_stop_cc_timer(struct gsm_trans *trans)
1234{
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001235 if (osmo_timer_pending(&trans->cc.timer)) {
Harald Weltedcaf5652009-07-23 18:56:43 +02001236 DEBUGP(DCC, "stopping pending timer T%x\n", trans->cc.Tcurrent);
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001237 osmo_timer_del(&trans->cc.timer);
Harald Weltedcaf5652009-07-23 18:56:43 +02001238 trans->cc.Tcurrent = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001239 }
1240}
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001241
Harald Welte4bfdfe72009-06-10 23:11:52 +08001242static int mncc_recvmsg(struct gsm_network *net, struct gsm_trans *trans,
1243 int msg_type, struct gsm_mncc *mncc)
1244{
1245 struct msgb *msg;
Harald Welte04dc88f2010-12-22 21:45:05 +01001246 unsigned char *data;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001247
1248 if (trans)
Harald Welteb854b292010-12-26 19:06:37 +01001249 if (trans->conn && trans->conn->lchan)
Harald Welte6f5aee02009-07-23 21:21:14 +02001250 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08001251 "Sending '%s' to MNCC.\n",
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001252 trans->conn->lchan->ts->trx->bts->nr,
1253 trans->conn->lchan->ts->trx->nr,
1254 trans->conn->lchan->ts->nr, trans->transaction_id,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001255 (trans->subscr)?(trans->subscr->extension):"-",
1256 get_mncc_name(msg_type));
1257 else
1258 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
1259 "Sending '%s' to MNCC.\n",
1260 (trans->subscr)?(trans->subscr->extension):"-",
1261 get_mncc_name(msg_type));
1262 else
1263 DEBUGP(DCC, "(bts - trx - ts - ti -- sub -) "
1264 "Sending '%s' to MNCC.\n", get_mncc_name(msg_type));
1265
1266 mncc->msg_type = msg_type;
1267
Harald Welte966636f2009-06-26 19:39:35 +02001268 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08001269 if (!msg)
1270 return -ENOMEM;
Harald Welte04dc88f2010-12-22 21:45:05 +01001271
1272 data = msgb_put(msg, sizeof(struct gsm_mncc));
1273 memcpy(data, mncc, sizeof(struct gsm_mncc));
1274
Harald Welte54209c22010-12-22 23:43:29 +01001275 cc_tx_to_mncc(net, msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001276
1277 return 0;
1278}
1279
1280int mncc_release_ind(struct gsm_network *net, struct gsm_trans *trans,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001281 uint32_t callref, int location, int value)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001282{
1283 struct gsm_mncc rel;
1284
Harald Welte92f70c52009-06-12 01:54:08 +08001285 memset(&rel, 0, sizeof(rel));
Harald Welte4bfdfe72009-06-10 23:11:52 +08001286 rel.callref = callref;
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001287 mncc_set_cause(&rel, location, value);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001288 return mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
1289}
1290
Harald Weltedcaf5652009-07-23 18:56:43 +02001291/* Call Control Specific transaction release.
1292 * gets called by trans_free, DO NOT CALL YOURSELF! */
1293void _gsm48_cc_trans_free(struct gsm_trans *trans)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001294{
Harald Welte4bfdfe72009-06-10 23:11:52 +08001295 gsm48_stop_cc_timer(trans);
1296
1297 /* send release to L4, if callref still exists */
1298 if (trans->callref) {
1299 /* Ressource unavailable */
Harald Welte596fed42009-07-23 19:06:52 +02001300 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001301 GSM48_CAUSE_LOC_PRN_S_LU,
1302 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001303 }
Harald Weltedcaf5652009-07-23 18:56:43 +02001304 if (trans->cc.state != GSM_CSTATE_NULL)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001305 new_cc_state(trans, GSM_CSTATE_NULL);
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001306 if (trans->conn)
1307 trau_mux_unmap(&trans->conn->lchan->ts->e1_link, trans->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001308}
1309
1310static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001311
Harald Welte09e38af2009-02-16 22:52:23 +00001312/* call-back from paging the B-end of the connection */
1313static int setup_trig_pag_evt(unsigned int hooknum, unsigned int event,
Holger Hans Peter Freyther86481c22010-06-17 15:05:57 +08001314 struct msgb *msg, void *_conn, void *param)
Harald Welte09e38af2009-02-16 22:52:23 +00001315{
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001316 int found = 0;
Holger Hans Peter Freyther86481c22010-06-17 15:05:57 +08001317 struct gsm_subscriber_connection *conn = _conn;
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001318 struct gsm_network **paging_request = param, *net;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001319 struct gsm_trans *transt, *tmp;
Harald Weltec05677b2009-06-26 20:17:06 +02001320
Harald Welte09e38af2009-02-16 22:52:23 +00001321 if (hooknum != GSM_HOOK_RR_PAGING)
1322 return -EINVAL;
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001323
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001324 net = *paging_request;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001325 if (!net) {
1326 DEBUGP(DCC, "Error Network not set!\n");
1327 return -EINVAL;
Harald Welte5a065df2009-02-22 21:13:18 +00001328 }
Harald Welte7584aea2009-02-11 11:44:12 +00001329
Harald Welte4bfdfe72009-06-10 23:11:52 +08001330 /* check all tranactions (without lchan) for subscriber */
1331 llist_for_each_entry_safe(transt, tmp, &net->trans_list, entry) {
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001332 if (transt->paging_request != paging_request || transt->conn)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001333 continue;
1334 switch (event) {
1335 case GSM_PAGING_SUCCEEDED:
Holger Hans Peter Freyther86481c22010-06-17 15:05:57 +08001336 if (!conn) // paranoid
Harald Welte4bfdfe72009-06-10 23:11:52 +08001337 break;
1338 DEBUGP(DCC, "Paging subscr %s succeeded!\n",
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001339 transt->subscr->extension);
1340 found = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001341 /* Assign lchan */
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001342 if (!transt->conn) {
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001343 transt->paging_request = NULL;
Holger Hans Peter Freyther86481c22010-06-17 15:05:57 +08001344 transt->conn = conn;
Holger Hans Peter Freyther182c81f2010-12-29 16:28:33 +01001345 conn->put_channel = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001346 }
1347 /* send SETUP request to called party */
Harald Weltedcaf5652009-07-23 18:56:43 +02001348 gsm48_cc_tx_setup(transt, &transt->cc.msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001349 break;
1350 case GSM_PAGING_EXPIRED:
Holger Hans Peter Freytherd3baf412010-12-23 18:19:17 +01001351 case GSM_PAGING_BUSY:
Harald Welte4bfdfe72009-06-10 23:11:52 +08001352 DEBUGP(DCC, "Paging subscr %s expired!\n",
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001353 transt->subscr->extension);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001354 /* Temporarily out of order */
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001355 found = 1;
Harald Welte596fed42009-07-23 19:06:52 +02001356 mncc_release_ind(transt->subscr->net, transt,
1357 transt->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001358 GSM48_CAUSE_LOC_PRN_S_LU,
1359 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001360 transt->callref = 0;
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001361 transt->paging_request = NULL;
Harald Weltedcaf5652009-07-23 18:56:43 +02001362 trans_free(transt);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001363 break;
1364 }
1365 }
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01001366
1367 talloc_free(paging_request);
1368
1369 /*
1370 * FIXME: The queue needs to be kicked. This is likely to go through a RF
1371 * failure and then the subscr will be poke again. This needs a lot of fixing
1372 * in the subscriber queue code.
1373 */
1374 if (!found && conn)
1375 conn->put_channel = 1;
Harald Welte09e38af2009-02-16 22:52:23 +00001376 return 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00001377}
Harald Welte7584aea2009-02-11 11:44:12 +00001378
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001379static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable);
Harald Welteda7ab742009-12-19 22:23:05 +01001380
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001381/* handle audio path for handover */
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001382static int switch_for_handover(struct gsm_lchan *old_lchan,
1383 struct gsm_lchan *new_lchan)
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001384{
1385 struct rtp_socket *old_rs, *new_rs, *other_rs;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001386
1387 if (ipacc_rtp_direct) {
1388 LOGP(DHO, LOGL_ERROR, "unable to handover in direct RTP mode\n");
1389 return 0;
1390 }
1391
1392 /* RTP Proxy mode */
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001393 new_rs = new_lchan->abis_ip.rtp_socket;
1394 old_rs = old_lchan->abis_ip.rtp_socket;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001395
1396 if (!new_rs) {
1397 LOGP(DHO, LOGL_ERROR, "no RTP socket for new_lchan\n");
1398 return -EIO;
1399 }
1400
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001401 rsl_ipacc_mdcx_to_rtpsock(new_lchan);
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001402
1403 if (!old_rs) {
1404 LOGP(DHO, LOGL_ERROR, "no RTP socket for old_lchan\n");
1405 return -EIO;
1406 }
1407
1408 /* copy rx_action and reference to other sock */
1409 new_rs->rx_action = old_rs->rx_action;
1410 new_rs->tx_action = old_rs->tx_action;
1411 new_rs->transmit = old_rs->transmit;
1412
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001413 switch (old_lchan->abis_ip.rtp_socket->rx_action) {
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001414 case RTP_PROXY:
1415 other_rs = old_rs->proxy.other_sock;
1416 rtp_socket_proxy(new_rs, other_rs);
1417 /* delete reference to other end socket to prevent
1418 * rtp_socket_free() from removing the inverse reference */
1419 old_rs->proxy.other_sock = NULL;
1420 break;
1421 case RTP_RECV_UPSTREAM:
1422 new_rs->receive = old_rs->receive;
1423 break;
1424 case RTP_NONE:
1425 break;
1426 }
1427
1428 return 0;
1429}
1430
Harald Welte805f6442009-07-28 18:25:29 +02001431/* some other part of the code sends us a signal */
1432static int handle_abisip_signal(unsigned int subsys, unsigned int signal,
1433 void *handler_data, void *signal_data)
1434{
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001435 struct gsm_lchan *lchan = signal_data, *old_lchan;
Harald Welte805f6442009-07-28 18:25:29 +02001436 int rc;
Harald Welteda7ab742009-12-19 22:23:05 +01001437 struct gsm_network *net;
1438 struct gsm_trans *trans;
Harald Welte805f6442009-07-28 18:25:29 +02001439
1440 if (subsys != SS_ABISIP)
1441 return 0;
1442
1443 /* in case we use direct BTS-to-BTS RTP */
1444 if (ipacc_rtp_direct)
1445 return 0;
1446
Harald Welte805f6442009-07-28 18:25:29 +02001447 switch (signal) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001448 case S_ABISIP_CRCX_ACK:
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001449 /* in case we don't use direct BTS-to-BTS RTP */
1450 /* the BTS has successfully bound a TCH to a local ip/port,
1451 * which means we can connect our UDP socket to it */
1452 if (lchan->abis_ip.rtp_socket) {
1453 rtp_socket_free(lchan->abis_ip.rtp_socket);
1454 lchan->abis_ip.rtp_socket = NULL;
1455 }
1456
1457 lchan->abis_ip.rtp_socket = rtp_socket_create();
1458 if (!lchan->abis_ip.rtp_socket)
1459 return -EIO;
1460
1461 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1462 lchan->abis_ip.bound_ip,
1463 lchan->abis_ip.bound_port);
1464 if (rc < 0)
1465 return -EIO;
1466
Harald Welteda7ab742009-12-19 22:23:05 +01001467 /* check if any transactions on this lchan still have
1468 * a tch_recv_mncc request pending */
1469 net = lchan->ts->trx->bts->network;
1470 llist_for_each_entry(trans, &net->trans_list, entry) {
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001471 if (trans->conn && trans->conn->lchan == lchan && trans->tch_recv) {
Harald Welteda7ab742009-12-19 22:23:05 +01001472 DEBUGP(DCC, "pending tch_recv_mncc request\n");
1473 tch_recv_mncc(net, trans->callref, 1);
1474 }
1475 }
Holger Hans Peter Freytherc121bb32012-12-26 10:17:42 +01001476
1477 /*
1478 * TODO: this appears to be too early? Why not until after
1479 * the handover detect or the handover complete?
1480 *
1481 * Do we have a handover pending for this new lchan? In that
1482 * case re-route the audio from the old channel to the new one.
1483 */
1484 old_lchan = bsc_handover_pending(lchan);
1485 if (old_lchan)
1486 switch_for_handover(old_lchan, lchan);
Harald Welte805f6442009-07-28 18:25:29 +02001487 break;
Holger Hans Peter Freyther6c4d2442011-01-06 13:31:41 +01001488 case S_ABISIP_DLCX_IND:
1489 /* the BTS tells us a RTP stream has been disconnected */
1490 if (lchan->abis_ip.rtp_socket) {
1491 rtp_socket_free(lchan->abis_ip.rtp_socket);
1492 lchan->abis_ip.rtp_socket = NULL;
1493 }
1494
1495 break;
Harald Welte805f6442009-07-28 18:25:29 +02001496 }
1497
1498 return 0;
Harald Welte805f6442009-07-28 18:25:29 +02001499}
1500
Harald Welte49f48b82009-02-17 15:29:33 +00001501/* map two ipaccess RTP streams onto each other */
Harald Welte11fa29c2009-02-19 17:24:39 +00001502static int tch_map(struct gsm_lchan *lchan, struct gsm_lchan *remote_lchan)
Harald Welte49f48b82009-02-17 15:29:33 +00001503{
Harald Welte11fa29c2009-02-19 17:24:39 +00001504 struct gsm_bts *bts = lchan->ts->trx->bts;
1505 struct gsm_bts *remote_bts = remote_lchan->ts->trx->bts;
Harald Welte805f6442009-07-28 18:25:29 +02001506 int rc;
Harald Welte49f48b82009-02-17 15:29:33 +00001507
Harald Welte11fa29c2009-02-19 17:24:39 +00001508 DEBUGP(DCC, "Setting up TCH map between (bts=%u,trx=%u,ts=%u) and (bts=%u,trx=%u,ts=%u)\n",
1509 bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
1510 remote_bts->nr, remote_lchan->ts->trx->nr, remote_lchan->ts->nr);
1511
1512 if (bts->type != remote_bts->type) {
Harald Weltee5215b52011-08-09 21:53:20 +02001513 LOGP(DCC, LOGL_ERROR, "Cannot switch calls between different BTS types yet\n");
Harald Welte11fa29c2009-02-19 17:24:39 +00001514 return -EINVAL;
1515 }
Harald Welteda7ab742009-12-19 22:23:05 +01001516
1517 // todo: map between different bts types
Harald Welte11fa29c2009-02-19 17:24:39 +00001518 switch (bts->type) {
Mike Habene2d82272009-10-02 12:19:34 +01001519 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02001520 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte805f6442009-07-28 18:25:29 +02001521 if (!ipacc_rtp_direct) {
1522 /* connect the TCH's to our RTP proxy */
Harald Weltea72273e2009-12-20 16:51:09 +01001523 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welte805f6442009-07-28 18:25:29 +02001524 if (rc < 0)
1525 return rc;
Harald Weltea72273e2009-12-20 16:51:09 +01001526 rc = rsl_ipacc_mdcx_to_rtpsock(remote_lchan);
Harald Welte4d54d0b2011-02-19 16:48:17 +01001527 if (rc < 0)
1528 return rc;
Harald Welte805f6442009-07-28 18:25:29 +02001529 /* connect them with each other */
Harald Welte2c828992009-12-02 01:56:49 +05301530 rtp_socket_proxy(lchan->abis_ip.rtp_socket,
1531 remote_lchan->abis_ip.rtp_socket);
Harald Welte805f6442009-07-28 18:25:29 +02001532 } else {
1533 /* directly connect TCH RTP streams to each other */
Harald Welte2c828992009-12-02 01:56:49 +05301534 rc = rsl_ipacc_mdcx(lchan, remote_lchan->abis_ip.bound_ip,
1535 remote_lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301536 remote_lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001537 if (rc < 0)
1538 return rc;
Harald Welte2c828992009-12-02 01:56:49 +05301539 rc = rsl_ipacc_mdcx(remote_lchan, lchan->abis_ip.bound_ip,
1540 lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301541 lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001542 }
Harald Welte11fa29c2009-02-19 17:24:39 +00001543 break;
1544 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03001545 case GSM_BTS_TYPE_RBS2000:
Dieter Spaar16646022011-07-28 00:01:50 +02001546 case GSM_BTS_TYPE_NOKIA_SITE:
Harald Welte11fa29c2009-02-19 17:24:39 +00001547 trau_mux_map_lchan(lchan, remote_lchan);
1548 break;
1549 default:
Harald Weltee5215b52011-08-09 21:53:20 +02001550 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01001551 return -EINVAL;
Harald Welte11fa29c2009-02-19 17:24:39 +00001552 }
Harald Welte49f48b82009-02-17 15:29:33 +00001553
1554 return 0;
1555}
1556
Harald Welte4bfdfe72009-06-10 23:11:52 +08001557/* bridge channels of two transactions */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001558static int tch_bridge(struct gsm_network *net, uint32_t *refs)
Harald Welte7ccf7782009-02-17 01:43:01 +00001559{
Harald Weltedcaf5652009-07-23 18:56:43 +02001560 struct gsm_trans *trans1 = trans_find_by_callref(net, refs[0]);
1561 struct gsm_trans *trans2 = trans_find_by_callref(net, refs[1]);
Harald Welte7ccf7782009-02-17 01:43:01 +00001562
Harald Welte4bfdfe72009-06-10 23:11:52 +08001563 if (!trans1 || !trans2)
Harald Welte7ccf7782009-02-17 01:43:01 +00001564 return -EIO;
1565
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001566 if (!trans1->conn || !trans2->conn)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001567 return -EIO;
1568
1569 /* through-connect channel */
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001570 return tch_map(trans1->conn->lchan, trans2->conn->lchan);
Harald Welte7ccf7782009-02-17 01:43:01 +00001571}
1572
Harald Welteda7ab742009-12-19 22:23:05 +01001573/* enable receive of channels to MNCC upqueue */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001574static int tch_recv_mncc(struct gsm_network *net, uint32_t callref, int enable)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001575{
1576 struct gsm_trans *trans;
Harald Welteda7ab742009-12-19 22:23:05 +01001577 struct gsm_lchan *lchan;
1578 struct gsm_bts *bts;
1579 int rc;
Harald Welte7ccf7782009-02-17 01:43:01 +00001580
Harald Welte4bfdfe72009-06-10 23:11:52 +08001581 /* Find callref */
Harald Welteda7ab742009-12-19 22:23:05 +01001582 trans = trans_find_by_callref(net, callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001583 if (!trans)
1584 return -EIO;
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001585 if (!trans->conn)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001586 return 0;
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01001587 lchan = trans->conn->lchan;
Harald Welteda7ab742009-12-19 22:23:05 +01001588 bts = lchan->ts->trx->bts;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001589
Harald Welteda7ab742009-12-19 22:23:05 +01001590 switch (bts->type) {
1591 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02001592 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welteda7ab742009-12-19 22:23:05 +01001593 if (ipacc_rtp_direct) {
Harald Weltee5215b52011-08-09 21:53:20 +02001594 LOGP(DCC, LOGL_ERROR, "Error: RTP proxy is disabled\n");
Harald Welteda7ab742009-12-19 22:23:05 +01001595 return -EINVAL;
1596 }
1597 /* in case, we don't have a RTP socket yet, we note this
1598 * in the transaction and try later */
1599 if (!lchan->abis_ip.rtp_socket) {
1600 trans->tch_recv = enable;
1601 DEBUGP(DCC, "queue tch_recv_mncc request (%d)\n", enable);
1602 return 0;
1603 }
1604 if (enable) {
1605 /* connect the TCH's to our RTP proxy */
Harald Weltea72273e2009-12-20 16:51:09 +01001606 rc = rsl_ipacc_mdcx_to_rtpsock(lchan);
Harald Welteda7ab742009-12-19 22:23:05 +01001607 if (rc < 0)
1608 return rc;
1609 /* assign socket to application interface */
1610 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1611 net, callref);
1612 } else
1613 rtp_socket_upstream(lchan->abis_ip.rtp_socket,
1614 net, 0);
1615 break;
1616 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03001617 case GSM_BTS_TYPE_RBS2000:
Harald Welte10456972011-08-05 20:11:18 +02001618 case GSM_BTS_TYPE_NOKIA_SITE:
Harald Welteda7ab742009-12-19 22:23:05 +01001619 if (enable)
1620 return trau_recv_lchan(lchan, callref);
1621 return trau_mux_unmap(NULL, callref);
1622 break;
1623 default:
Harald Weltee5215b52011-08-09 21:53:20 +02001624 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01001625 return -EINVAL;
1626 }
1627
1628 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001629}
1630
Harald Welte4bfdfe72009-06-10 23:11:52 +08001631static int gsm48_cc_rx_status_enq(struct gsm_trans *trans, struct msgb *msg)
1632{
1633 DEBUGP(DCC, "-> STATUS ENQ\n");
1634 return gsm48_cc_tx_status(trans, msg);
1635}
1636
1637static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg);
1638static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg);
1639
1640static void gsm48_cc_timeout(void *arg)
1641{
1642 struct gsm_trans *trans = arg;
1643 int disconnect = 0, release = 0;
Harald Weltec66b71c2009-06-11 14:23:20 +08001644 int mo_cause = GSM48_CC_CAUSE_RECOVERY_TIMER;
1645 int mo_location = GSM48_CAUSE_LOC_USER;
1646 int l4_cause = GSM48_CC_CAUSE_NORMAL_UNSPEC;
1647 int l4_location = GSM48_CAUSE_LOC_PRN_S_LU;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001648 struct gsm_mncc mo_rel, l4_rel;
1649
1650 memset(&mo_rel, 0, sizeof(struct gsm_mncc));
1651 mo_rel.callref = trans->callref;
1652 memset(&l4_rel, 0, sizeof(struct gsm_mncc));
1653 l4_rel.callref = trans->callref;
1654
Harald Weltedcaf5652009-07-23 18:56:43 +02001655 switch(trans->cc.Tcurrent) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08001656 case 0x303:
1657 release = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001658 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001659 break;
1660 case 0x310:
1661 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001662 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001663 break;
1664 case 0x313:
1665 disconnect = 1;
1666 /* unknown, did not find it in the specs */
1667 break;
1668 case 0x301:
1669 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08001670 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001671 break;
1672 case 0x308:
Harald Weltedcaf5652009-07-23 18:56:43 +02001673 if (!trans->cc.T308_second) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08001674 /* restart T308 a second time */
Harald Weltedcaf5652009-07-23 18:56:43 +02001675 gsm48_cc_tx_release(trans, &trans->cc.msg);
1676 trans->cc.T308_second = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001677 break; /* stay in release state */
1678 }
Harald Weltedcaf5652009-07-23 18:56:43 +02001679 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001680 return;
1681// release = 1;
1682// l4_cause = 14;
1683// break;
1684 case 0x306:
1685 release = 1;
Harald Weltedcaf5652009-07-23 18:56:43 +02001686 mo_cause = trans->cc.msg.cause.value;
1687 mo_location = trans->cc.msg.cause.location;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001688 break;
1689 case 0x323:
1690 disconnect = 1;
1691 break;
1692 default:
1693 release = 1;
1694 }
1695
1696 if (release && trans->callref) {
1697 /* process release towards layer 4 */
Harald Welte596fed42009-07-23 19:06:52 +02001698 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001699 l4_location, l4_cause);
1700 trans->callref = 0;
1701 }
1702
1703 if (disconnect && trans->callref) {
1704 /* process disconnect towards layer 4 */
1705 mncc_set_cause(&l4_rel, l4_location, l4_cause);
Harald Welte596fed42009-07-23 19:06:52 +02001706 mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &l4_rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001707 }
1708
1709 /* process disconnect towards mobile station */
1710 if (disconnect || release) {
1711 mncc_set_cause(&mo_rel, mo_location, mo_cause);
Harald Weltedcaf5652009-07-23 18:56:43 +02001712 mo_rel.cause.diag[0] = ((trans->cc.Tcurrent & 0xf00) >> 8) + '0';
1713 mo_rel.cause.diag[1] = ((trans->cc.Tcurrent & 0x0f0) >> 4) + '0';
1714 mo_rel.cause.diag[2] = (trans->cc.Tcurrent & 0x00f) + '0';
Harald Welte4bfdfe72009-06-10 23:11:52 +08001715 mo_rel.cause.diag_len = 3;
1716
1717 if (disconnect)
1718 gsm48_cc_tx_disconnect(trans, &mo_rel);
1719 if (release)
1720 gsm48_cc_tx_release(trans, &mo_rel);
1721 }
1722
1723}
1724
1725static void gsm48_start_cc_timer(struct gsm_trans *trans, int current,
1726 int sec, int micro)
1727{
1728 DEBUGP(DCC, "starting timer T%x with %d seconds\n", current, sec);
Harald Weltedcaf5652009-07-23 18:56:43 +02001729 trans->cc.timer.cb = gsm48_cc_timeout;
1730 trans->cc.timer.data = trans;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001731 osmo_timer_schedule(&trans->cc.timer, sec, micro);
Harald Weltedcaf5652009-07-23 18:56:43 +02001732 trans->cc.Tcurrent = current;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001733}
1734
1735static int gsm48_cc_rx_setup(struct gsm_trans *trans, struct msgb *msg)
1736{
1737 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001738 uint8_t msg_type = gh->msg_type & 0xbf;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001739 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1740 struct tlv_parsed tp;
1741 struct gsm_mncc setup;
1742
1743 memset(&setup, 0, sizeof(struct gsm_mncc));
1744 setup.callref = trans->callref;
Harald Welteab386e62011-09-01 18:18:43 +02001745 if (trans->conn && trans->conn->lchan)
1746 setup.lchan_type = trans->conn->lchan->type;
Harald Welte474d19f2010-03-02 23:18:30 +01001747 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001748 /* emergency setup is identified by msg_type */
1749 if (msg_type == GSM48_MT_CC_EMERG_SETUP)
1750 setup.emergency = 1;
1751
1752 /* use subscriber as calling party number */
1753 if (trans->subscr) {
1754 setup.fields |= MNCC_F_CALLING;
1755 strncpy(setup.calling.number, trans->subscr->extension,
1756 sizeof(setup.calling.number)-1);
Andreas Eversbergc079be42009-06-15 23:22:09 +02001757 strncpy(setup.imsi, trans->subscr->imsi,
1758 sizeof(setup.imsi)-1);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001759 }
1760 /* bearer capability */
1761 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
1762 setup.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001763 gsm48_decode_bearer_cap(&setup.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001764 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
1765 }
1766 /* facility */
1767 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
1768 setup.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01001769 gsm48_decode_facility(&setup.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001770 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
1771 }
1772 /* called party bcd number */
1773 if (TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) {
1774 setup.fields |= MNCC_F_CALLED;
Harald Welte55c8f352010-03-07 23:40:35 +01001775 gsm48_decode_called(&setup.called,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001776 TLVP_VAL(&tp, GSM48_IE_CALLED_BCD)-1);
1777 }
1778 /* user-user */
1779 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
1780 setup.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01001781 gsm48_decode_useruser(&setup.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001782 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
1783 }
1784 /* ss-version */
1785 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
1786 setup.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01001787 gsm48_decode_ssversion(&setup.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001788 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
1789 }
1790 /* CLIR suppression */
1791 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_SUPP))
1792 setup.clir.sup = 1;
1793 /* CLIR invocation */
1794 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_INVOC))
1795 setup.clir.inv = 1;
1796 /* cc cap */
1797 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
1798 setup.fields |= MNCC_F_CCCAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001799 gsm48_decode_cccap(&setup.cccap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001800 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
1801 }
1802
Harald Welte4bfdfe72009-06-10 23:11:52 +08001803 new_cc_state(trans, GSM_CSTATE_INITIATED);
1804
Harald Welte (local)47df3992009-12-26 19:45:03 +01001805 LOGP(DCC, LOGL_INFO, "Subscriber %s (%s) sends SETUP to %s\n",
1806 subscr_name(trans->subscr), trans->subscr->extension,
1807 setup.called.number);
1808
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001809 osmo_counter_inc(trans->subscr->net->stats.call.mo_setup);
Harald Weltea29e43a2010-12-24 16:06:33 +01001810
Harald Welte4bfdfe72009-06-10 23:11:52 +08001811 /* indicate setup to MNCC */
Harald Welte596fed42009-07-23 19:06:52 +02001812 mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_IND, &setup);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001813
Harald Welte13cac662009-07-29 12:10:35 +02001814 /* MNCC code will modify the channel asynchronously, we should
1815 * ipaccess-bind only after the modification has been made to the
1816 * lchan->tch_mode */
Harald Welte4bfdfe72009-06-10 23:11:52 +08001817 return 0;
1818}
1819
1820static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg)
Harald Welte65e74cc2008-12-29 01:55:35 +00001821{
1822 struct msgb *msg = gsm48_msgb_alloc();
1823 struct gsm48_hdr *gh;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001824 struct gsm_mncc *setup = arg;
Harald Welte78283ef2009-07-23 21:36:44 +02001825 int rc, trans_id;
Harald Welte65e74cc2008-12-29 01:55:35 +00001826
Harald Welte7ccf7782009-02-17 01:43:01 +00001827 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Welte65e74cc2008-12-29 01:55:35 +00001828
Harald Welte4bfdfe72009-06-10 23:11:52 +08001829 /* transaction id must not be assigned */
1830 if (trans->transaction_id != 0xff) { /* unasssigned */
1831 DEBUGP(DCC, "TX Setup with assigned transaction. "
1832 "This is not allowed!\n");
1833 /* Temporarily out of order */
Harald Welte596fed42009-07-23 19:06:52 +02001834 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001835 GSM48_CAUSE_LOC_PRN_S_LU,
1836 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001837 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02001838 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001839 return rc;
1840 }
1841
1842 /* Get free transaction_id */
Harald Welte78283ef2009-07-23 21:36:44 +02001843 trans_id = trans_assign_trans_id(trans->subscr, GSM48_PDISC_CC, 0);
1844 if (trans_id < 0) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08001845 /* no free transaction ID */
Harald Welte596fed42009-07-23 19:06:52 +02001846 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001847 GSM48_CAUSE_LOC_PRN_S_LU,
1848 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001849 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02001850 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001851 return rc;
1852 }
Harald Welte78283ef2009-07-23 21:36:44 +02001853 trans->transaction_id = trans_id;
Harald Welte49f48b82009-02-17 15:29:33 +00001854
Harald Welte65e74cc2008-12-29 01:55:35 +00001855 gh->msg_type = GSM48_MT_CC_SETUP;
Harald Welte09e38af2009-02-16 22:52:23 +00001856
Harald Welte4bfdfe72009-06-10 23:11:52 +08001857 gsm48_start_cc_timer(trans, 0x303, GSM48_T303);
Harald Welte65e74cc2008-12-29 01:55:35 +00001858
Harald Welte4bfdfe72009-06-10 23:11:52 +08001859 /* bearer capability */
1860 if (setup->fields & MNCC_F_BEARER_CAP)
Harald Welte55c8f352010-03-07 23:40:35 +01001861 gsm48_encode_bearer_cap(msg, 0, &setup->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001862 /* facility */
1863 if (setup->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01001864 gsm48_encode_facility(msg, 0, &setup->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001865 /* progress */
1866 if (setup->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01001867 gsm48_encode_progress(msg, 0, &setup->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001868 /* calling party BCD number */
1869 if (setup->fields & MNCC_F_CALLING)
Harald Welte55c8f352010-03-07 23:40:35 +01001870 gsm48_encode_calling(msg, &setup->calling);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001871 /* called party BCD number */
1872 if (setup->fields & MNCC_F_CALLED)
Harald Welte55c8f352010-03-07 23:40:35 +01001873 gsm48_encode_called(msg, &setup->called);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001874 /* user-user */
1875 if (setup->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01001876 gsm48_encode_useruser(msg, 0, &setup->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001877 /* redirecting party BCD number */
1878 if (setup->fields & MNCC_F_REDIRECTING)
Harald Welte55c8f352010-03-07 23:40:35 +01001879 gsm48_encode_redirecting(msg, &setup->redirecting);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001880 /* signal */
1881 if (setup->fields & MNCC_F_SIGNAL)
Harald Welte55c8f352010-03-07 23:40:35 +01001882 gsm48_encode_signal(msg, setup->signal);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001883
1884 new_cc_state(trans, GSM_CSTATE_CALL_PRESENT);
Harald Welte65e74cc2008-12-29 01:55:35 +00001885
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001886 osmo_counter_inc(trans->subscr->net->stats.call.mt_setup);
Harald Weltea29e43a2010-12-24 16:06:33 +01001887
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08001888 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte65e74cc2008-12-29 01:55:35 +00001889}
1890
Harald Welte4bfdfe72009-06-10 23:11:52 +08001891static int gsm48_cc_rx_call_conf(struct gsm_trans *trans, struct msgb *msg)
1892{
1893 struct gsm48_hdr *gh = msgb_l3(msg);
1894 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1895 struct tlv_parsed tp;
1896 struct gsm_mncc call_conf;
1897
1898 gsm48_stop_cc_timer(trans);
1899 gsm48_start_cc_timer(trans, 0x310, GSM48_T310);
1900
1901 memset(&call_conf, 0, sizeof(struct gsm_mncc));
1902 call_conf.callref = trans->callref;
Harald Welteab386e62011-09-01 18:18:43 +02001903 if (trans->conn && trans->conn->lchan)
1904 call_conf.lchan_type = trans->conn->lchan->type;
Harald Welte474d19f2010-03-02 23:18:30 +01001905 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001906#if 0
1907 /* repeat */
1908 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_CIR))
1909 call_conf.repeat = 1;
1910 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_SEQ))
1911 call_conf.repeat = 2;
1912#endif
1913 /* bearer capability */
1914 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
1915 call_conf.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001916 gsm48_decode_bearer_cap(&call_conf.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001917 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
1918 }
1919 /* cause */
1920 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
1921 call_conf.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01001922 gsm48_decode_cause(&call_conf.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001923 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
1924 }
1925 /* cc cap */
1926 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
1927 call_conf.fields |= MNCC_F_CCCAP;
Harald Welte55c8f352010-03-07 23:40:35 +01001928 gsm48_decode_cccap(&call_conf.cccap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001929 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
1930 }
1931
1932 new_cc_state(trans, GSM_CSTATE_MO_TERM_CALL_CONF);
1933
Harald Welte596fed42009-07-23 19:06:52 +02001934 return mncc_recvmsg(trans->subscr->net, trans, MNCC_CALL_CONF_IND,
1935 &call_conf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001936}
1937
1938static int gsm48_cc_tx_call_proc(struct gsm_trans *trans, void *arg)
1939{
1940 struct gsm_mncc *proceeding = arg;
1941 struct msgb *msg = gsm48_msgb_alloc();
1942 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1943
Harald Welte4bfdfe72009-06-10 23:11:52 +08001944 gh->msg_type = GSM48_MT_CC_CALL_PROC;
1945
1946 new_cc_state(trans, GSM_CSTATE_MO_CALL_PROC);
1947
1948 /* bearer capability */
1949 if (proceeding->fields & MNCC_F_BEARER_CAP)
Harald Welte55c8f352010-03-07 23:40:35 +01001950 gsm48_encode_bearer_cap(msg, 0, &proceeding->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001951 /* facility */
1952 if (proceeding->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01001953 gsm48_encode_facility(msg, 0, &proceeding->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001954 /* progress */
1955 if (proceeding->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01001956 gsm48_encode_progress(msg, 0, &proceeding->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001957
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08001958 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001959}
1960
1961static int gsm48_cc_rx_alerting(struct gsm_trans *trans, struct msgb *msg)
1962{
1963 struct gsm48_hdr *gh = msgb_l3(msg);
1964 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1965 struct tlv_parsed tp;
1966 struct gsm_mncc alerting;
1967
1968 gsm48_stop_cc_timer(trans);
1969 gsm48_start_cc_timer(trans, 0x301, GSM48_T301);
1970
1971 memset(&alerting, 0, sizeof(struct gsm_mncc));
1972 alerting.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01001973 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001974 /* facility */
1975 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
1976 alerting.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01001977 gsm48_decode_facility(&alerting.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001978 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
1979 }
1980
1981 /* progress */
1982 if (TLVP_PRESENT(&tp, GSM48_IE_PROGR_IND)) {
1983 alerting.fields |= MNCC_F_PROGRESS;
Harald Welte55c8f352010-03-07 23:40:35 +01001984 gsm48_decode_progress(&alerting.progress,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001985 TLVP_VAL(&tp, GSM48_IE_PROGR_IND)-1);
1986 }
1987 /* ss-version */
1988 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
1989 alerting.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01001990 gsm48_decode_ssversion(&alerting.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08001991 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
1992 }
1993
1994 new_cc_state(trans, GSM_CSTATE_CALL_RECEIVED);
1995
Harald Welte596fed42009-07-23 19:06:52 +02001996 return mncc_recvmsg(trans->subscr->net, trans, MNCC_ALERT_IND,
1997 &alerting);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001998}
1999
2000static int gsm48_cc_tx_alerting(struct gsm_trans *trans, void *arg)
2001{
2002 struct gsm_mncc *alerting = arg;
2003 struct msgb *msg = gsm48_msgb_alloc();
2004 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2005
Harald Welte4bfdfe72009-06-10 23:11:52 +08002006 gh->msg_type = GSM48_MT_CC_ALERTING;
2007
2008 /* facility */
2009 if (alerting->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002010 gsm48_encode_facility(msg, 0, &alerting->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002011 /* progress */
2012 if (alerting->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002013 gsm48_encode_progress(msg, 0, &alerting->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002014 /* user-user */
2015 if (alerting->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002016 gsm48_encode_useruser(msg, 0, &alerting->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002017
2018 new_cc_state(trans, GSM_CSTATE_CALL_DELIVERED);
2019
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002020 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002021}
2022
2023static int gsm48_cc_tx_progress(struct gsm_trans *trans, void *arg)
2024{
2025 struct gsm_mncc *progress = arg;
2026 struct msgb *msg = gsm48_msgb_alloc();
2027 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2028
Harald Welte4bfdfe72009-06-10 23:11:52 +08002029 gh->msg_type = GSM48_MT_CC_PROGRESS;
2030
2031 /* progress */
Harald Welte55c8f352010-03-07 23:40:35 +01002032 gsm48_encode_progress(msg, 1, &progress->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002033 /* user-user */
2034 if (progress->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002035 gsm48_encode_useruser(msg, 0, &progress->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002036
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002037 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002038}
2039
2040static int gsm48_cc_tx_connect(struct gsm_trans *trans, void *arg)
2041{
2042 struct gsm_mncc *connect = arg;
2043 struct msgb *msg = gsm48_msgb_alloc();
2044 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2045
Harald Welte4bfdfe72009-06-10 23:11:52 +08002046 gh->msg_type = GSM48_MT_CC_CONNECT;
2047
2048 gsm48_stop_cc_timer(trans);
2049 gsm48_start_cc_timer(trans, 0x313, GSM48_T313);
2050
2051 /* facility */
2052 if (connect->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002053 gsm48_encode_facility(msg, 0, &connect->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002054 /* progress */
2055 if (connect->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002056 gsm48_encode_progress(msg, 0, &connect->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002057 /* connected number */
2058 if (connect->fields & MNCC_F_CONNECTED)
Harald Welte55c8f352010-03-07 23:40:35 +01002059 gsm48_encode_connected(msg, &connect->connected);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002060 /* user-user */
2061 if (connect->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002062 gsm48_encode_useruser(msg, 0, &connect->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002063
2064 new_cc_state(trans, GSM_CSTATE_CONNECT_IND);
2065
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002066 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002067}
2068
2069static int gsm48_cc_rx_connect(struct gsm_trans *trans, struct msgb *msg)
2070{
2071 struct gsm48_hdr *gh = msgb_l3(msg);
2072 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2073 struct tlv_parsed tp;
2074 struct gsm_mncc connect;
2075
2076 gsm48_stop_cc_timer(trans);
2077
2078 memset(&connect, 0, sizeof(struct gsm_mncc));
2079 connect.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002080 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002081 /* use subscriber as connected party number */
2082 if (trans->subscr) {
2083 connect.fields |= MNCC_F_CONNECTED;
2084 strncpy(connect.connected.number, trans->subscr->extension,
2085 sizeof(connect.connected.number)-1);
Andreas Eversbergc079be42009-06-15 23:22:09 +02002086 strncpy(connect.imsi, trans->subscr->imsi,
2087 sizeof(connect.imsi)-1);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002088 }
2089 /* facility */
2090 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2091 connect.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002092 gsm48_decode_facility(&connect.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002093 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2094 }
2095 /* user-user */
2096 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2097 connect.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002098 gsm48_decode_useruser(&connect.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002099 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2100 }
2101 /* ss-version */
2102 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2103 connect.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002104 gsm48_decode_ssversion(&connect.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002105 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2106 }
2107
2108 new_cc_state(trans, GSM_CSTATE_CONNECT_REQUEST);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02002109 osmo_counter_inc(trans->subscr->net->stats.call.mt_connect);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002110
Harald Welte596fed42009-07-23 19:06:52 +02002111 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_CNF, &connect);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002112}
2113
2114
2115static int gsm48_cc_rx_connect_ack(struct gsm_trans *trans, struct msgb *msg)
2116{
2117 struct gsm_mncc connect_ack;
2118
2119 gsm48_stop_cc_timer(trans);
2120
2121 new_cc_state(trans, GSM_CSTATE_ACTIVE);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02002122 osmo_counter_inc(trans->subscr->net->stats.call.mo_connect_ack);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002123
2124 memset(&connect_ack, 0, sizeof(struct gsm_mncc));
2125 connect_ack.callref = trans->callref;
Harald Weltea29e43a2010-12-24 16:06:33 +01002126
Harald Welte596fed42009-07-23 19:06:52 +02002127 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_COMPL_IND,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002128 &connect_ack);
2129}
2130
2131static int gsm48_cc_tx_connect_ack(struct gsm_trans *trans, void *arg)
2132{
2133 struct msgb *msg = gsm48_msgb_alloc();
2134 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2135
Harald Welte4bfdfe72009-06-10 23:11:52 +08002136 gh->msg_type = GSM48_MT_CC_CONNECT_ACK;
2137
2138 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2139
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002140 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002141}
2142
2143static int gsm48_cc_rx_disconnect(struct gsm_trans *trans, struct msgb *msg)
2144{
2145 struct gsm48_hdr *gh = msgb_l3(msg);
2146 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2147 struct tlv_parsed tp;
2148 struct gsm_mncc disc;
2149
2150 gsm48_stop_cc_timer(trans);
2151
2152 new_cc_state(trans, GSM_CSTATE_DISCONNECT_REQ);
2153
2154 memset(&disc, 0, sizeof(struct gsm_mncc));
2155 disc.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002156 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_CAUSE, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002157 /* cause */
2158 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2159 disc.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002160 gsm48_decode_cause(&disc.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002161 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2162 }
2163 /* facility */
2164 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2165 disc.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002166 gsm48_decode_facility(&disc.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002167 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2168 }
2169 /* user-user */
2170 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2171 disc.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002172 gsm48_decode_useruser(&disc.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002173 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2174 }
2175 /* ss-version */
2176 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2177 disc.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002178 gsm48_decode_ssversion(&disc.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002179 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2180 }
2181
Harald Welte596fed42009-07-23 19:06:52 +02002182 return mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &disc);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002183
2184}
2185
Harald Weltec66b71c2009-06-11 14:23:20 +08002186static struct gsm_mncc_cause default_cause = {
2187 .location = GSM48_CAUSE_LOC_PRN_S_LU,
2188 .coding = 0,
2189 .rec = 0,
2190 .rec_val = 0,
2191 .value = GSM48_CC_CAUSE_NORMAL_UNSPEC,
2192 .diag_len = 0,
2193 .diag = { 0 },
2194};
Harald Welte4bfdfe72009-06-10 23:11:52 +08002195
2196static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg)
2197{
2198 struct gsm_mncc *disc = arg;
2199 struct msgb *msg = gsm48_msgb_alloc();
2200 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2201
Harald Welte4bfdfe72009-06-10 23:11:52 +08002202 gh->msg_type = GSM48_MT_CC_DISCONNECT;
2203
2204 gsm48_stop_cc_timer(trans);
2205 gsm48_start_cc_timer(trans, 0x306, GSM48_T306);
2206
2207 /* cause */
2208 if (disc->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002209 gsm48_encode_cause(msg, 1, &disc->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002210 else
Harald Welte55c8f352010-03-07 23:40:35 +01002211 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002212
2213 /* facility */
2214 if (disc->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002215 gsm48_encode_facility(msg, 0, &disc->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002216 /* progress */
2217 if (disc->fields & MNCC_F_PROGRESS)
Harald Welte55c8f352010-03-07 23:40:35 +01002218 gsm48_encode_progress(msg, 0, &disc->progress);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002219 /* user-user */
2220 if (disc->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002221 gsm48_encode_useruser(msg, 0, &disc->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002222
2223 /* store disconnect cause for T306 expiry */
Harald Weltedcaf5652009-07-23 18:56:43 +02002224 memcpy(&trans->cc.msg, disc, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002225
2226 new_cc_state(trans, GSM_CSTATE_DISCONNECT_IND);
2227
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002228 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002229}
2230
2231static int gsm48_cc_rx_release(struct gsm_trans *trans, struct msgb *msg)
2232{
2233 struct gsm48_hdr *gh = msgb_l3(msg);
2234 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2235 struct tlv_parsed tp;
2236 struct gsm_mncc rel;
2237 int rc;
2238
2239 gsm48_stop_cc_timer(trans);
2240
2241 memset(&rel, 0, sizeof(struct gsm_mncc));
2242 rel.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002243 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002244 /* cause */
2245 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2246 rel.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002247 gsm48_decode_cause(&rel.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002248 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2249 }
2250 /* facility */
2251 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2252 rel.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002253 gsm48_decode_facility(&rel.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002254 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2255 }
2256 /* user-user */
2257 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2258 rel.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002259 gsm48_decode_useruser(&rel.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002260 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2261 }
2262 /* ss-version */
2263 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2264 rel.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002265 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002266 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2267 }
2268
Harald Weltedcaf5652009-07-23 18:56:43 +02002269 if (trans->cc.state == GSM_CSTATE_RELEASE_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002270 /* release collision 5.4.5 */
Harald Welte596fed42009-07-23 19:06:52 +02002271 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_CNF, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002272 } else {
Holger Hans Peter Freythere9ed3402010-06-16 12:30:50 +08002273 rc = gsm48_tx_simple(trans->conn,
Harald Welte6f5aee02009-07-23 21:21:14 +02002274 GSM48_PDISC_CC | (trans->transaction_id << 4),
Harald Welte596fed42009-07-23 19:06:52 +02002275 GSM48_MT_CC_RELEASE_COMPL);
2276 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_IND, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002277 }
2278
2279 new_cc_state(trans, GSM_CSTATE_NULL);
2280
2281 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002282 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002283
2284 return rc;
2285}
2286
2287static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg)
2288{
2289 struct gsm_mncc *rel = arg;
2290 struct msgb *msg = gsm48_msgb_alloc();
2291 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2292
Harald Welte4bfdfe72009-06-10 23:11:52 +08002293 gh->msg_type = GSM48_MT_CC_RELEASE;
2294
2295 trans->callref = 0;
2296
2297 gsm48_stop_cc_timer(trans);
2298 gsm48_start_cc_timer(trans, 0x308, GSM48_T308);
2299
2300 /* cause */
2301 if (rel->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002302 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002303 /* facility */
2304 if (rel->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002305 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002306 /* user-user */
2307 if (rel->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002308 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002309
Harald Weltedcaf5652009-07-23 18:56:43 +02002310 trans->cc.T308_second = 0;
2311 memcpy(&trans->cc.msg, rel, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002312
Harald Weltedcaf5652009-07-23 18:56:43 +02002313 if (trans->cc.state != GSM_CSTATE_RELEASE_REQ)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002314 new_cc_state(trans, GSM_CSTATE_RELEASE_REQ);
2315
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002316 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002317}
2318
2319static int gsm48_cc_rx_release_compl(struct gsm_trans *trans, struct msgb *msg)
2320{
2321 struct gsm48_hdr *gh = msgb_l3(msg);
2322 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2323 struct tlv_parsed tp;
2324 struct gsm_mncc rel;
2325 int rc = 0;
2326
2327 gsm48_stop_cc_timer(trans);
2328
2329 memset(&rel, 0, sizeof(struct gsm_mncc));
2330 rel.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002331 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002332 /* cause */
2333 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2334 rel.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002335 gsm48_decode_cause(&rel.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002336 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2337 }
2338 /* facility */
2339 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2340 rel.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002341 gsm48_decode_facility(&rel.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002342 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2343 }
2344 /* user-user */
2345 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2346 rel.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002347 gsm48_decode_useruser(&rel.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002348 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2349 }
2350 /* ss-version */
2351 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2352 rel.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002353 gsm48_decode_ssversion(&rel.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002354 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2355 }
2356
2357 if (trans->callref) {
Harald Weltedcaf5652009-07-23 18:56:43 +02002358 switch (trans->cc.state) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002359 case GSM_CSTATE_CALL_PRESENT:
Harald Welte596fed42009-07-23 19:06:52 +02002360 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002361 MNCC_REJ_IND, &rel);
2362 break;
2363 case GSM_CSTATE_RELEASE_REQ:
Harald Welte596fed42009-07-23 19:06:52 +02002364 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002365 MNCC_REL_CNF, &rel);
2366 break;
2367 default:
Harald Welte596fed42009-07-23 19:06:52 +02002368 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002369 MNCC_REL_IND, &rel);
2370 }
2371 }
2372
2373 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002374 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002375
2376 return rc;
2377}
2378
2379static int gsm48_cc_tx_release_compl(struct gsm_trans *trans, void *arg)
2380{
2381 struct gsm_mncc *rel = arg;
2382 struct msgb *msg = gsm48_msgb_alloc();
2383 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Weltec7782de2010-12-21 19:31:41 +01002384 int ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002385
Harald Welte4bfdfe72009-06-10 23:11:52 +08002386 gh->msg_type = GSM48_MT_CC_RELEASE_COMPL;
2387
2388 trans->callref = 0;
2389
2390 gsm48_stop_cc_timer(trans);
2391
2392 /* cause */
2393 if (rel->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002394 gsm48_encode_cause(msg, 0, &rel->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002395 /* facility */
2396 if (rel->fields & MNCC_F_FACILITY)
Harald Welte55c8f352010-03-07 23:40:35 +01002397 gsm48_encode_facility(msg, 0, &rel->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002398 /* user-user */
2399 if (rel->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002400 gsm48_encode_useruser(msg, 0, &rel->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002401
Harald Weltec7782de2010-12-21 19:31:41 +01002402 ret = gsm48_conn_sendmsg(msg, trans->conn, trans);
2403
Harald Weltedcaf5652009-07-23 18:56:43 +02002404 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002405
Harald Weltec7782de2010-12-21 19:31:41 +01002406 return ret;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002407}
2408
2409static int gsm48_cc_rx_facility(struct gsm_trans *trans, struct msgb *msg)
2410{
2411 struct gsm48_hdr *gh = msgb_l3(msg);
2412 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2413 struct tlv_parsed tp;
2414 struct gsm_mncc fac;
2415
2416 memset(&fac, 0, sizeof(struct gsm_mncc));
2417 fac.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002418 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_FACILITY, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002419 /* facility */
2420 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2421 fac.fields |= MNCC_F_FACILITY;
Harald Welte55c8f352010-03-07 23:40:35 +01002422 gsm48_decode_facility(&fac.facility,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002423 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2424 }
2425 /* ss-version */
2426 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2427 fac.fields |= MNCC_F_SSVERSION;
Harald Welte55c8f352010-03-07 23:40:35 +01002428 gsm48_decode_ssversion(&fac.ssversion,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002429 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2430 }
2431
Harald Welte596fed42009-07-23 19:06:52 +02002432 return mncc_recvmsg(trans->subscr->net, trans, MNCC_FACILITY_IND, &fac);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002433}
2434
2435static int gsm48_cc_tx_facility(struct gsm_trans *trans, void *arg)
2436{
2437 struct gsm_mncc *fac = arg;
2438 struct msgb *msg = gsm48_msgb_alloc();
2439 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2440
Harald Welte4bfdfe72009-06-10 23:11:52 +08002441 gh->msg_type = GSM48_MT_CC_FACILITY;
2442
2443 /* facility */
Harald Welte55c8f352010-03-07 23:40:35 +01002444 gsm48_encode_facility(msg, 1, &fac->facility);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002445
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002446 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002447}
2448
2449static int gsm48_cc_rx_hold(struct gsm_trans *trans, struct msgb *msg)
2450{
2451 struct gsm_mncc hold;
2452
2453 memset(&hold, 0, sizeof(struct gsm_mncc));
2454 hold.callref = trans->callref;
Harald Welte596fed42009-07-23 19:06:52 +02002455 return mncc_recvmsg(trans->subscr->net, trans, MNCC_HOLD_IND, &hold);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002456}
2457
2458static int gsm48_cc_tx_hold_ack(struct gsm_trans *trans, void *arg)
2459{
2460 struct msgb *msg = gsm48_msgb_alloc();
2461 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2462
Harald Welte4bfdfe72009-06-10 23:11:52 +08002463 gh->msg_type = GSM48_MT_CC_HOLD_ACK;
2464
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002465 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002466}
2467
2468static int gsm48_cc_tx_hold_rej(struct gsm_trans *trans, void *arg)
2469{
2470 struct gsm_mncc *hold_rej = arg;
2471 struct msgb *msg = gsm48_msgb_alloc();
2472 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2473
Harald Welte4bfdfe72009-06-10 23:11:52 +08002474 gh->msg_type = GSM48_MT_CC_HOLD_REJ;
2475
2476 /* cause */
2477 if (hold_rej->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002478 gsm48_encode_cause(msg, 1, &hold_rej->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002479 else
Harald Welte55c8f352010-03-07 23:40:35 +01002480 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002481
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002482 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002483}
2484
2485static int gsm48_cc_rx_retrieve(struct gsm_trans *trans, struct msgb *msg)
2486{
2487 struct gsm_mncc retrieve;
2488
2489 memset(&retrieve, 0, sizeof(struct gsm_mncc));
2490 retrieve.callref = trans->callref;
Harald Welte596fed42009-07-23 19:06:52 +02002491 return mncc_recvmsg(trans->subscr->net, trans, MNCC_RETRIEVE_IND,
2492 &retrieve);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002493}
2494
2495static int gsm48_cc_tx_retrieve_ack(struct gsm_trans *trans, void *arg)
2496{
2497 struct msgb *msg = gsm48_msgb_alloc();
2498 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2499
Harald Welte4bfdfe72009-06-10 23:11:52 +08002500 gh->msg_type = GSM48_MT_CC_RETR_ACK;
2501
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002502 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002503}
2504
2505static int gsm48_cc_tx_retrieve_rej(struct gsm_trans *trans, void *arg)
2506{
2507 struct gsm_mncc *retrieve_rej = arg;
2508 struct msgb *msg = gsm48_msgb_alloc();
2509 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2510
Harald Welte4bfdfe72009-06-10 23:11:52 +08002511 gh->msg_type = GSM48_MT_CC_RETR_REJ;
2512
2513 /* cause */
2514 if (retrieve_rej->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002515 gsm48_encode_cause(msg, 1, &retrieve_rej->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002516 else
Harald Welte55c8f352010-03-07 23:40:35 +01002517 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002518
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002519 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002520}
2521
2522static int gsm48_cc_rx_start_dtmf(struct gsm_trans *trans, struct msgb *msg)
2523{
2524 struct gsm48_hdr *gh = msgb_l3(msg);
2525 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2526 struct tlv_parsed tp;
2527 struct gsm_mncc dtmf;
2528
2529 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2530 dtmf.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002531 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, 0, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002532 /* keypad facility */
2533 if (TLVP_PRESENT(&tp, GSM48_IE_KPD_FACILITY)) {
2534 dtmf.fields |= MNCC_F_KEYPAD;
Harald Welte55c8f352010-03-07 23:40:35 +01002535 gsm48_decode_keypad(&dtmf.keypad,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002536 TLVP_VAL(&tp, GSM48_IE_KPD_FACILITY)-1);
2537 }
2538
Harald Welte596fed42009-07-23 19:06:52 +02002539 return mncc_recvmsg(trans->subscr->net, trans, MNCC_START_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002540}
2541
2542static int gsm48_cc_tx_start_dtmf_ack(struct gsm_trans *trans, void *arg)
2543{
2544 struct gsm_mncc *dtmf = arg;
2545 struct msgb *msg = gsm48_msgb_alloc();
2546 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2547
Harald Welte4bfdfe72009-06-10 23:11:52 +08002548 gh->msg_type = GSM48_MT_CC_START_DTMF_ACK;
2549
2550 /* keypad */
2551 if (dtmf->fields & MNCC_F_KEYPAD)
Harald Welte55c8f352010-03-07 23:40:35 +01002552 gsm48_encode_keypad(msg, dtmf->keypad);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002553
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002554 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002555}
2556
2557static int gsm48_cc_tx_start_dtmf_rej(struct gsm_trans *trans, void *arg)
2558{
2559 struct gsm_mncc *dtmf = arg;
2560 struct msgb *msg = gsm48_msgb_alloc();
2561 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2562
Harald Welte4bfdfe72009-06-10 23:11:52 +08002563 gh->msg_type = GSM48_MT_CC_START_DTMF_REJ;
2564
2565 /* cause */
2566 if (dtmf->fields & MNCC_F_CAUSE)
Harald Welte55c8f352010-03-07 23:40:35 +01002567 gsm48_encode_cause(msg, 1, &dtmf->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002568 else
Harald Welte55c8f352010-03-07 23:40:35 +01002569 gsm48_encode_cause(msg, 1, &default_cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002570
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002571 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002572}
2573
2574static int gsm48_cc_tx_stop_dtmf_ack(struct gsm_trans *trans, void *arg)
2575{
2576 struct msgb *msg = gsm48_msgb_alloc();
2577 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2578
Harald Welte4bfdfe72009-06-10 23:11:52 +08002579 gh->msg_type = GSM48_MT_CC_STOP_DTMF_ACK;
2580
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002581 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002582}
2583
2584static int gsm48_cc_rx_stop_dtmf(struct gsm_trans *trans, struct msgb *msg)
2585{
2586 struct gsm_mncc dtmf;
2587
2588 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2589 dtmf.callref = trans->callref;
2590
Harald Welte596fed42009-07-23 19:06:52 +02002591 return mncc_recvmsg(trans->subscr->net, trans, MNCC_STOP_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002592}
2593
2594static int gsm48_cc_rx_modify(struct gsm_trans *trans, struct msgb *msg)
2595{
2596 struct gsm48_hdr *gh = msgb_l3(msg);
2597 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2598 struct tlv_parsed tp;
2599 struct gsm_mncc modify;
2600
2601 memset(&modify, 0, sizeof(struct gsm_mncc));
2602 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002603 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002604 /* bearer capability */
2605 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2606 modify.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002607 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002608 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2609 }
2610
2611 new_cc_state(trans, GSM_CSTATE_MO_ORIG_MODIFY);
2612
Harald Welte596fed42009-07-23 19:06:52 +02002613 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_IND, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002614}
2615
2616static int gsm48_cc_tx_modify(struct gsm_trans *trans, void *arg)
2617{
2618 struct gsm_mncc *modify = arg;
2619 struct msgb *msg = gsm48_msgb_alloc();
2620 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2621
Harald Welte4bfdfe72009-06-10 23:11:52 +08002622 gh->msg_type = GSM48_MT_CC_MODIFY;
2623
2624 gsm48_start_cc_timer(trans, 0x323, GSM48_T323);
2625
2626 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002627 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002628
2629 new_cc_state(trans, GSM_CSTATE_MO_TERM_MODIFY);
2630
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002631 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002632}
2633
2634static int gsm48_cc_rx_modify_complete(struct gsm_trans *trans, struct msgb *msg)
2635{
2636 struct gsm48_hdr *gh = msgb_l3(msg);
2637 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2638 struct tlv_parsed tp;
2639 struct gsm_mncc modify;
2640
2641 gsm48_stop_cc_timer(trans);
2642
2643 memset(&modify, 0, sizeof(struct gsm_mncc));
2644 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002645 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002646 /* bearer capability */
2647 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2648 modify.fields |= MNCC_F_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002649 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002650 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2651 }
2652
2653 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2654
Harald Welte596fed42009-07-23 19:06:52 +02002655 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_CNF, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002656}
2657
2658static int gsm48_cc_tx_modify_complete(struct gsm_trans *trans, void *arg)
2659{
2660 struct gsm_mncc *modify = arg;
2661 struct msgb *msg = gsm48_msgb_alloc();
2662 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2663
Harald Welte4bfdfe72009-06-10 23:11:52 +08002664 gh->msg_type = GSM48_MT_CC_MODIFY_COMPL;
2665
2666 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002667 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002668
2669 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2670
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002671 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002672}
2673
2674static int gsm48_cc_rx_modify_reject(struct gsm_trans *trans, struct msgb *msg)
2675{
2676 struct gsm48_hdr *gh = msgb_l3(msg);
2677 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2678 struct tlv_parsed tp;
2679 struct gsm_mncc modify;
2680
2681 gsm48_stop_cc_timer(trans);
2682
2683 memset(&modify, 0, sizeof(struct gsm_mncc));
2684 modify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002685 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, GSM48_IE_CAUSE);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002686 /* bearer capability */
2687 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2688 modify.fields |= GSM48_IE_BEARER_CAP;
Harald Welte55c8f352010-03-07 23:40:35 +01002689 gsm48_decode_bearer_cap(&modify.bearer_cap,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002690 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2691 }
2692 /* cause */
2693 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2694 modify.fields |= MNCC_F_CAUSE;
Harald Welte55c8f352010-03-07 23:40:35 +01002695 gsm48_decode_cause(&modify.cause,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002696 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2697 }
2698
2699 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2700
Harald Welte596fed42009-07-23 19:06:52 +02002701 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_REJ, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002702}
2703
2704static int gsm48_cc_tx_modify_reject(struct gsm_trans *trans, void *arg)
2705{
2706 struct gsm_mncc *modify = arg;
2707 struct msgb *msg = gsm48_msgb_alloc();
2708 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2709
Harald Welte4bfdfe72009-06-10 23:11:52 +08002710 gh->msg_type = GSM48_MT_CC_MODIFY_REJECT;
2711
2712 /* bearer capability */
Harald Welte55c8f352010-03-07 23:40:35 +01002713 gsm48_encode_bearer_cap(msg, 1, &modify->bearer_cap);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002714 /* cause */
Harald Welte55c8f352010-03-07 23:40:35 +01002715 gsm48_encode_cause(msg, 1, &modify->cause);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002716
2717 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2718
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002719 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002720}
2721
2722static int gsm48_cc_tx_notify(struct gsm_trans *trans, void *arg)
2723{
2724 struct gsm_mncc *notify = arg;
2725 struct msgb *msg = gsm48_msgb_alloc();
2726 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2727
Harald Welte4bfdfe72009-06-10 23:11:52 +08002728 gh->msg_type = GSM48_MT_CC_NOTIFY;
2729
2730 /* notify */
Harald Welte55c8f352010-03-07 23:40:35 +01002731 gsm48_encode_notify(msg, notify->notify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002732
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002733 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002734}
2735
2736static int gsm48_cc_rx_notify(struct gsm_trans *trans, struct msgb *msg)
2737{
2738 struct gsm48_hdr *gh = msgb_l3(msg);
2739 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2740// struct tlv_parsed tp;
2741 struct gsm_mncc notify;
2742
2743 memset(&notify, 0, sizeof(struct gsm_mncc));
2744 notify.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002745// tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002746 if (payload_len >= 1)
Harald Welte55c8f352010-03-07 23:40:35 +01002747 gsm48_decode_notify(&notify.notify, gh->data);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002748
Harald Welte596fed42009-07-23 19:06:52 +02002749 return mncc_recvmsg(trans->subscr->net, trans, MNCC_NOTIFY_IND, &notify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002750}
2751
2752static int gsm48_cc_tx_userinfo(struct gsm_trans *trans, void *arg)
2753{
2754 struct gsm_mncc *user = arg;
2755 struct msgb *msg = gsm48_msgb_alloc();
2756 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2757
Harald Welte4bfdfe72009-06-10 23:11:52 +08002758 gh->msg_type = GSM48_MT_CC_USER_INFO;
2759
2760 /* user-user */
2761 if (user->fields & MNCC_F_USERUSER)
Harald Welte55c8f352010-03-07 23:40:35 +01002762 gsm48_encode_useruser(msg, 1, &user->useruser);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002763 /* more data */
2764 if (user->more)
Harald Welte55c8f352010-03-07 23:40:35 +01002765 gsm48_encode_more(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002766
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +08002767 return gsm48_conn_sendmsg(msg, trans->conn, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002768}
2769
2770static int gsm48_cc_rx_userinfo(struct gsm_trans *trans, struct msgb *msg)
2771{
2772 struct gsm48_hdr *gh = msgb_l3(msg);
2773 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2774 struct tlv_parsed tp;
2775 struct gsm_mncc user;
2776
2777 memset(&user, 0, sizeof(struct gsm_mncc));
2778 user.callref = trans->callref;
Harald Welte474d19f2010-03-02 23:18:30 +01002779 tlv_parse(&tp, &gsm48_att_tlvdef, gh->data, payload_len, GSM48_IE_USER_USER, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002780 /* user-user */
2781 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2782 user.fields |= MNCC_F_USERUSER;
Harald Welte55c8f352010-03-07 23:40:35 +01002783 gsm48_decode_useruser(&user.useruser,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002784 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2785 }
2786 /* more data */
2787 if (TLVP_PRESENT(&tp, GSM48_IE_MORE_DATA))
2788 user.more = 1;
2789
Harald Welte596fed42009-07-23 19:06:52 +02002790 return mncc_recvmsg(trans->subscr->net, trans, MNCC_USERINFO_IND, &user);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002791}
2792
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02002793static int _gsm48_lchan_modify(struct gsm_trans *trans, void *arg)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002794{
2795 struct gsm_mncc *mode = arg;
2796
Holger Hans Peter Freytherb549ddf2011-01-16 18:17:04 +01002797 return gsm0808_assign_req(trans->conn, mode->lchan_mode, 1);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002798}
2799
2800static struct downstate {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02002801 uint32_t states;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002802 int type;
2803 int (*rout) (struct gsm_trans *trans, void *arg);
2804} downstatelist[] = {
2805 /* mobile originating call establishment */
2806 {SBIT(GSM_CSTATE_INITIATED), /* 5.2.1.2 */
2807 MNCC_CALL_PROC_REQ, gsm48_cc_tx_call_proc},
2808 {SBIT(GSM_CSTATE_INITIATED) | SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.2 | 5.2.1.5 */
2809 MNCC_ALERT_REQ, gsm48_cc_tx_alerting},
2810 {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 */
2811 MNCC_SETUP_RSP, gsm48_cc_tx_connect},
2812 {SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.4.2 */
2813 MNCC_PROGRESS_REQ, gsm48_cc_tx_progress},
2814 /* mobile terminating call establishment */
2815 {SBIT(GSM_CSTATE_NULL), /* 5.2.2.1 */
2816 MNCC_SETUP_REQ, gsm48_cc_tx_setup},
2817 {SBIT(GSM_CSTATE_CONNECT_REQUEST),
2818 MNCC_SETUP_COMPL_REQ, gsm48_cc_tx_connect_ack},
2819 /* signalling during call */
2820 {SBIT(GSM_CSTATE_ACTIVE),
2821 MNCC_NOTIFY_REQ, gsm48_cc_tx_notify},
2822 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ),
2823 MNCC_FACILITY_REQ, gsm48_cc_tx_facility},
2824 {ALL_STATES,
2825 MNCC_START_DTMF_RSP, gsm48_cc_tx_start_dtmf_ack},
2826 {ALL_STATES,
2827 MNCC_START_DTMF_REJ, gsm48_cc_tx_start_dtmf_rej},
2828 {ALL_STATES,
2829 MNCC_STOP_DTMF_RSP, gsm48_cc_tx_stop_dtmf_ack},
2830 {SBIT(GSM_CSTATE_ACTIVE),
2831 MNCC_HOLD_CNF, gsm48_cc_tx_hold_ack},
2832 {SBIT(GSM_CSTATE_ACTIVE),
2833 MNCC_HOLD_REJ, gsm48_cc_tx_hold_rej},
2834 {SBIT(GSM_CSTATE_ACTIVE),
2835 MNCC_RETRIEVE_CNF, gsm48_cc_tx_retrieve_ack},
2836 {SBIT(GSM_CSTATE_ACTIVE),
2837 MNCC_RETRIEVE_REJ, gsm48_cc_tx_retrieve_rej},
2838 {SBIT(GSM_CSTATE_ACTIVE),
2839 MNCC_MODIFY_REQ, gsm48_cc_tx_modify},
2840 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
2841 MNCC_MODIFY_RSP, gsm48_cc_tx_modify_complete},
2842 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
2843 MNCC_MODIFY_REJ, gsm48_cc_tx_modify_reject},
2844 {SBIT(GSM_CSTATE_ACTIVE),
2845 MNCC_USERINFO_REQ, gsm48_cc_tx_userinfo},
2846 /* clearing */
2847 {SBIT(GSM_CSTATE_INITIATED),
2848 MNCC_REJ_REQ, gsm48_cc_tx_release_compl},
2849 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_DISCONNECT_IND) - SBIT(GSM_CSTATE_RELEASE_REQ) - SBIT(GSM_CSTATE_DISCONNECT_REQ), /* 5.4.4 */
2850 MNCC_DISC_REQ, gsm48_cc_tx_disconnect},
2851 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
2852 MNCC_REL_REQ, gsm48_cc_tx_release},
2853 /* special */
2854 {ALL_STATES,
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02002855 MNCC_LCHAN_MODIFY, _gsm48_lchan_modify},
Harald Welte4bfdfe72009-06-10 23:11:52 +08002856};
2857
2858#define DOWNSLLEN \
2859 (sizeof(downstatelist) / sizeof(struct downstate))
2860
2861
Harald Welte76556372010-12-22 23:57:45 +01002862int mncc_tx_to_cc(struct gsm_network *net, int msg_type, void *arg)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002863{
Harald Welte1a6f7982009-08-09 18:52:33 +02002864 int i, rc = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002865 struct gsm_trans *trans = NULL, *transt;
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08002866 struct gsm_subscriber_connection *conn = NULL;
Holger Hans Peter Freytherb56a6bb2010-12-27 16:02:25 +01002867 struct gsm_bts *bts = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002868 struct gsm_mncc *data = arg, rel;
2869
Harald Welte04dc88f2010-12-22 21:45:05 +01002870 DEBUGP(DMNCC, "receive message %s\n", get_mncc_name(msg_type));
2871
Harald Welte4bfdfe72009-06-10 23:11:52 +08002872 /* handle special messages */
2873 switch(msg_type) {
2874 case MNCC_BRIDGE:
2875 return tch_bridge(net, arg);
2876 case MNCC_FRAME_DROP:
Harald Welteda7ab742009-12-19 22:23:05 +01002877 return tch_recv_mncc(net, data->callref, 0);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002878 case MNCC_FRAME_RECV:
Harald Welteda7ab742009-12-19 22:23:05 +01002879 return tch_recv_mncc(net, data->callref, 1);
2880 case GSM_TCHF_FRAME:
2881 /* Find callref */
2882 trans = trans_find_by_callref(net, data->callref);
Harald Welte04dc88f2010-12-22 21:45:05 +01002883 if (!trans) {
2884 LOGP(DMNCC, LOGL_ERROR, "TCH frame for non-existing trans\n");
Harald Welteda7ab742009-12-19 22:23:05 +01002885 return -EIO;
Harald Welte04dc88f2010-12-22 21:45:05 +01002886 }
2887 if (!trans->conn) {
2888 LOGP(DMNCC, LOGL_NOTICE, "TCH frame for trans without conn\n");
Harald Welteda7ab742009-12-19 22:23:05 +01002889 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01002890 }
2891 if (trans->conn->lchan->type != GSM_LCHAN_TCH_F) {
2892 /* This should be LOGL_ERROR or NOTICE, but
2893 * unfortuantely it happens for a couple of frames at
2894 * the beginning of every RTP connection */
2895 LOGP(DMNCC, LOGL_DEBUG, "TCH frame for lchan != TCH_F\n");
Harald Welteda7ab742009-12-19 22:23:05 +01002896 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01002897 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01002898 bts = trans->conn->lchan->ts->trx->bts;
Harald Welteda7ab742009-12-19 22:23:05 +01002899 switch (bts->type) {
2900 case GSM_BTS_TYPE_NANOBTS:
Harald Weltef383aa12012-07-02 19:51:55 +02002901 case GSM_BTS_TYPE_OSMO_SYSMO:
Harald Welte04dc88f2010-12-22 21:45:05 +01002902 if (!trans->conn->lchan->abis_ip.rtp_socket) {
Harald Welte91c59c82010-12-24 12:40:21 +01002903 DEBUGP(DMNCC, "TCH frame to lchan without RTP connection\n");
Harald Welteda7ab742009-12-19 22:23:05 +01002904 return 0;
Harald Welte04dc88f2010-12-22 21:45:05 +01002905 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01002906 return rtp_send_frame(trans->conn->lchan->abis_ip.rtp_socket, arg);
Harald Welteda7ab742009-12-19 22:23:05 +01002907 case GSM_BTS_TYPE_BS11:
Harald Weltec76fb5d2011-03-20 06:27:31 -03002908 case GSM_BTS_TYPE_RBS2000:
Harald Welte10456972011-08-05 20:11:18 +02002909 case GSM_BTS_TYPE_NOKIA_SITE:
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01002910 return trau_send_frame(trans->conn->lchan, arg);
Harald Welteda7ab742009-12-19 22:23:05 +01002911 default:
Harald Weltee5215b52011-08-09 21:53:20 +02002912 LOGP(DCC, LOGL_ERROR, "Unknown BTS type %u\n", bts->type);
Harald Welteda7ab742009-12-19 22:23:05 +01002913 }
2914 return -EINVAL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002915 }
2916
2917 memset(&rel, 0, sizeof(struct gsm_mncc));
2918 rel.callref = data->callref;
2919
2920 /* Find callref */
Harald Weltedcaf5652009-07-23 18:56:43 +02002921 trans = trans_find_by_callref(net, data->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002922
2923 /* Callref unknown */
2924 if (!trans) {
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01002925 struct gsm_subscriber *subscr;
2926
Harald Welte4a3464c2009-07-04 10:11:24 +02002927 if (msg_type != MNCC_SETUP_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002928 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2929 "Received '%s' from MNCC with "
2930 "unknown callref %d\n", data->called.number,
2931 get_mncc_name(msg_type), data->callref);
2932 /* Invalid call reference */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002933 return mncc_release_ind(net, NULL, data->callref,
2934 GSM48_CAUSE_LOC_PRN_S_LU,
2935 GSM48_CC_CAUSE_INVAL_TRANS_ID);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002936 }
Andreas Eversbergc079be42009-06-15 23:22:09 +02002937 if (!data->called.number[0] && !data->imsi[0]) {
2938 DEBUGP(DCC, "(bts - trx - ts - ti) "
2939 "Received '%s' from MNCC with "
2940 "no number or IMSI\n", get_mncc_name(msg_type));
2941 /* Invalid number */
2942 return mncc_release_ind(net, NULL, data->callref,
2943 GSM48_CAUSE_LOC_PRN_S_LU,
2944 GSM48_CC_CAUSE_INV_NR_FORMAT);
2945 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08002946 /* New transaction due to setup, find subscriber */
Andreas Eversbergc079be42009-06-15 23:22:09 +02002947 if (data->called.number[0])
Harald Welte9176bd42009-07-23 18:46:00 +02002948 subscr = subscr_get_by_extension(net,
2949 data->called.number);
Andreas Eversbergc079be42009-06-15 23:22:09 +02002950 else
Harald Welte9176bd42009-07-23 18:46:00 +02002951 subscr = subscr_get_by_imsi(net, data->imsi);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002952 /* If subscriber is not found */
2953 if (!subscr) {
2954 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2955 "Received '%s' from MNCC with "
2956 "unknown subscriber %s\n", data->called.number,
2957 get_mncc_name(msg_type), data->called.number);
2958 /* Unknown subscriber */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002959 return mncc_release_ind(net, NULL, data->callref,
2960 GSM48_CAUSE_LOC_PRN_S_LU,
2961 GSM48_CC_CAUSE_UNASSIGNED_NR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002962 }
2963 /* If subscriber is not "attached" */
2964 if (!subscr->lac) {
2965 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
2966 "Received '%s' from MNCC with "
2967 "detached subscriber %s\n", data->called.number,
2968 get_mncc_name(msg_type), data->called.number);
2969 subscr_put(subscr);
2970 /* Temporarily out of order */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002971 return mncc_release_ind(net, NULL, data->callref,
2972 GSM48_CAUSE_LOC_PRN_S_LU,
2973 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002974 }
2975 /* Create transaction */
Harald Weltedcaf5652009-07-23 18:56:43 +02002976 trans = trans_alloc(subscr, GSM48_PDISC_CC, 0xff, data->callref);
2977 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002978 DEBUGP(DCC, "No memory for trans.\n");
2979 subscr_put(subscr);
2980 /* Ressource unavailable */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002981 mncc_release_ind(net, NULL, data->callref,
2982 GSM48_CAUSE_LOC_PRN_S_LU,
2983 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002984 return -ENOMEM;
2985 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08002986 /* Find lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08002987 conn = connection_for_subscr(subscr);
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01002988
Harald Welte4bfdfe72009-06-10 23:11:52 +08002989 /* If subscriber has no lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08002990 if (!conn) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002991 /* find transaction with this subscriber already paging */
2992 llist_for_each_entry(transt, &net->trans_list, entry) {
2993 /* Transaction of our lchan? */
2994 if (transt == trans ||
2995 transt->subscr != subscr)
2996 continue;
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01002997 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08002998 "Received '%s' from MNCC with "
2999 "unallocated channel, paging already "
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01003000 "started for lac %d.\n",
Harald Welte4bfdfe72009-06-10 23:11:52 +08003001 data->called.number,
Holger Hans Peter Freyther8e3eb582010-12-27 16:08:34 +01003002 get_mncc_name(msg_type), subscr->lac);
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003003 subscr_put(subscr);
3004 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003005 return 0;
3006 }
3007 /* store setup informations until paging was successfull */
Harald Weltedcaf5652009-07-23 18:56:43 +02003008 memcpy(&trans->cc.msg, data, sizeof(struct gsm_mncc));
Sylvain Munaut567c8dc2010-12-01 22:17:36 +01003009
3010 /* Get a channel */
Holger Hans Peter Freyther49b3ed22010-12-29 17:09:07 +01003011 trans->paging_request = talloc_zero(subscr->net, struct gsm_network*);
3012 if (!trans->paging_request) {
3013 LOGP(DCC, LOGL_ERROR, "Failed to allocate paging token.\n");
3014 subscr_put(subscr);
3015 trans_free(trans);
3016 return 0;
3017 }
3018
3019 *trans->paging_request = subscr->net;
3020 subscr_get_channel(subscr, RSL_CHANNEED_TCH_F, setup_trig_pag_evt, trans->paging_request);
Sylvain Munaut567c8dc2010-12-01 22:17:36 +01003021
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003022 subscr_put(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003023 return 0;
3024 }
3025 /* Assign lchan */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003026 trans->conn = conn;
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003027 subscr_put(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003028 }
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003029
3030 if (trans->conn)
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003031 conn = trans->conn;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003032
3033 /* if paging did not respond yet */
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003034 if (!conn) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003035 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02003036 "Received '%s' from MNCC in paging state\n",
Harald Welte4bfdfe72009-06-10 23:11:52 +08003037 (trans->subscr)?(trans->subscr->extension):"-",
3038 get_mncc_name(msg_type));
Harald Weltec66b71c2009-06-11 14:23:20 +08003039 mncc_set_cause(&rel, GSM48_CAUSE_LOC_PRN_S_LU,
3040 GSM48_CC_CAUSE_NORM_CALL_CLEAR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003041 if (msg_type == MNCC_REL_REQ)
3042 rc = mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
3043 else
3044 rc = mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
3045 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02003046 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003047 return rc;
3048 }
3049
3050 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x sub %s) "
3051 "Received '%s' from MNCC in state %d (%s)\n",
Holger Hans Peter Freytherb2be1952010-06-16 13:23:55 +08003052 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Harald Welte4bfdfe72009-06-10 23:11:52 +08003053 trans->transaction_id,
Holger Hans Peter Freythere95d4822010-03-23 07:00:22 +01003054 (trans->conn->subscr)?(trans->conn->subscr->extension):"-",
Harald Weltedcaf5652009-07-23 18:56:43 +02003055 get_mncc_name(msg_type), trans->cc.state,
Harald Weltee95daf12010-03-25 12:13:02 +08003056 gsm48_cc_state_name(trans->cc.state));
Harald Welte4bfdfe72009-06-10 23:11:52 +08003057
3058 /* Find function for current state and message */
3059 for (i = 0; i < DOWNSLLEN; i++)
3060 if ((msg_type == downstatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003061 && ((1 << trans->cc.state) & downstatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003062 break;
3063 if (i == DOWNSLLEN) {
3064 DEBUGP(DCC, "Message unhandled at this state.\n");
3065 return 0;
3066 }
3067
3068 rc = downstatelist[i].rout(trans, arg);
3069
3070 return rc;
3071}
3072
3073
3074static struct datastate {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02003075 uint32_t states;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003076 int type;
3077 int (*rout) (struct gsm_trans *trans, struct msgb *msg);
3078} datastatelist[] = {
3079 /* mobile originating call establishment */
3080 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3081 GSM48_MT_CC_SETUP, gsm48_cc_rx_setup},
3082 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3083 GSM48_MT_CC_EMERG_SETUP, gsm48_cc_rx_setup},
3084 {SBIT(GSM_CSTATE_CONNECT_IND), /* 5.2.1.2 */
3085 GSM48_MT_CC_CONNECT_ACK, gsm48_cc_rx_connect_ack},
3086 /* mobile terminating call establishment */
3087 {SBIT(GSM_CSTATE_CALL_PRESENT), /* 5.2.2.3.2 */
3088 GSM48_MT_CC_CALL_CONF, gsm48_cc_rx_call_conf},
3089 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF), /* ???? | 5.2.2.3.2 */
3090 GSM48_MT_CC_ALERTING, gsm48_cc_rx_alerting},
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02003091 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF) | SBIT(GSM_CSTATE_CALL_RECEIVED), /* (5.2.2.6) | 5.2.2.6 | 5.2.2.6 */
Harald Welte4bfdfe72009-06-10 23:11:52 +08003092 GSM48_MT_CC_CONNECT, gsm48_cc_rx_connect},
3093 /* signalling during call */
3094 {ALL_STATES - SBIT(GSM_CSTATE_NULL),
3095 GSM48_MT_CC_FACILITY, gsm48_cc_rx_facility},
3096 {SBIT(GSM_CSTATE_ACTIVE),
3097 GSM48_MT_CC_NOTIFY, gsm48_cc_rx_notify},
3098 {ALL_STATES,
3099 GSM48_MT_CC_START_DTMF, gsm48_cc_rx_start_dtmf},
3100 {ALL_STATES,
3101 GSM48_MT_CC_STOP_DTMF, gsm48_cc_rx_stop_dtmf},
3102 {ALL_STATES,
3103 GSM48_MT_CC_STATUS_ENQ, gsm48_cc_rx_status_enq},
3104 {SBIT(GSM_CSTATE_ACTIVE),
3105 GSM48_MT_CC_HOLD, gsm48_cc_rx_hold},
3106 {SBIT(GSM_CSTATE_ACTIVE),
3107 GSM48_MT_CC_RETR, gsm48_cc_rx_retrieve},
3108 {SBIT(GSM_CSTATE_ACTIVE),
3109 GSM48_MT_CC_MODIFY, gsm48_cc_rx_modify},
3110 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3111 GSM48_MT_CC_MODIFY_COMPL, gsm48_cc_rx_modify_complete},
3112 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3113 GSM48_MT_CC_MODIFY_REJECT, gsm48_cc_rx_modify_reject},
3114 {SBIT(GSM_CSTATE_ACTIVE),
3115 GSM48_MT_CC_USER_INFO, gsm48_cc_rx_userinfo},
3116 /* clearing */
3117 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3118 GSM48_MT_CC_DISCONNECT, gsm48_cc_rx_disconnect},
3119 {ALL_STATES - SBIT(GSM_CSTATE_NULL), /* 5.4.4.1.2.2 */
3120 GSM48_MT_CC_RELEASE, gsm48_cc_rx_release},
3121 {ALL_STATES, /* 5.4.3.4 */
3122 GSM48_MT_CC_RELEASE_COMPL, gsm48_cc_rx_release_compl},
3123};
3124
3125#define DATASLLEN \
3126 (sizeof(datastatelist) / sizeof(struct datastate))
3127
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003128static int gsm0408_rcv_cc(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte4bc90a12008-12-27 16:32:52 +00003129{
3130 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02003131 uint8_t msg_type = gh->msg_type & 0xbf;
3132 uint8_t transaction_id = ((gh->proto_discr & 0xf0) ^ 0x80) >> 4; /* flip */
Harald Weltedcaf5652009-07-23 18:56:43 +02003133 struct gsm_trans *trans = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003134 int i, rc = 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00003135
Harald Welte4bfdfe72009-06-10 23:11:52 +08003136 if (msg_type & 0x80) {
3137 DEBUGP(DCC, "MSG 0x%2x not defined for PD error\n", msg_type);
3138 return -EINVAL;
Harald Welte4bc90a12008-12-27 16:32:52 +00003139 }
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003140
Harald Welte4bfdfe72009-06-10 23:11:52 +08003141 /* Find transaction */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003142 trans = trans_find_by_id(conn->subscr, GSM48_PDISC_CC, transaction_id);
Harald Weltedcaf5652009-07-23 18:56:43 +02003143
Harald Welte6f5aee02009-07-23 21:21:14 +02003144 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003145 "Received '%s' from MS in state %d (%s)\n",
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003146 conn->bts->nr, conn->lchan->ts->trx->nr, conn->lchan->ts->nr,
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003147 transaction_id, (conn->subscr)?(conn->subscr->extension):"-",
Harald Weltee95daf12010-03-25 12:13:02 +08003148 gsm48_cc_msg_name(msg_type), trans?(trans->cc.state):0,
3149 gsm48_cc_state_name(trans?(trans->cc.state):0));
Harald Welte4bfdfe72009-06-10 23:11:52 +08003150
3151 /* Create transaction */
3152 if (!trans) {
Harald Welte6f5aee02009-07-23 21:21:14 +02003153 DEBUGP(DCC, "Unknown transaction ID %x, "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003154 "creating new trans.\n", transaction_id);
3155 /* Create transaction */
Holger Hans Peter Freyther68884aa2010-03-23 06:41:45 +01003156 trans = trans_alloc(conn->subscr, GSM48_PDISC_CC,
Harald Weltedcaf5652009-07-23 18:56:43 +02003157 transaction_id, new_callref++);
3158 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003159 DEBUGP(DCC, "No memory for trans.\n");
Holger Hans Peter Freytherb549ddf2011-01-16 18:17:04 +01003160 rc = gsm48_tx_simple(conn,
Harald Welte6f5aee02009-07-23 21:21:14 +02003161 GSM48_PDISC_CC | (transaction_id << 4),
Harald Welte4bfdfe72009-06-10 23:11:52 +08003162 GSM48_MT_CC_RELEASE_COMPL);
3163 return -ENOMEM;
3164 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003165 /* Assign transaction */
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003166 trans->conn = conn;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003167 }
3168
3169 /* find function for current state and message */
3170 for (i = 0; i < DATASLLEN; i++)
3171 if ((msg_type == datastatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003172 && ((1 << trans->cc.state) & datastatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003173 break;
3174 if (i == DATASLLEN) {
3175 DEBUGP(DCC, "Message unhandled at this state.\n");
3176 return 0;
3177 }
3178
3179 rc = datastatelist[i].rout(trans, msg);
Harald Welte4bc90a12008-12-27 16:32:52 +00003180
3181 return rc;
3182}
3183
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003184/* Create a dummy to wait five seconds */
3185static void release_anchor(struct gsm_subscriber_connection *conn)
3186{
3187 if (!conn->anch_operation)
3188 return;
3189
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02003190 osmo_timer_del(&conn->anch_operation->timeout);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003191 talloc_free(conn->anch_operation);
3192 conn->anch_operation = NULL;
3193}
3194
3195static void anchor_timeout(void *_data)
3196{
3197 struct gsm_subscriber_connection *con = _data;
3198
3199 release_anchor(con);
3200 msc_release_connection(con);
3201}
3202
3203int gsm0408_new_conn(struct gsm_subscriber_connection *conn)
3204{
3205 conn->anch_operation = talloc_zero(conn, struct gsm_anchor_operation);
3206 if (!conn->anch_operation)
3207 return -1;
3208
3209 conn->anch_operation->timeout.data = conn;
3210 conn->anch_operation->timeout.cb = anchor_timeout;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02003211 osmo_timer_schedule(&conn->anch_operation->timeout, 5, 0);
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003212 return 0;
3213}
3214
Holger Hans Peter Freyther97643312010-06-17 16:41:25 +08003215/* here we get data from the BSC level... */
3216int gsm0408_dispatch(struct gsm_subscriber_connection *conn, struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00003217{
3218 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02003219 uint8_t pdisc = gh->proto_discr & 0x0f;
Harald Welte8470bf22008-12-25 23:28:35 +00003220 int rc = 0;
Harald Welte51008772009-12-29 11:49:12 +01003221
Holger Hans Peter Freyther758f4df2010-06-21 10:34:03 +08003222 if (silent_call_reroute(conn, msg))
3223 return silent_call_rx(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003224
3225 switch (pdisc) {
3226 case GSM48_PDISC_CC:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003227 release_anchor(conn);
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003228 rc = gsm0408_rcv_cc(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003229 break;
3230 case GSM48_PDISC_MM:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003231 rc = gsm0408_rcv_mm(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003232 break;
3233 case GSM48_PDISC_RR:
Holger Hans Peter Freyther3f122be2010-06-17 17:14:35 +08003234 rc = gsm0408_rcv_rr(conn, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00003235 break;
Harald Weltebcae43f2008-12-27 21:45:37 +00003236 case GSM48_PDISC_SMS:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003237 release_anchor(conn);
Holger Hans Peter Freyther97643312010-06-17 16:41:25 +08003238 rc = gsm0411_rcv_sms(conn, msg);
Harald Weltebcae43f2008-12-27 21:45:37 +00003239 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003240 case GSM48_PDISC_MM_GPRS:
Harald Weltebcae43f2008-12-27 21:45:37 +00003241 case GSM48_PDISC_SM_GPRS:
Harald Welte5d24ba12009-12-24 12:13:17 +01003242 LOGP(DRLL, LOGL_NOTICE, "Unimplemented "
3243 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Harald Welte52b1f982008-12-23 20:25:15 +00003244 break;
Harald Welte6eafe912009-10-16 08:32:58 +02003245 case GSM48_PDISC_NC_SS:
Holger Hans Peter Freyther02d39b22010-07-05 15:34:16 +08003246 release_anchor(conn);
Holger Hans Peter Freytherd42c3f22010-06-17 17:35:57 +08003247 rc = handle_rcv_ussd(conn, msg);
Harald Welte6eafe912009-10-16 08:32:58 +02003248 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003249 default:
Harald Welte5d24ba12009-12-24 12:13:17 +01003250 LOGP(DRLL, LOGL_NOTICE, "Unknown "
3251 "GSM 04.08 discriminator 0x%02x\n", pdisc);
Harald Welte52b1f982008-12-23 20:25:15 +00003252 break;
3253 }
3254
3255 return rc;
3256}
Harald Welte8470bf22008-12-25 23:28:35 +00003257
Harald Welte805f6442009-07-28 18:25:29 +02003258/*
3259 * This will be ran by the linker when loading the DSO. We use it to
3260 * do system initialization, e.g. registration of signal handlers.
3261 */
3262static __attribute__((constructor)) void on_dso_load_0408(void)
3263{
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02003264 osmo_signal_register_handler(SS_ABISIP, handle_abisip_signal, NULL);
Harald Welte805f6442009-07-28 18:25:29 +02003265}