blob: d59d7d7caf06432a7da7e8f7f8bd50811c565d27 [file] [log] [blame]
Harald Welte52b1f982008-12-23 20:25:15 +00001/* GSM Mobile Radio Interface Layer 3 messages on the A-bis interface
2 * 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>
Harald Welte498b0bb2009-01-09 21:27:43 +00005 * (C) 2008, 2009 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
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (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
17 * GNU General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, write to the Free Software Foundation, Inc.,
21 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22 *
23 */
24
25
26#include <stdio.h>
27#include <stdlib.h>
28#include <string.h>
29#include <errno.h>
Harald Weltedb253af2008-12-30 17:56:55 +000030#include <time.h>
Harald Welte4b634542008-12-27 01:55:51 +000031#include <netinet/in.h>
Harald Welte52b1f982008-12-23 20:25:15 +000032
Harald Welte75a983f2008-12-27 21:34:06 +000033#include <openbsc/db.h>
Harald Welte8470bf22008-12-25 23:28:35 +000034#include <openbsc/msgb.h>
Harald Weltef1dae192009-12-14 22:24:28 +010035#include <openbsc/bitvec.h>
Harald Welte7584aea2009-02-11 11:44:12 +000036#include <openbsc/tlv.h>
Harald Welte8470bf22008-12-25 23:28:35 +000037#include <openbsc/debug.h>
38#include <openbsc/gsm_data.h>
Daniel Willmanneea93372009-08-13 03:42:07 +020039#include <openbsc/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000040#include <openbsc/gsm_subscriber.h>
Daniel Willmann8b3390e2008-12-28 00:31:09 +000041#include <openbsc/gsm_04_11.h>
Harald Welte8470bf22008-12-25 23:28:35 +000042#include <openbsc/gsm_04_08.h>
43#include <openbsc/abis_rsl.h>
Holger Freytherca362a62009-01-04 21:05:01 +000044#include <openbsc/chan_alloc.h>
Harald Welte0b4c34e2009-02-09 17:54:43 +000045#include <openbsc/paging.h>
Holger Freyther053e09d2009-02-14 22:51:06 +000046#include <openbsc/signal.h>
Harald Welte45b407a2009-05-23 15:51:12 +000047#include <openbsc/trau_frame.h>
Harald Welte11fa29c2009-02-19 17:24:39 +000048#include <openbsc/trau_mux.h>
Harald Welte805f6442009-07-28 18:25:29 +020049#include <openbsc/rtp_proxy.h>
Harald Welte2cf161b2009-06-20 22:36:41 +020050#include <openbsc/talloc.h>
Harald Weltedcaf5652009-07-23 18:56:43 +020051#include <openbsc/transaction.h>
Harald Welte6eafe912009-10-16 08:32:58 +020052#include <openbsc/ussd.h>
Harald Welte52b1f982008-12-23 20:25:15 +000053
Harald Welte0c389302009-06-10 12:08:54 +080054#define GSM_MAX_FACILITY 128
55#define GSM_MAX_SSVERSION 128
56#define GSM_MAX_USERUSER 128
57
Harald Welte (local)d19e58b2009-08-15 02:30:58 +020058void *tall_locop_ctx;
Harald Welte2cf161b2009-06-20 22:36:41 +020059
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020060extern int ipacc_rtp_direct;
Harald Welte805f6442009-07-28 18:25:29 +020061
Harald Welte09e38af2009-02-16 22:52:23 +000062static const struct tlv_definition rsl_att_tlvdef = {
63 .def = {
64 [GSM48_IE_MOBILE_ID] = { TLV_TYPE_TLV },
65 [GSM48_IE_NAME_LONG] = { TLV_TYPE_TLV },
66 [GSM48_IE_NAME_SHORT] = { TLV_TYPE_TLV },
67 [GSM48_IE_UTC] = { TLV_TYPE_TV },
68 [GSM48_IE_NET_TIME_TZ] = { TLV_TYPE_FIXED, 7 },
69 [GSM48_IE_LSA_IDENT] = { TLV_TYPE_TLV },
70
71 [GSM48_IE_BEARER_CAP] = { TLV_TYPE_TLV },
72 [GSM48_IE_CAUSE] = { TLV_TYPE_TLV },
73 [GSM48_IE_CC_CAP] = { TLV_TYPE_TLV },
74 [GSM48_IE_ALERT] = { TLV_TYPE_TLV },
75 [GSM48_IE_FACILITY] = { TLV_TYPE_TLV },
76 [GSM48_IE_PROGR_IND] = { TLV_TYPE_TLV },
77 [GSM48_IE_AUX_STATUS] = { TLV_TYPE_TLV },
Harald Welte0c389302009-06-10 12:08:54 +080078 [GSM48_IE_NOTIFY] = { TLV_TYPE_TV },
Harald Welte09e38af2009-02-16 22:52:23 +000079 [GSM48_IE_KPD_FACILITY] = { TLV_TYPE_TV },
80 [GSM48_IE_SIGNAL] = { TLV_TYPE_TV },
Harald Welte0c389302009-06-10 12:08:54 +080081 [GSM48_IE_CONN_BCD] = { TLV_TYPE_TLV },
82 [GSM48_IE_CONN_SUB] = { TLV_TYPE_TLV },
Harald Welte09e38af2009-02-16 22:52:23 +000083 [GSM48_IE_CALLING_BCD] = { TLV_TYPE_TLV },
84 [GSM48_IE_CALLING_SUB] = { TLV_TYPE_TLV },
85 [GSM48_IE_CALLED_BCD] = { TLV_TYPE_TLV },
86 [GSM48_IE_CALLED_SUB] = { TLV_TYPE_TLV },
87 [GSM48_IE_REDIR_BCD] = { TLV_TYPE_TLV },
88 [GSM48_IE_REDIR_SUB] = { TLV_TYPE_TLV },
89 [GSM48_IE_LOWL_COMPAT] = { TLV_TYPE_TLV },
90 [GSM48_IE_HIGHL_COMPAT] = { TLV_TYPE_TLV },
91 [GSM48_IE_USER_USER] = { TLV_TYPE_TLV },
92 [GSM48_IE_SS_VERS] = { TLV_TYPE_TLV },
93 [GSM48_IE_MORE_DATA] = { TLV_TYPE_T },
94 [GSM48_IE_CLIR_SUPP] = { TLV_TYPE_T },
95 [GSM48_IE_CLIR_INVOC] = { TLV_TYPE_T },
96 [GSM48_IE_REV_C_SETUP] = { TLV_TYPE_T },
Harald Welte0c389302009-06-10 12:08:54 +080097 [GSM48_IE_REPEAT_CIR] = { TLV_TYPE_T },
98 [GSM48_IE_REPEAT_SEQ] = { TLV_TYPE_T },
Harald Welte09e38af2009-02-16 22:52:23 +000099 /* FIXME: more elements */
100 },
101};
Harald Weltecf5b3592009-05-01 18:28:42 +0000102
103static const char *rr_cause_names[] = {
104 [GSM48_RR_CAUSE_NORMAL] = "Normal event",
105 [GSM48_RR_CAUSE_ABNORMAL_UNSPEC] = "Abnormal release, unspecified",
106 [GSM48_RR_CAUSE_ABNORMAL_UNACCT] = "Abnormal release, channel unacceptable",
107 [GSM48_RR_CAUSE_ABNORMAL_TIMER] = "Abnormal release, timer expired",
108 [GSM48_RR_CAUSE_ABNORMAL_NOACT] = "Abnormal release, no activity on radio path",
109 [GSM48_RR_CAUSE_PREMPTIVE_REL] = "Preemptive release",
110 [GSM48_RR_CAUSE_HNDOVER_IMP] = "Handover impossible, timing advance out of range",
111 [GSM48_RR_CAUSE_CHAN_MODE_UNACCT] = "Channel mode unacceptable",
112 [GSM48_RR_CAUSE_FREQ_NOT_IMPL] = "Frequency not implemented",
113 [GSM48_RR_CAUSE_CALL_CLEARED] = "Call already cleared",
114 [GSM48_RR_CAUSE_SEMANT_INCORR] = "Semantically incorrect message",
115 [GSM48_RR_CAUSE_INVALID_MAND_INF] = "Invalid mandatory information",
116 [GSM48_RR_CAUSE_MSG_TYPE_N] = "Message type non-existant or not implemented",
117 [GSM48_RR_CAUSE_MSG_TYPE_N_COMPAT] = "Message type not compatible with protocol state",
118 [GSM48_RR_CAUSE_COND_IE_ERROR] = "Conditional IE error",
119 [GSM48_RR_CAUSE_NO_CELL_ALLOC_A] = "No cell allocation available",
120 [GSM48_RR_CAUSE_PROT_ERROR_UNSPC] = "Protocol error unspecified",
121};
122
Harald Welte4bfdfe72009-06-10 23:11:52 +0800123static const char *cc_state_names[] = {
124 "NULL",
125 "INITIATED",
126 "illegal state 2",
127 "MO_CALL_PROC",
128 "CALL_DELIVERED",
129 "illegal state 5",
130 "CALL_PRESENT",
131 "CALL_RECEIVED",
132 "CONNECT_REQUEST",
133 "MO_TERM_CALL_CONF",
134 "ACTIVE",
135 "DISCONNECT_REQ",
136 "DISCONNECT_IND",
137 "illegal state 13",
138 "illegal state 14",
139 "illegal state 15",
140 "illegal state 16",
141 "illegal state 17",
142 "illegal state 18",
143 "RELEASE_REQ",
144 "illegal state 20",
145 "illegal state 21",
146 "illegal state 22",
147 "illegal state 23",
148 "illegal state 24",
149 "illegal state 25",
150 "MO_ORIG_MODIFY",
151 "MO_TERM_MODIFY",
152 "CONNECT_IND",
153 "illegal state 29",
154 "illegal state 30",
155 "illegal state 31",
156};
157
Harald Weltecf5b3592009-05-01 18:28:42 +0000158static char strbuf[64];
159
160static const char *rr_cause_name(u_int8_t cause)
161{
162 if (cause < ARRAY_SIZE(rr_cause_names) &&
163 rr_cause_names[cause])
164 return rr_cause_names[cause];
165
166 snprintf(strbuf, sizeof(strbuf), "0x%02x", cause);
167 return strbuf;
168}
169
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100170int gsm48_parse_meas_rep(struct gsm_meas_rep *rep, struct msgb *msg)
Harald Weltef7c43522009-06-09 20:24:21 +0000171{
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100172 struct gsm48_hdr *gh = msgb_l3(msg);
173 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
174 u_int8_t *data = gh->data;
Harald Weltef1dae192009-12-14 22:24:28 +0100175 struct gsm_bts *bts = msg->lchan->ts->trx->bts;
176 struct bitvec *nbv = &bts->si_common.neigh_list;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100177
178 if (gh->msg_type != GSM48_MT_RR_MEAS_REP)
179 return -EINVAL;
Harald Weltef7c43522009-06-09 20:24:21 +0000180
181 if (data[0] & 0x80)
182 rep->flags |= MEAS_REP_F_BA1;
183 if (data[0] & 0x40)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100184 rep->flags |= MEAS_REP_F_UL_DTX;
Harald Welte5a691b52009-07-05 04:05:44 +0200185 if ((data[1] & 0x40) == 0x00)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100186 rep->flags |= MEAS_REP_F_DL_VALID;
Harald Weltef7c43522009-06-09 20:24:21 +0000187
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100188 rep->dl.full.rx_lev = data[0] & 0x3f;
189 rep->dl.sub.rx_lev = data[1] & 0x3f;
190 rep->dl.full.rx_qual = (data[3] >> 4) & 0x7;
191 rep->dl.sub.rx_qual = (data[3] >> 1) & 0x7;
192
Harald Weltea2f74b82009-12-16 16:49:21 +0100193 rep->num_cell = ((data[3] >> 6) & 0x3) | ((data[2] & 0x01) << 2);
Harald Welte51cec5f2009-12-19 16:45:29 +0100194 if (rep->num_cell < 1 || rep->num_cell > 6)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100195 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000196
197 /* an encoding nightmare in perfection */
198
Harald Weltea2f74b82009-12-16 16:49:21 +0100199 rep->cell[0].rxlev = data[3] & 0x3f;
200 rep->cell[0].arfcn = bitvec_get_nth_set_bit(nbv, data[4] >> 2);
Harald Welte73ddaed2009-12-16 23:29:12 +0100201 rep->cell[0].bsic = ((data[4] & 0x07) << 3) | (data[5] >> 5);
Harald Weltef7c43522009-06-09 20:24:21 +0000202 if (rep->num_cell < 2)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100203 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000204
Harald Weltea2f74b82009-12-16 16:49:21 +0100205 rep->cell[1].rxlev = ((data[5] & 0x1f) << 1) | (data[6] >> 7);
206 rep->cell[1].arfcn = bitvec_get_nth_set_bit(nbv, (data[6] >> 2) & 0x1f);
207 rep->cell[1].bsic = ((data[6] & 0x03) << 4) | (data[7] >> 4);
Harald Weltef7c43522009-06-09 20:24:21 +0000208 if (rep->num_cell < 3)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100209 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000210
Harald Weltea2f74b82009-12-16 16:49:21 +0100211 rep->cell[2].rxlev = ((data[7] & 0x0f) << 2) | (data[8] >> 6);
212 rep->cell[2].arfcn = bitvec_get_nth_set_bit(nbv, (data[8] >> 1) & 0x1f);
213 rep->cell[2].bsic = ((data[8] & 0x01) << 6) | (data[9] >> 3);
Harald Weltef7c43522009-06-09 20:24:21 +0000214 if (rep->num_cell < 4)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100215 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000216
Harald Weltea2f74b82009-12-16 16:49:21 +0100217 rep->cell[3].rxlev = ((data[9] & 0x07) << 3) | (data[10] >> 5);
218 rep->cell[3].arfcn = bitvec_get_nth_set_bit(nbv, data[10] & 0x1f);
219 rep->cell[3].bsic = data[11] >> 2;
Harald Weltef7c43522009-06-09 20:24:21 +0000220 if (rep->num_cell < 5)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100221 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000222
Harald Weltea2f74b82009-12-16 16:49:21 +0100223 rep->cell[4].rxlev = ((data[11] & 0x03) << 4) | (data[12] >> 4);
Harald Weltef1dae192009-12-14 22:24:28 +0100224 rep->cell[4].arfcn = bitvec_get_nth_set_bit(nbv,
Harald Weltea2f74b82009-12-16 16:49:21 +0100225 ((data[12] & 0xf) << 1) | (data[13] >> 7));
226 rep->cell[4].bsic = (data[13] >> 1) & 0x3f;
Harald Weltef7c43522009-06-09 20:24:21 +0000227 if (rep->num_cell < 6)
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100228 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000229
Harald Weltea2f74b82009-12-16 16:49:21 +0100230 rep->cell[5].rxlev = ((data[13] & 0x01) << 5) | (data[14] >> 3);
Harald Weltef1dae192009-12-14 22:24:28 +0100231 rep->cell[5].arfcn = bitvec_get_nth_set_bit(nbv,
Harald Weltea2f74b82009-12-16 16:49:21 +0100232 ((data[14] & 0x07) << 2) | (data[15] >> 6));
233 rep->cell[5].bsic = data[15] & 0x3f;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100234
235 return 0;
Harald Weltef7c43522009-06-09 20:24:21 +0000236}
237
Holger Freytherd51524f2009-06-09 08:27:07 +0000238int gsm0408_loc_upd_acc(struct gsm_lchan *lchan, u_int32_t tmsi);
Harald Welte65e74cc2008-12-29 01:55:35 +0000239static int gsm48_tx_simple(struct gsm_lchan *lchan,
240 u_int8_t pdisc, u_int8_t msg_type);
Holger Freytherb7193e42008-12-29 17:44:08 +0000241static void schedule_reject(struct gsm_lchan *lchan);
Harald Welte65e74cc2008-12-29 01:55:35 +0000242
Harald Welte52b1f982008-12-23 20:25:15 +0000243struct gsm_lai {
244 u_int16_t mcc;
245 u_int16_t mnc;
246 u_int16_t lac;
247};
248
Harald Welte4bfdfe72009-06-10 23:11:52 +0800249static u_int32_t new_callref = 0x80000001;
250
Holger Freyther73487a22008-12-31 18:53:57 +0000251static int authorize_subscriber(struct gsm_loc_updating_operation *loc,
252 struct gsm_subscriber *subscriber)
Holger Freyther89824fc2008-12-30 16:18:18 +0000253{
254 if (!subscriber)
255 return 0;
256
Holger Freyther73487a22008-12-31 18:53:57 +0000257 /*
258 * Do not send accept yet as more information should arrive. Some
259 * phones will not send us the information and we will have to check
260 * what we want to do with that.
261 */
262 if (loc && (loc->waiting_for_imsi || loc->waiting_for_imei))
263 return 0;
264
Jan Luebbe06513f22009-08-12 12:48:00 +0200265 switch (subscriber->net->auth_policy) {
266 case GSM_AUTH_POLICY_CLOSED:
267 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200268 case GSM_AUTH_POLICY_TOKEN:
Harald Welte (local)ee9afe32009-08-13 20:44:23 +0200269 if (subscriber->authorized)
270 return subscriber->authorized;
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200271 return (subscriber->flags & GSM_SUBSCRIBER_FIRST_CONTACT);
Jan Luebbe06513f22009-08-12 12:48:00 +0200272 case GSM_AUTH_POLICY_ACCEPT_ALL:
Holger Freyther89824fc2008-12-30 16:18:18 +0000273 return 1;
Jan Luebbe06513f22009-08-12 12:48:00 +0200274 default:
275 return 0;
276 }
Holger Freyther89824fc2008-12-30 16:18:18 +0000277}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000278
Holger Freyther73487a22008-12-31 18:53:57 +0000279static void release_loc_updating_req(struct gsm_lchan *lchan)
280{
Harald Welte179f0642008-12-31 23:59:18 +0000281 if (!lchan->loc_operation)
Holger Freyther73487a22008-12-31 18:53:57 +0000282 return;
283
Harald Welteff117a82009-05-23 05:22:08 +0000284 bsc_del_timer(&lchan->loc_operation->updating_timer);
Harald Welte2cf161b2009-06-20 22:36:41 +0200285 talloc_free(lchan->loc_operation);
Holger Freyther73487a22008-12-31 18:53:57 +0000286 lchan->loc_operation = 0;
Holger Freyther3eaa7922009-01-01 02:59:03 +0000287 put_lchan(lchan);
Holger Freyther73487a22008-12-31 18:53:57 +0000288}
289
290static void allocate_loc_updating_req(struct gsm_lchan *lchan)
291{
Holger Freyther67b4b9a2009-01-01 03:46:11 +0000292 use_lchan(lchan);
Holger Freyther73487a22008-12-31 18:53:57 +0000293 release_loc_updating_req(lchan);
294
Harald Welte470ec292009-06-26 20:25:23 +0200295 lchan->loc_operation = talloc_zero(tall_locop_ctx,
296 struct gsm_loc_updating_operation);
Holger Freyther73487a22008-12-31 18:53:57 +0000297}
Holger Freyther07cc8d82008-12-29 06:23:46 +0000298
Holger Freytherd51524f2009-06-09 08:27:07 +0000299static int gsm0408_authorize(struct gsm_lchan *lchan, struct msgb *msg)
300{
Holger Freytherd51524f2009-06-09 08:27:07 +0000301 if (authorize_subscriber(lchan->loc_operation, lchan->subscr)) {
Harald Welteee5ad162009-08-09 19:07:00 +0200302 int rc;
303
Holger Freytherd51524f2009-06-09 08:27:07 +0000304 db_subscriber_alloc_tmsi(lchan->subscr);
Holger Freytherd51524f2009-06-09 08:27:07 +0000305 release_loc_updating_req(lchan);
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +0200306 rc = gsm0408_loc_upd_acc(msg->lchan, lchan->subscr->tmsi);
Harald Welte648b6ce2009-12-14 09:00:24 +0100307 if (lchan->ts->trx->bts->network->send_mm_info) {
308 /* send MM INFO with network name */
309 rc = gsm48_tx_mm_info(msg->lchan);
310 }
Harald Welteb83d9382009-12-12 21:00:48 +0100311
Harald Welteee5ad162009-08-09 19:07:00 +0200312 /* call subscr_update after putting the loc_upd_acc
313 * in the transmit queue, since S_SUBSCR_ATTACHED might
314 * trigger further action like SMS delivery */
315 subscr_update(lchan->subscr, msg->trx->bts,
316 GSM_SUBSCRIBER_UPDATE_ATTACHED);
Harald Welteb83d9382009-12-12 21:00:48 +0100317 /* try to close channel ASAP */
318 lchan_auto_release(lchan);
Harald Welteee5ad162009-08-09 19:07:00 +0200319 return rc;
Holger Freytherd51524f2009-06-09 08:27:07 +0000320 }
321
322 return 0;
323}
324
Holger Freyther7c19f742009-06-06 13:54:35 +0000325static int gsm0408_handle_lchan_signal(unsigned int subsys, unsigned int signal,
326 void *handler_data, void *signal_data)
327{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800328 struct gsm_trans *trans, *temp;
329
Holger Freyther7c19f742009-06-06 13:54:35 +0000330 if (subsys != SS_LCHAN || signal != S_LCHAN_UNEXPECTED_RELEASE)
331 return 0;
332
333 /*
334 * Cancel any outstanding location updating request
335 * operation taking place on the lchan.
336 */
Harald Welte1a5c6bd2009-07-04 09:35:21 +0200337 struct gsm_lchan *lchan = (struct gsm_lchan *)signal_data;
Harald Weltec05677b2009-06-26 20:17:06 +0200338 if (!lchan)
339 return 0;
340
Holger Freyther7c19f742009-06-06 13:54:35 +0000341 release_loc_updating_req(lchan);
342
Harald Welte4bfdfe72009-06-10 23:11:52 +0800343 /* Free all transactions that are associated with the released lchan */
Harald Weltedcaf5652009-07-23 18:56:43 +0200344 /* FIXME: this is not neccessarily the right thing to do, we should
345 * only set trans->lchan to NULL and wait for another lchan to be
346 * established to the same MM entity (phone/subscriber) */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800347 llist_for_each_entry_safe(trans, temp, &lchan->ts->trx->bts->network->trans_list, entry) {
348 if (trans->lchan == lchan)
Harald Weltedcaf5652009-07-23 18:56:43 +0200349 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +0800350 }
351
Holger Freyther7c19f742009-06-06 13:54:35 +0000352 return 0;
353}
354
Harald Welte09e38af2009-02-16 22:52:23 +0000355static const char bcd_num_digits[] = {
356 '0', '1', '2', '3', '4', '5', '6', '7',
357 '8', '9', '*', '#', 'a', 'b', 'c', '\0'
358};
359
Harald Welte0c389302009-06-10 12:08:54 +0800360/* decode a 'called/calling/connect party BCD number' as in 10.5.4.7 */
361int decode_bcd_number(char *output, int output_len, const u_int8_t *bcd_lv,
362 int h_len)
Harald Welte09e38af2009-02-16 22:52:23 +0000363{
364 u_int8_t in_len = bcd_lv[0];
365 int i;
366
Harald Welte0c389302009-06-10 12:08:54 +0800367 for (i = 1 + h_len; i <= in_len; i++) {
Harald Welte09e38af2009-02-16 22:52:23 +0000368 /* lower nibble */
369 output_len--;
370 if (output_len <= 1)
371 break;
372 *output++ = bcd_num_digits[bcd_lv[i] & 0xf];
373
374 /* higher nibble */
375 output_len--;
376 if (output_len <= 1)
377 break;
378 *output++ = bcd_num_digits[bcd_lv[i] >> 4];
379 }
380 if (output_len >= 1)
381 *output++ = '\0';
382
Harald Welte0c389302009-06-10 12:08:54 +0800383 return 0;
Harald Welte09e38af2009-02-16 22:52:23 +0000384}
385
386/* convert a single ASCII character to call-control BCD */
387static int asc_to_bcd(const char asc)
388{
389 int i;
390
391 for (i = 0; i < ARRAY_SIZE(bcd_num_digits); i++) {
392 if (bcd_num_digits[i] == asc)
393 return i;
394 }
395 return -EINVAL;
396}
397
Harald Welte0c389302009-06-10 12:08:54 +0800398/* convert a ASCII phone number to 'called/calling/connect party BCD number' */
Harald Welte09e38af2009-02-16 22:52:23 +0000399int encode_bcd_number(u_int8_t *bcd_lv, u_int8_t max_len,
Harald Welte0c389302009-06-10 12:08:54 +0800400 int h_len, const char *input)
Harald Welte09e38af2009-02-16 22:52:23 +0000401{
402 int in_len = strlen(input);
403 int i;
Harald Welte0c389302009-06-10 12:08:54 +0800404 u_int8_t *bcd_cur = bcd_lv + 1 + h_len;
Harald Welte09e38af2009-02-16 22:52:23 +0000405
406 /* two digits per byte, plus type byte */
Harald Welte0c389302009-06-10 12:08:54 +0800407 bcd_lv[0] = in_len/2 + h_len;
Harald Welte09e38af2009-02-16 22:52:23 +0000408 if (in_len % 2)
409 bcd_lv[0]++;
410
Harald Welte0c389302009-06-10 12:08:54 +0800411 if (bcd_lv[0] > max_len)
412 return -EIO;
Harald Welte09e38af2009-02-16 22:52:23 +0000413
414 for (i = 0; i < in_len; i++) {
415 int rc = asc_to_bcd(input[i]);
416 if (rc < 0)
417 return rc;
418 if (i % 2 == 0)
419 *bcd_cur = rc;
420 else
421 *bcd_cur++ |= (rc << 4);
422 }
423 /* append padding nibble in case of odd length */
424 if (i % 2)
425 *bcd_cur++ |= 0xf0;
426
427 /* return how many bytes we used */
428 return (bcd_cur - bcd_lv);
429}
430
Harald Welte0c389302009-06-10 12:08:54 +0800431/* decode 'bearer capability' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800432static int decode_bearer_cap(struct gsm_mncc_bearer_cap *bcap,
Harald Welte0c389302009-06-10 12:08:54 +0800433 const u_int8_t *lv)
434{
435 u_int8_t in_len = lv[0];
436 int i, s;
437
438 if (in_len < 1)
439 return -EINVAL;
440
Harald Welte4bfdfe72009-06-10 23:11:52 +0800441 bcap->speech_ver[0] = -1; /* end of list, of maximum 7 values */
Harald Welte0c389302009-06-10 12:08:54 +0800442
443 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800444 bcap->transfer = lv[1] & 0x07;
445 bcap->mode = (lv[1] & 0x08) >> 3;
446 bcap->coding = (lv[1] & 0x10) >> 4;
447 bcap->radio = (lv[1] & 0x60) >> 5;
Harald Welte0c389302009-06-10 12:08:54 +0800448
Harald Welte09b7e7f2009-12-12 21:36:53 +0100449 if (bcap->transfer == GSM_MNCC_BCAP_SPEECH) {
450 i = 1;
451 s = 0;
452 while(!(lv[i] & 0x80)) {
453 i++; /* octet 3a etc */
454 if (in_len < i)
455 return 0;
456 bcap->speech_ver[s++] = lv[i] & 0x0f;
457 bcap->speech_ver[s] = -1; /* end of list */
458 if (i == 2) /* octet 3a */
459 bcap->speech_ctm = (lv[i] & 0x20) >> 5;
460 if (s == 7) /* maximum speech versions + end of list */
461 return 0;
462 }
463 } else {
464 i = 1;
465 while (!(lv[i] & 0x80)) {
466 i++; /* octet 3a etc */
467 if (in_len < i)
468 return 0;
469 /* ignore them */
470 }
471 /* FIXME: implement OCTET 4+ parsing */
Harald Welte0c389302009-06-10 12:08:54 +0800472 }
473
474 return 0;
475}
476
477/* encode 'bearer capability' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800478static int encode_bearer_cap(struct msgb *msg, int lv_only,
479 const struct gsm_mncc_bearer_cap *bcap)
Harald Welte0c389302009-06-10 12:08:54 +0800480{
481 u_int8_t lv[32 + 1];
Harald Welte09b7e7f2009-12-12 21:36:53 +0100482 int i = 1, s;
Harald Welte0c389302009-06-10 12:08:54 +0800483
Harald Welte4bfdfe72009-06-10 23:11:52 +0800484 lv[1] = bcap->transfer;
485 lv[1] |= bcap->mode << 3;
486 lv[1] |= bcap->coding << 4;
487 lv[1] |= bcap->radio << 5;
Harald Welte0c389302009-06-10 12:08:54 +0800488
Harald Welte09b7e7f2009-12-12 21:36:53 +0100489 if (bcap->transfer == GSM_MNCC_BCAP_SPEECH) {
490 for (s = 0; bcap->speech_ver[s] >= 0; s++) {
491 i++; /* octet 3a etc */
492 lv[i] = bcap->speech_ver[s];
493 if (i == 2) /* octet 3a */
494 lv[i] |= bcap->speech_ctm << 5;
495 }
496 lv[i] |= 0x80; /* last IE of octet 3 etc */
497 } else {
498 /* FIXME: implement OCTET 4+ encoding */
Harald Welte0c389302009-06-10 12:08:54 +0800499 }
Harald Welte0c389302009-06-10 12:08:54 +0800500
501 lv[0] = i;
502 if (lv_only)
503 msgb_lv_put(msg, lv[0], lv+1);
504 else
505 msgb_tlv_put(msg, GSM48_IE_BEARER_CAP, lv[0], lv+1);
506
507 return 0;
508}
509
510/* decode 'call control cap' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800511static int decode_cccap(struct gsm_mncc_cccap *ccap, const u_int8_t *lv)
Harald Welte0c389302009-06-10 12:08:54 +0800512{
513 u_int8_t in_len = lv[0];
514
515 if (in_len < 1)
516 return -EINVAL;
517
518 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800519 ccap->dtmf = lv[1] & 0x01;
520 ccap->pcp = (lv[1] & 0x02) >> 1;
Harald Welte0c389302009-06-10 12:08:54 +0800521
522 return 0;
523}
524
525/* decode 'called party BCD number' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800526static int decode_called(struct gsm_mncc_number *called,
527 const u_int8_t *lv)
Harald Welte0c389302009-06-10 12:08:54 +0800528{
529 u_int8_t in_len = lv[0];
530
531 if (in_len < 1)
532 return -EINVAL;
533
534 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800535 called->plan = lv[1] & 0x0f;
536 called->type = (lv[1] & 0x70) >> 4;
Harald Welte0c389302009-06-10 12:08:54 +0800537
538 /* octet 4..N */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800539 decode_bcd_number(called->number, sizeof(called->number), lv, 1);
Harald Welte0c389302009-06-10 12:08:54 +0800540
541 return 0;
542}
543
544/* encode 'called party BCD number' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800545static int encode_called(struct msgb *msg,
546 const struct gsm_mncc_number *called)
Harald Welte0c389302009-06-10 12:08:54 +0800547{
548 u_int8_t lv[18];
549 int ret;
550
551 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800552 lv[1] = called->plan;
553 lv[1] |= called->type << 4;
Harald Welte0c389302009-06-10 12:08:54 +0800554
555 /* octet 4..N, octet 2 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800556 ret = encode_bcd_number(lv, sizeof(lv), 1, called->number);
Harald Welte0c389302009-06-10 12:08:54 +0800557 if (ret < 0)
558 return ret;
559
560 msgb_tlv_put(msg, GSM48_IE_CALLED_BCD, lv[0], lv+1);
561
562 return 0;
563}
564
565/* encode callerid of various IEs */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800566static int encode_callerid(struct msgb *msg, int ie,
567 const struct gsm_mncc_number *callerid)
Harald Welte0c389302009-06-10 12:08:54 +0800568{
569 u_int8_t lv[13];
570 int h_len = 1;
571 int ret;
572
573 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800574 lv[1] = callerid->plan;
575 lv[1] |= callerid->type << 4;
Harald Welte0c389302009-06-10 12:08:54 +0800576
Harald Welte4bfdfe72009-06-10 23:11:52 +0800577 if (callerid->present || callerid->screen) {
Harald Welte0c389302009-06-10 12:08:54 +0800578 /* octet 3a */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800579 lv[2] = callerid->screen;
580 lv[2] |= callerid->present << 5;
Harald Welte0c389302009-06-10 12:08:54 +0800581 lv[2] |= 0x80;
582 h_len++;
583 } else
584 lv[1] |= 0x80;
585
586 /* octet 4..N, octet 2 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800587 ret = encode_bcd_number(lv, sizeof(lv), h_len, callerid->number);
Harald Welte0c389302009-06-10 12:08:54 +0800588 if (ret < 0)
589 return ret;
590
591 msgb_tlv_put(msg, ie, lv[0], lv+1);
592
593 return 0;
594}
595
596/* decode 'cause' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800597static int decode_cause(struct gsm_mncc_cause *cause,
Harald Welte0c389302009-06-10 12:08:54 +0800598 const u_int8_t *lv)
599{
600 u_int8_t in_len = lv[0];
601 int i;
602
603 if (in_len < 2)
604 return -EINVAL;
605
Harald Welte4bfdfe72009-06-10 23:11:52 +0800606 cause->diag_len = 0;
Harald Welte0c389302009-06-10 12:08:54 +0800607
608 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800609 cause->location = lv[1] & 0x0f;
610 cause->coding = (lv[1] & 0x60) >> 5;
Harald Welte0c389302009-06-10 12:08:54 +0800611
612 i = 1;
613 if (!(lv[i] & 0x80)) {
614 i++; /* octet 3a */
615 if (in_len < i+1)
616 return 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800617 cause->rec = 1;
618 cause->rec_val = lv[i] & 0x7f;
Harald Welte0c389302009-06-10 12:08:54 +0800619
620 }
621 i++;
622
623 /* octet 4 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800624 cause->value = lv[i] & 0x7f;
Harald Welte0c389302009-06-10 12:08:54 +0800625 i++;
626
627 if (in_len < i) /* no diag */
628 return 0;
629
630 if (in_len - (i-1) > 32) /* maximum 32 octets */
631 return 0;
632
633 /* octet 5-N */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800634 memcpy(cause->diag, lv + i, in_len - (i-1));
635 cause->diag_len = in_len - (i-1);
Harald Welte0c389302009-06-10 12:08:54 +0800636
637 return 0;
638}
639
640/* encode 'cause' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800641static int encode_cause(struct msgb *msg, int lv_only,
642 const struct gsm_mncc_cause *cause)
Harald Welte0c389302009-06-10 12:08:54 +0800643{
644 u_int8_t lv[32+4];
645 int i;
646
Harald Welte4bfdfe72009-06-10 23:11:52 +0800647 if (cause->diag_len > 32)
Harald Welte0c389302009-06-10 12:08:54 +0800648 return -EINVAL;
649
650 /* octet 3 */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800651 lv[1] = cause->location;
652 lv[1] |= cause->coding << 5;
Harald Welte0c389302009-06-10 12:08:54 +0800653
654 i = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800655 if (cause->rec) {
Harald Welte0c389302009-06-10 12:08:54 +0800656 i++; /* octet 3a */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800657 lv[i] = cause->rec_val;
Harald Welte0c389302009-06-10 12:08:54 +0800658 }
659 lv[i] |= 0x80; /* end of octet 3 */
660
661 /* octet 4 */
662 i++;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800663 lv[i] = 0x80 | cause->value;
Harald Welte0c389302009-06-10 12:08:54 +0800664
665 /* octet 5-N */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800666 if (cause->diag_len) {
667 memcpy(lv + i, cause->diag, cause->diag_len);
668 i += cause->diag_len;
Harald Welte0c389302009-06-10 12:08:54 +0800669 }
670
671 lv[0] = i;
672 if (lv_only)
673 msgb_lv_put(msg, lv[0], lv+1);
674 else
675 msgb_tlv_put(msg, GSM48_IE_CAUSE, lv[0], lv+1);
676
677 return 0;
678}
679
680/* encode 'calling number' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800681static int encode_calling(struct msgb *msg,
682 const struct gsm_mncc_number *calling)
Harald Welte0c389302009-06-10 12:08:54 +0800683{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800684 return encode_callerid(msg, GSM48_IE_CALLING_BCD, calling);
Harald Welte0c389302009-06-10 12:08:54 +0800685}
686
687/* encode 'connected number' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800688static int encode_connected(struct msgb *msg,
689 const struct gsm_mncc_number *connected)
Harald Welte0c389302009-06-10 12:08:54 +0800690{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800691 return encode_callerid(msg, GSM48_IE_CONN_BCD, connected);
Harald Welte0c389302009-06-10 12:08:54 +0800692}
693
694/* encode 'redirecting number' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800695static int encode_redirecting(struct msgb *msg,
696 const struct gsm_mncc_number *redirecting)
Harald Welte0c389302009-06-10 12:08:54 +0800697{
Harald Welte4bfdfe72009-06-10 23:11:52 +0800698 return encode_callerid(msg, GSM48_IE_REDIR_BCD, redirecting);
Harald Welte0c389302009-06-10 12:08:54 +0800699}
700
701/* decode 'facility' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800702static int decode_facility(struct gsm_mncc_facility *facility,
Harald Welte0c389302009-06-10 12:08:54 +0800703 const u_int8_t *lv)
704{
705 u_int8_t in_len = lv[0];
706
707 if (in_len < 1)
708 return -EINVAL;
709
Harald Welte4bfdfe72009-06-10 23:11:52 +0800710 if (in_len > sizeof(facility->info))
Harald Welte0c389302009-06-10 12:08:54 +0800711 return -EINVAL;
712
Harald Welte4bfdfe72009-06-10 23:11:52 +0800713 memcpy(facility->info, lv+1, in_len);
714 facility->len = in_len;
Harald Welte0c389302009-06-10 12:08:54 +0800715
716 return 0;
717}
718
719/* encode 'facility' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800720static int encode_facility(struct msgb *msg, int lv_only,
721 const struct gsm_mncc_facility *facility)
Harald Welte0c389302009-06-10 12:08:54 +0800722{
723 u_int8_t lv[GSM_MAX_FACILITY + 1];
724
Harald Welte4bfdfe72009-06-10 23:11:52 +0800725 if (facility->len < 1 || facility->len > GSM_MAX_FACILITY)
Harald Welte0c389302009-06-10 12:08:54 +0800726 return -EINVAL;
727
Harald Welte4bfdfe72009-06-10 23:11:52 +0800728 memcpy(lv+1, facility->info, facility->len);
729 lv[0] = facility->len;
Harald Welte0c389302009-06-10 12:08:54 +0800730 if (lv_only)
731 msgb_lv_put(msg, lv[0], lv+1);
732 else
733 msgb_tlv_put(msg, GSM48_IE_FACILITY, lv[0], lv+1);
734
735 return 0;
736}
737
738/* decode 'notify' */
739static int decode_notify(int *notify, const u_int8_t *v)
740{
741 *notify = v[0] & 0x7f;
742
743 return 0;
744}
745
746/* encode 'notify' */
747static int encode_notify(struct msgb *msg, int notify)
748{
749 msgb_v_put(msg, notify | 0x80);
750
751 return 0;
752}
753
754/* encode 'signal' */
755static int encode_signal(struct msgb *msg, int signal)
756{
757 msgb_tv_put(msg, GSM48_IE_SIGNAL, signal);
758
759 return 0;
760}
761
762/* decode 'keypad' */
763static int decode_keypad(int *keypad, const u_int8_t *lv)
764{
765 u_int8_t in_len = lv[0];
766
767 if (in_len < 1)
768 return -EINVAL;
769
770 *keypad = lv[1] & 0x7f;
771
772 return 0;
773}
774
775/* encode 'keypad' */
776static int encode_keypad(struct msgb *msg, int keypad)
777{
778 msgb_tv_put(msg, GSM48_IE_KPD_FACILITY, keypad);
779
780 return 0;
781}
782
783/* decode 'progress' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800784static int decode_progress(struct gsm_mncc_progress *progress,
Harald Welte0c389302009-06-10 12:08:54 +0800785 const u_int8_t *lv)
786{
787 u_int8_t in_len = lv[0];
788
789 if (in_len < 2)
790 return -EINVAL;
791
Harald Welte4bfdfe72009-06-10 23:11:52 +0800792 progress->coding = (lv[1] & 0x60) >> 5;
793 progress->location = lv[1] & 0x0f;
794 progress->descr = lv[2] & 0x7f;
Harald Welte0c389302009-06-10 12:08:54 +0800795
796 return 0;
797}
798
799/* encode 'progress' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800800static int encode_progress(struct msgb *msg, int lv_only,
801 const struct gsm_mncc_progress *p)
Harald Welte0c389302009-06-10 12:08:54 +0800802{
803 u_int8_t lv[3];
804
805 lv[0] = 2;
Harald Welte4bfdfe72009-06-10 23:11:52 +0800806 lv[1] = 0x80 | ((p->coding & 0x3) << 5) | (p->location & 0xf);
807 lv[2] = 0x80 | (p->descr & 0x7f);
Harald Welte0c389302009-06-10 12:08:54 +0800808 if (lv_only)
809 msgb_lv_put(msg, lv[0], lv+1);
810 else
811 msgb_tlv_put(msg, GSM48_IE_PROGR_IND, lv[0], lv+1);
812
813 return 0;
814}
815
816/* decode 'user-user' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800817static int decode_useruser(struct gsm_mncc_useruser *uu,
Harald Welte0c389302009-06-10 12:08:54 +0800818 const u_int8_t *lv)
819{
820 u_int8_t in_len = lv[0];
Harald Welte4bfdfe72009-06-10 23:11:52 +0800821 char *info = uu->info;
822 int info_len = sizeof(uu->info);
Harald Welte0c389302009-06-10 12:08:54 +0800823 int i;
824
825 if (in_len < 1)
826 return -EINVAL;
827
Harald Welte4bfdfe72009-06-10 23:11:52 +0800828 uu->proto = lv[1];
Harald Welte0c389302009-06-10 12:08:54 +0800829
830 for (i = 2; i <= in_len; i++) {
831 info_len--;
832 if (info_len <= 1)
833 break;
834 *info++ = lv[i];
835 }
836 if (info_len >= 1)
837 *info++ = '\0';
838
839 return 0;
840}
841
842/* encode 'useruser' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800843static int encode_useruser(struct msgb *msg, int lv_only,
844 const struct gsm_mncc_useruser *uu)
Harald Welte0c389302009-06-10 12:08:54 +0800845{
846 u_int8_t lv[GSM_MAX_USERUSER + 2];
847
Harald Welte4bfdfe72009-06-10 23:11:52 +0800848 if (strlen(uu->info) > GSM_MAX_USERUSER)
Harald Welte0c389302009-06-10 12:08:54 +0800849 return -EINVAL;
850
Harald Welte4bfdfe72009-06-10 23:11:52 +0800851 lv[0] = 1 + strlen(uu->info);
852 lv[1] = uu->proto;
853 memcpy(lv + 2, uu->info, strlen(uu->info));
Harald Welte0c389302009-06-10 12:08:54 +0800854 if (lv_only)
855 msgb_lv_put(msg, lv[0], lv+1);
856 else
857 msgb_tlv_put(msg, GSM48_IE_USER_USER, lv[0], lv+1);
858
859 return 0;
860}
861
862/* decode 'ss version' */
Harald Welte4bfdfe72009-06-10 23:11:52 +0800863static int decode_ssversion(struct gsm_mncc_ssversion *ssv,
Harald Welte0c389302009-06-10 12:08:54 +0800864 const u_int8_t *lv)
865{
866 u_int8_t in_len = lv[0];
867
Harald Welte4bfdfe72009-06-10 23:11:52 +0800868 if (in_len < 1 || in_len < sizeof(ssv->info))
Harald Welte0c389302009-06-10 12:08:54 +0800869 return -EINVAL;
870
Harald Welte4bfdfe72009-06-10 23:11:52 +0800871 memcpy(ssv->info, lv + 1, in_len);
872 ssv->len = in_len;
Harald Welte0c389302009-06-10 12:08:54 +0800873
874 return 0;
875}
876
877/* encode 'more data' */
878static int encode_more(struct msgb *msg)
879{
880 u_int8_t *ie;
881
882 ie = msgb_put(msg, 1);
883 ie[0] = GSM48_IE_MORE_DATA;
884
885 return 0;
886}
887
Holger Freyther429e7762008-12-30 13:28:30 +0000888/* Chapter 9.2.14 : Send LOCATION UPDATING REJECT */
Harald Welte8470bf22008-12-25 23:28:35 +0000889int gsm0408_loc_upd_rej(struct gsm_lchan *lchan, u_int8_t cause)
Harald Welte52b1f982008-12-23 20:25:15 +0000890{
Harald Welte8470bf22008-12-25 23:28:35 +0000891 struct msgb *msg = gsm48_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000892 struct gsm48_hdr *gh;
893
Harald Welte8470bf22008-12-25 23:28:35 +0000894 msg->lchan = lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000895
896 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
897 gh->proto_discr = GSM48_PDISC_MM;
Harald Welte10b487b2008-12-27 19:53:37 +0000898 gh->msg_type = GSM48_MT_MM_LOC_UPD_REJECT;
Harald Welte52b1f982008-12-23 20:25:15 +0000899 gh->data[0] = cause;
900
Harald Weltedb253af2008-12-30 17:56:55 +0000901 DEBUGP(DMM, "-> LOCATION UPDATING REJECT on channel: %d\n", lchan->nr);
902
Harald Welte39e2ead2009-07-23 21:13:03 +0200903 return gsm48_sendmsg(msg, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000904}
905
906/* Chapter 9.2.13 : Send LOCATION UPDATE ACCEPT */
Harald Welte75a983f2008-12-27 21:34:06 +0000907int gsm0408_loc_upd_acc(struct gsm_lchan *lchan, u_int32_t tmsi)
Harald Welte52b1f982008-12-23 20:25:15 +0000908{
Harald Welte8470bf22008-12-25 23:28:35 +0000909 struct gsm_bts *bts = lchan->ts->trx->bts;
910 struct msgb *msg = gsm48_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000911 struct gsm48_hdr *gh;
912 struct gsm48_loc_area_id *lai;
913 u_int8_t *mid;
914
Harald Welte8470bf22008-12-25 23:28:35 +0000915 msg->lchan = lchan;
Harald Welte52b1f982008-12-23 20:25:15 +0000916
917 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
918 gh->proto_discr = GSM48_PDISC_MM;
919 gh->msg_type = GSM48_MT_MM_LOC_UPD_ACCEPT;
920
921 lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai));
Holger Freyther17746612008-12-28 16:32:44 +0000922 gsm0408_generate_lai(lai, bts->network->country_code,
Harald Welte52b1f982008-12-23 20:25:15 +0000923 bts->network->network_code, bts->location_area_code);
924
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200925 mid = msgb_put(msg, GSM48_MID_TMSI_LEN);
Holger Hans Peter Freyther5d0e56f2009-08-20 08:41:24 +0200926 gsm48_generate_mid_from_tmsi(mid, tmsi);
Harald Welte52b1f982008-12-23 20:25:15 +0000927
928 DEBUGP(DMM, "-> LOCATION UPDATE ACCEPT\n");
929
Harald Welteb83d9382009-12-12 21:00:48 +0100930 return gsm48_sendmsg(msg, NULL);
Harald Welte52b1f982008-12-23 20:25:15 +0000931}
932
Harald Weltebf5e8df2009-02-03 12:59:45 +0000933/* Transmit Chapter 9.2.10 Identity Request */
Harald Welte231ad4f2008-12-27 11:15:38 +0000934static int mm_tx_identity_req(struct gsm_lchan *lchan, u_int8_t id_type)
935{
936 struct msgb *msg = gsm48_msgb_alloc();
937 struct gsm48_hdr *gh;
Harald Weltefc977a82008-12-27 10:19:37 +0000938
Harald Welte231ad4f2008-12-27 11:15:38 +0000939 msg->lchan = lchan;
940
941 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
942 gh->proto_discr = GSM48_PDISC_MM;
943 gh->msg_type = GSM48_MT_MM_ID_REQ;
944 gh->data[0] = id_type;
945
Harald Welte39e2ead2009-07-23 21:13:03 +0200946 return gsm48_sendmsg(msg, NULL);
Harald Welte231ad4f2008-12-27 11:15:38 +0000947}
948
Harald Welte231ad4f2008-12-27 11:15:38 +0000949
Harald Weltebf5e8df2009-02-03 12:59:45 +0000950/* Parse Chapter 9.2.11 Identity Response */
Harald Welte231ad4f2008-12-27 11:15:38 +0000951static int mm_rx_id_resp(struct msgb *msg)
952{
953 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte75a983f2008-12-27 21:34:06 +0000954 struct gsm_lchan *lchan = msg->lchan;
Harald Welte9176bd42009-07-23 18:46:00 +0200955 struct gsm_bts *bts = lchan->ts->trx->bts;
956 struct gsm_network *net = bts->network;
Harald Welte231ad4f2008-12-27 11:15:38 +0000957 u_int8_t mi_type = gh->data[1] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200958 char mi_string[GSM48_MI_SIZE];
Harald Welte231ad4f2008-12-27 11:15:38 +0000959
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +0200960 gsm48_mi_to_string(mi_string, sizeof(mi_string), &gh->data[1], gh->data[0]);
Harald Welte61253062008-12-27 11:25:50 +0000961 DEBUGP(DMM, "IDENTITY RESPONSE: mi_type=0x%02x MI(%s)\n",
Harald Welte231ad4f2008-12-27 11:15:38 +0000962 mi_type, mi_string);
963
Harald Welte7659de12009-12-13 12:39:18 +0100964 dispatch_signal(SS_SUBSCR, S_SUBSCR_IDENTITY, gh->data);
965
Harald Welte75a983f2008-12-27 21:34:06 +0000966 switch (mi_type) {
967 case GSM_MI_TYPE_IMSI:
Jan Luebbe370b41d2009-08-12 10:19:34 +0200968 /* look up subscriber based on IMSI, create if not found */
969 if (!lchan->subscr) {
970 lchan->subscr = subscr_get_by_imsi(net, mi_string);
Harald Welte (local)aa9dc192009-08-13 13:49:51 +0200971 if (!lchan->subscr)
972 lchan->subscr = db_create_subscriber(net, mi_string);
Jan Luebbeb0dfc312009-08-12 10:12:52 +0200973 }
Holger Freyther73487a22008-12-31 18:53:57 +0000974 if (lchan->loc_operation)
975 lchan->loc_operation->waiting_for_imsi = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000976 break;
977 case GSM_MI_TYPE_IMEI:
Harald Welte255539c2008-12-28 02:26:27 +0000978 case GSM_MI_TYPE_IMEISV:
Harald Welte75a983f2008-12-27 21:34:06 +0000979 /* update subscribe <-> IMEI mapping */
Harald Welte (local)ee4410a2009-08-17 09:39:55 +0200980 if (lchan->subscr) {
Harald Welte75a983f2008-12-27 21:34:06 +0000981 db_subscriber_assoc_imei(lchan->subscr, mi_string);
Harald Welte (local)ee4410a2009-08-17 09:39:55 +0200982 db_sync_equipment(&lchan->subscr->equipment);
983 }
Holger Freyther73487a22008-12-31 18:53:57 +0000984 if (lchan->loc_operation)
985 lchan->loc_operation->waiting_for_imei = 0;
Harald Welte75a983f2008-12-27 21:34:06 +0000986 break;
987 }
Holger Freyther73487a22008-12-31 18:53:57 +0000988
989 /* Check if we can let the mobile station enter */
Holger Freytherd51524f2009-06-09 08:27:07 +0000990 return gsm0408_authorize(lchan, msg);
Harald Welte231ad4f2008-12-27 11:15:38 +0000991}
992
Harald Welte255539c2008-12-28 02:26:27 +0000993
994static void loc_upd_rej_cb(void *data)
995{
996 struct gsm_lchan *lchan = data;
Harald Welte1085c092009-11-18 20:33:19 +0100997 struct gsm_bts *bts = lchan->ts->trx->bts;
Harald Welte255539c2008-12-28 02:26:27 +0000998
Holger Freyther73487a22008-12-31 18:53:57 +0000999 release_loc_updating_req(lchan);
Harald Welte1085c092009-11-18 20:33:19 +01001000 gsm0408_loc_upd_rej(lchan, bts->network->reject_cause);
Holger Freyther67b4b9a2009-01-01 03:46:11 +00001001 lchan_auto_release(lchan);
Harald Welte255539c2008-12-28 02:26:27 +00001002}
1003
Holger Freytherb7193e42008-12-29 17:44:08 +00001004static void schedule_reject(struct gsm_lchan *lchan)
1005{
Holger Freyther73487a22008-12-31 18:53:57 +00001006 lchan->loc_operation->updating_timer.cb = loc_upd_rej_cb;
1007 lchan->loc_operation->updating_timer.data = lchan;
Harald Welteff117a82009-05-23 05:22:08 +00001008 bsc_schedule_timer(&lchan->loc_operation->updating_timer, 5, 0);
Holger Freytherb7193e42008-12-29 17:44:08 +00001009}
1010
Harald Welte2a139372009-02-22 21:14:55 +00001011static const char *lupd_name(u_int8_t type)
1012{
1013 switch (type) {
1014 case GSM48_LUPD_NORMAL:
1015 return "NORMAL";
1016 case GSM48_LUPD_PERIODIC:
1017 return "PEROIDOC";
1018 case GSM48_LUPD_IMSI_ATT:
1019 return "IMSI ATTACH";
1020 default:
1021 return "UNKNOWN";
1022 }
1023}
1024
Harald Weltebf5e8df2009-02-03 12:59:45 +00001025/* Chapter 9.2.15: Receive Location Updating Request */
Harald Welte231ad4f2008-12-27 11:15:38 +00001026static int mm_rx_loc_upd_req(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001027{
Harald Welte8470bf22008-12-25 23:28:35 +00001028 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001029 struct gsm48_loc_upd_req *lu;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001030 struct gsm_subscriber *subscr = NULL;
Harald Welte255539c2008-12-28 02:26:27 +00001031 struct gsm_lchan *lchan = msg->lchan;
Harald Welte9176bd42009-07-23 18:46:00 +02001032 struct gsm_bts *bts = lchan->ts->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001033 u_int8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001034 char mi_string[GSM48_MI_SIZE];
Harald Welte231ad4f2008-12-27 11:15:38 +00001035 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001036
Harald Welte8470bf22008-12-25 23:28:35 +00001037 lu = (struct gsm48_loc_upd_req *) gh->data;
1038
1039 mi_type = lu->mi[0] & GSM_MI_TYPE_MASK;
Harald Welte52b1f982008-12-23 20:25:15 +00001040
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001041 gsm48_mi_to_string(mi_string, sizeof(mi_string), lu->mi, lu->mi_len);
Harald Weltefc977a82008-12-27 10:19:37 +00001042
Harald Weltea0368542009-06-27 02:58:43 +02001043 DEBUGPC(DMM, "mi_type=0x%02x MI(%s) type=%s ", mi_type, mi_string,
Harald Welte2a139372009-02-22 21:14:55 +00001044 lupd_name(lu->type));
Holger Freyther73487a22008-12-31 18:53:57 +00001045
Harald Welte7659de12009-12-13 12:39:18 +01001046 dispatch_signal(SS_SUBSCR, S_SUBSCR_IDENTITY, &lu->mi_len);
1047
Holger Freythereaf04692009-06-06 13:54:44 +00001048 /*
1049 * Pseudo Spoof detection: Just drop a second/concurrent
1050 * location updating request.
1051 */
1052 if (lchan->loc_operation) {
Harald Weltea0368542009-06-27 02:58:43 +02001053 DEBUGPC(DMM, "ignoring request due an existing one: %p.\n",
Holger Freythereaf04692009-06-06 13:54:44 +00001054 lchan->loc_operation);
1055 gsm0408_loc_upd_rej(lchan, GSM48_REJECT_PROTOCOL_ERROR);
1056 return 0;
1057 }
1058
Holger Freyther73487a22008-12-31 18:53:57 +00001059 allocate_loc_updating_req(lchan);
1060
Harald Welte52b1f982008-12-23 20:25:15 +00001061 switch (mi_type) {
1062 case GSM_MI_TYPE_IMSI:
Harald Weltea0368542009-06-27 02:58:43 +02001063 DEBUGPC(DMM, "\n");
Harald Welte231ad4f2008-12-27 11:15:38 +00001064 /* we always want the IMEI, too */
Harald Welte015b9ad2009-02-28 18:22:03 +00001065 rc = mm_tx_identity_req(lchan, GSM_MI_TYPE_IMEI);
Holger Freyther73487a22008-12-31 18:53:57 +00001066 lchan->loc_operation->waiting_for_imei = 1;
Holger Freytherc6ea9db2008-12-30 19:18:21 +00001067
Jan Luebbe370b41d2009-08-12 10:19:34 +02001068 /* look up subscriber based on IMSI, create if not found */
1069 subscr = subscr_get_by_imsi(bts->network, mi_string);
1070 if (!subscr) {
1071 subscr = db_create_subscriber(bts->network, mi_string);
1072 }
Harald Welte4b634542008-12-27 01:55:51 +00001073 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001074 case GSM_MI_TYPE_TMSI:
Harald Weltea0368542009-06-27 02:58:43 +02001075 DEBUGPC(DMM, "\n");
Harald Welte231ad4f2008-12-27 11:15:38 +00001076 /* we always want the IMEI, too */
Harald Welte015b9ad2009-02-28 18:22:03 +00001077 rc = mm_tx_identity_req(lchan, GSM_MI_TYPE_IMEI);
Holger Freyther73487a22008-12-31 18:53:57 +00001078 lchan->loc_operation->waiting_for_imei = 1;
Holger Freytherc6ea9db2008-12-30 19:18:21 +00001079
Harald Welte52b1f982008-12-23 20:25:15 +00001080 /* look up the subscriber based on TMSI, request IMSI if it fails */
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001081 subscr = subscr_get_by_tmsi(bts->network,
1082 tmsi_from_string(mi_string));
Harald Welte52b1f982008-12-23 20:25:15 +00001083 if (!subscr) {
Harald Welte231ad4f2008-12-27 11:15:38 +00001084 /* send IDENTITY REQUEST message to get IMSI */
Harald Welte255539c2008-12-28 02:26:27 +00001085 rc = mm_tx_identity_req(lchan, GSM_MI_TYPE_IMSI);
Holger Freyther73487a22008-12-31 18:53:57 +00001086 lchan->loc_operation->waiting_for_imsi = 1;
Harald Welte52b1f982008-12-23 20:25:15 +00001087 }
1088 break;
1089 case GSM_MI_TYPE_IMEI:
1090 case GSM_MI_TYPE_IMEISV:
1091 /* no sim card... FIXME: what to do ? */
Harald Weltea0368542009-06-27 02:58:43 +02001092 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +00001093 break;
1094 default:
Harald Weltea0368542009-06-27 02:58:43 +02001095 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte52b1f982008-12-23 20:25:15 +00001096 break;
1097 }
1098
Harald Welte24516ea2009-07-04 10:18:00 +02001099 /* schedule the reject timer */
1100 schedule_reject(lchan);
1101
Harald Welte4bfdfe72009-06-10 23:11:52 +08001102 if (!subscr) {
Harald Weltea0368542009-06-27 02:58:43 +02001103 DEBUGPC(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte4bfdfe72009-06-10 23:11:52 +08001104 /* FIXME: request id? close channel? */
1105 return -EINVAL;
1106 }
1107
Harald Welte255539c2008-12-28 02:26:27 +00001108 lchan->subscr = subscr;
Harald Welte (local)ee4410a2009-08-17 09:39:55 +02001109 lchan->subscr->equipment.classmark1 = lu->classmark1;
Harald Welte255539c2008-12-28 02:26:27 +00001110
Harald Welte24516ea2009-07-04 10:18:00 +02001111 /* check if we can let the subscriber into our network immediately
1112 * or if we need to wait for identity responses. */
Holger Freytherd51524f2009-06-09 08:27:07 +00001113 return gsm0408_authorize(lchan, msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001114}
1115
Harald Welte4bfdfe72009-06-10 23:11:52 +08001116#if 0
1117static u_int8_t to_bcd8(u_int8_t val)
1118{
1119 return ((val / 10) << 4) | (val % 10);
1120}
1121#endif
1122
Harald Weltedb253af2008-12-30 17:56:55 +00001123/* Section 9.2.15a */
1124int gsm48_tx_mm_info(struct gsm_lchan *lchan)
1125{
1126 struct msgb *msg = gsm48_msgb_alloc();
1127 struct gsm48_hdr *gh;
1128 struct gsm_network *net = lchan->ts->trx->bts->network;
Harald Weltedb253af2008-12-30 17:56:55 +00001129 u_int8_t *ptr8;
Daniel Willmanneea93372009-08-13 03:42:07 +02001130 int name_len, name_pad;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001131#if 0
1132 time_t cur_t;
1133 struct tm* cur_time;
1134 int tz15min;
1135#endif
Harald Weltedb253af2008-12-30 17:56:55 +00001136
1137 msg->lchan = lchan;
1138
1139 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1140 gh->proto_discr = GSM48_PDISC_MM;
1141 gh->msg_type = GSM48_MT_MM_INFO;
1142
1143 if (net->name_long) {
Daniel Willmanneea93372009-08-13 03:42:07 +02001144#if 0
Harald Weltedb253af2008-12-30 17:56:55 +00001145 name_len = strlen(net->name_long);
1146 /* 10.5.3.5a */
1147 ptr8 = msgb_put(msg, 3);
1148 ptr8[0] = GSM48_IE_NAME_LONG;
1149 ptr8[1] = name_len*2 +1;
1150 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
1151
1152 ptr16 = (u_int16_t *) msgb_put(msg, name_len*2);
1153 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +00001154 ptr16[i] = htons(net->name_long[i]);
Harald Weltedb253af2008-12-30 17:56:55 +00001155
1156 /* FIXME: Use Cell Broadcast, not UCS-2, since
1157 * UCS-2 is only supported by later revisions of the spec */
Daniel Willmanneea93372009-08-13 03:42:07 +02001158#endif
1159 name_len = (strlen(net->name_long)*7)/8;
1160 name_pad = (8 - strlen(net->name_long)*7)%8;
1161 if (name_pad > 0)
1162 name_len++;
1163 /* 10.5.3.5a */
1164 ptr8 = msgb_put(msg, 3);
1165 ptr8[0] = GSM48_IE_NAME_LONG;
1166 ptr8[1] = name_len +1;
1167 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
1168
1169 ptr8 = msgb_put(msg, name_len);
1170 gsm_7bit_encode(ptr8, net->name_long);
1171
Harald Weltedb253af2008-12-30 17:56:55 +00001172 }
1173
1174 if (net->name_short) {
Daniel Willmanneea93372009-08-13 03:42:07 +02001175#if 0
Harald Weltedb253af2008-12-30 17:56:55 +00001176 name_len = strlen(net->name_short);
1177 /* 10.5.3.5a */
1178 ptr8 = (u_int8_t *) msgb_put(msg, 3);
Harald Welte7543eb72009-07-19 17:51:36 +02001179 ptr8[0] = GSM48_IE_NAME_SHORT;
Harald Weltedb253af2008-12-30 17:56:55 +00001180 ptr8[1] = name_len*2 + 1;
1181 ptr8[2] = 0x90; /* UCS2, no spare bits, no CI */
1182
Harald Weltee872cb12009-01-01 00:33:37 +00001183 ptr16 = (u_int16_t *) msgb_put(msg, name_len*2);
Harald Weltedb253af2008-12-30 17:56:55 +00001184 for (i = 0; i < name_len; i++)
Harald Welte179f0642008-12-31 23:59:18 +00001185 ptr16[i] = htons(net->name_short[i]);
Daniel Willmanneea93372009-08-13 03:42:07 +02001186#endif
1187 name_len = (strlen(net->name_short)*7)/8;
1188 name_pad = (8 - strlen(net->name_short)*7)%8;
1189 if (name_pad > 0)
1190 name_len++;
1191 /* 10.5.3.5a */
1192 ptr8 = (u_int8_t *) msgb_put(msg, 3);
1193 ptr8[0] = GSM48_IE_NAME_SHORT;
1194 ptr8[1] = name_len +1;
1195 ptr8[2] = 0x80 | name_pad; /* Cell Broadcast DCS, no CI */
1196
1197 ptr8 = msgb_put(msg, name_len);
1198 gsm_7bit_encode(ptr8, net->name_short);
1199
Harald Weltedb253af2008-12-30 17:56:55 +00001200 }
1201
1202#if 0
1203 /* Section 10.5.3.9 */
1204 cur_t = time(NULL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001205 cur_time = gmtime(&cur_t);
Harald Weltedb253af2008-12-30 17:56:55 +00001206 ptr8 = msgb_put(msg, 8);
1207 ptr8[0] = GSM48_IE_NET_TIME_TZ;
1208 ptr8[1] = to_bcd8(cur_time->tm_year % 100);
1209 ptr8[2] = to_bcd8(cur_time->tm_mon);
1210 ptr8[3] = to_bcd8(cur_time->tm_mday);
1211 ptr8[4] = to_bcd8(cur_time->tm_hour);
1212 ptr8[5] = to_bcd8(cur_time->tm_min);
1213 ptr8[6] = to_bcd8(cur_time->tm_sec);
1214 /* 02.42: coded as BCD encoded signed value in units of 15 minutes */
1215 tz15min = (cur_time->tm_gmtoff)/(60*15);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001216 ptr8[7] = to_bcd8(tz15min);
Harald Weltedb253af2008-12-30 17:56:55 +00001217 if (tz15min < 0)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001218 ptr8[7] |= 0x80;
Harald Weltedb253af2008-12-30 17:56:55 +00001219#endif
1220
Daniel Willmanneea93372009-08-13 03:42:07 +02001221 DEBUGP(DMM, "-> MM INFO\n");
1222
Harald Welte39e2ead2009-07-23 21:13:03 +02001223 return gsm48_sendmsg(msg, NULL);
Harald Weltedb253af2008-12-30 17:56:55 +00001224}
1225
Harald Welte7984d5c2009-08-12 22:56:50 +02001226/* Section 9.2.2 */
1227int gsm48_tx_mm_auth_req(struct gsm_lchan *lchan, u_int8_t *rand)
1228{
1229 struct msgb *msg = gsm48_msgb_alloc();
1230 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Sylvain Munaut849f5542009-09-27 11:10:17 +02001231 struct gsm48_auth_req *ar = (struct gsm48_auth_req *) msgb_put(msg, sizeof(*ar));
Harald Welte7984d5c2009-08-12 22:56:50 +02001232
1233 DEBUGP(DMM, "-> AUTH REQ\n");
1234
1235 msg->lchan = lchan;
1236 gh->proto_discr = GSM48_PDISC_MM;
1237 gh->msg_type = GSM48_MT_MM_AUTH_REQ;
1238
Sylvain Munaut849f5542009-09-27 11:10:17 +02001239 /* Key Sequence: FIXME fixed to 0 */
1240 ar->key_seq = 0;
1241
Harald Welte7984d5c2009-08-12 22:56:50 +02001242 /* 16 bytes RAND parameters */
Harald Welte7984d5c2009-08-12 22:56:50 +02001243 if (rand)
Sylvain Munaut849f5542009-09-27 11:10:17 +02001244 memcpy(ar->rand, rand, 16);
Harald Welte7984d5c2009-08-12 22:56:50 +02001245
1246 return gsm48_sendmsg(msg, NULL);
1247}
1248
1249/* Section 9.2.1 */
1250int gsm48_tx_mm_auth_rej(struct gsm_lchan *lchan)
1251{
1252 DEBUGP(DMM, "-> AUTH REJECT\n");
1253 return gsm48_tx_simple(lchan, GSM48_PDISC_MM, GSM48_MT_MM_AUTH_REJ);
1254}
1255
Harald Welte4b634542008-12-27 01:55:51 +00001256static int gsm48_tx_mm_serv_ack(struct gsm_lchan *lchan)
1257{
Harald Welte4b634542008-12-27 01:55:51 +00001258 DEBUGP(DMM, "-> CM SERVICE ACK\n");
Harald Welte65e74cc2008-12-29 01:55:35 +00001259 return gsm48_tx_simple(lchan, GSM48_PDISC_MM, GSM48_MT_MM_CM_SERV_ACC);
Harald Welte4b634542008-12-27 01:55:51 +00001260}
Harald Welteba4cf162009-01-10 01:49:35 +00001261
1262/* 9.2.6 CM service reject */
1263static int gsm48_tx_mm_serv_rej(struct gsm_lchan *lchan,
1264 enum gsm48_reject_value value)
1265{
1266 struct msgb *msg = gsm48_msgb_alloc();
1267 struct gsm48_hdr *gh;
1268
1269 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
1270
1271 msg->lchan = lchan;
1272 use_lchan(lchan);
1273
1274 gh->proto_discr = GSM48_PDISC_MM;
1275 gh->msg_type = GSM48_MT_MM_CM_SERV_REJ;
1276 gh->data[0] = value;
1277 DEBUGP(DMM, "-> CM SERVICE Reject cause: %d\n", value);
1278
Harald Welte39e2ead2009-07-23 21:13:03 +02001279 return gsm48_sendmsg(msg, NULL);
Harald Welteba4cf162009-01-10 01:49:35 +00001280}
1281
Harald Welte4ed0e922009-01-10 03:17:30 +00001282/*
1283 * Handle CM Service Requests
1284 * a) Verify that the packet is long enough to contain the information
1285 * we require otherwsie reject with INCORRECT_MESSAGE
1286 * b) Try to parse the TMSI. If we do not have one reject
1287 * c) Check that we know the subscriber with the TMSI otherwise reject
1288 * with a HLR cause
1289 * d) Set the subscriber on the gsm_lchan and accept
1290 */
Harald Welte4b634542008-12-27 01:55:51 +00001291static int gsm48_rx_mm_serv_req(struct msgb *msg)
1292{
Harald Welteba4cf162009-01-10 01:49:35 +00001293 u_int8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001294 char mi_string[GSM48_MI_SIZE];
Harald Welte4b634542008-12-27 01:55:51 +00001295
Harald Welte9176bd42009-07-23 18:46:00 +02001296 struct gsm_bts *bts = msg->lchan->ts->trx->bts;
Harald Welteba4cf162009-01-10 01:49:35 +00001297 struct gsm_subscriber *subscr;
1298 struct gsm48_hdr *gh = msgb_l3(msg);
1299 struct gsm48_service_request *req =
1300 (struct gsm48_service_request *)gh->data;
Harald Weltec9e02182009-05-01 19:07:53 +00001301 /* unfortunately in Phase1 the classmar2 length is variable */
1302 u_int8_t classmark2_len = gh->data[1];
1303 u_int8_t *classmark2 = gh->data+2;
1304 u_int8_t mi_len = *(classmark2 + classmark2_len);
1305 u_int8_t *mi = (classmark2 + classmark2_len + 1);
Harald Welteba4cf162009-01-10 01:49:35 +00001306
Harald Weltec9e02182009-05-01 19:07:53 +00001307 DEBUGP(DMM, "<- CM SERVICE REQUEST ");
Harald Welteba4cf162009-01-10 01:49:35 +00001308 if (msg->data_len < sizeof(struct gsm48_service_request*)) {
Harald Weltec9e02182009-05-01 19:07:53 +00001309 DEBUGPC(DMM, "wrong sized message\n");
Harald Welteba4cf162009-01-10 01:49:35 +00001310 return gsm48_tx_mm_serv_rej(msg->lchan,
1311 GSM48_REJECT_INCORRECT_MESSAGE);
1312 }
1313
1314 if (msg->data_len < req->mi_len + 6) {
Harald Weltec9e02182009-05-01 19:07:53 +00001315 DEBUGPC(DMM, "does not fit in packet\n");
Harald Welteba4cf162009-01-10 01:49:35 +00001316 return gsm48_tx_mm_serv_rej(msg->lchan,
1317 GSM48_REJECT_INCORRECT_MESSAGE);
1318 }
1319
Harald Weltec9e02182009-05-01 19:07:53 +00001320 mi_type = mi[0] & GSM_MI_TYPE_MASK;
Harald Welteba4cf162009-01-10 01:49:35 +00001321 if (mi_type != GSM_MI_TYPE_TMSI) {
Harald Weltec9e02182009-05-01 19:07:53 +00001322 DEBUGPC(DMM, "mi_type is not TMSI: %d\n", mi_type);
Harald Welteba4cf162009-01-10 01:49:35 +00001323 return gsm48_tx_mm_serv_rej(msg->lchan,
1324 GSM48_REJECT_INCORRECT_MESSAGE);
1325 }
1326
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001327 gsm48_mi_to_string(mi_string, sizeof(mi_string), mi, mi_len);
Harald Weltec9e02182009-05-01 19:07:53 +00001328 DEBUGPC(DMM, "serv_type=0x%02x mi_type=0x%02x M(%s)\n",
Harald Welte4ed0e922009-01-10 03:17:30 +00001329 req->cm_service_type, mi_type, mi_string);
Harald Weltebcae43f2008-12-27 21:45:37 +00001330
Harald Welte7659de12009-12-13 12:39:18 +01001331 dispatch_signal(SS_SUBSCR, S_SUBSCR_IDENTITY, (classmark2 + classmark2_len));
1332
Harald Welte3ac7f102009-08-10 10:12:45 +02001333 if (is_siemens_bts(bts))
1334 send_siemens_mrpci(msg->lchan, classmark2-1);
1335
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001336 subscr = subscr_get_by_tmsi(bts->network,
1337 tmsi_from_string(mi_string));
Holger Freythereb443982009-06-04 13:58:42 +00001338
Harald Welte2a139372009-02-22 21:14:55 +00001339 /* FIXME: if we don't know the TMSI, inquire abit IMSI and allocate new TMSI */
Harald Welte4ed0e922009-01-10 03:17:30 +00001340 if (!subscr)
1341 return gsm48_tx_mm_serv_rej(msg->lchan,
1342 GSM48_REJECT_IMSI_UNKNOWN_IN_HLR);
1343
1344 if (!msg->lchan->subscr)
1345 msg->lchan->subscr = subscr;
Sylvain Munautea3f6742009-12-18 18:28:10 +01001346 else if (msg->lchan->subscr == subscr)
1347 subscr_put(subscr); /* lchan already has a ref, don't need another one */
1348 else {
Harald Welte9bb7c702009-01-10 03:21:41 +00001349 DEBUGP(DMM, "<- CM Channel already owned by someone else?\n");
1350 subscr_put(subscr);
1351 }
1352
Harald Weltec2e302d2009-07-05 14:08:13 +02001353 subscr->equipment.classmark2_len = classmark2_len;
1354 memcpy(subscr->equipment.classmark2, classmark2, classmark2_len);
1355 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001356
Harald Welte4b634542008-12-27 01:55:51 +00001357 return gsm48_tx_mm_serv_ack(msg->lchan);
1358}
1359
Harald Welte2a139372009-02-22 21:14:55 +00001360static int gsm48_rx_mm_imsi_detach_ind(struct msgb *msg)
1361{
Harald Welte9176bd42009-07-23 18:46:00 +02001362 struct gsm_bts *bts = msg->lchan->ts->trx->bts;
Harald Welte2a139372009-02-22 21:14:55 +00001363 struct gsm48_hdr *gh = msgb_l3(msg);
1364 struct gsm48_imsi_detach_ind *idi =
1365 (struct gsm48_imsi_detach_ind *) gh->data;
1366 u_int8_t mi_type = idi->mi[0] & GSM_MI_TYPE_MASK;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001367 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +08001368 struct gsm_subscriber *subscr = NULL;
Harald Welte2a139372009-02-22 21:14:55 +00001369
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001370 gsm48_mi_to_string(mi_string, sizeof(mi_string), idi->mi, idi->mi_len);
Harald Welte2a139372009-02-22 21:14:55 +00001371 DEBUGP(DMM, "IMSI DETACH INDICATION: mi_type=0x%02x MI(%s): ",
1372 mi_type, mi_string);
1373
1374 switch (mi_type) {
1375 case GSM_MI_TYPE_TMSI:
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001376 subscr = subscr_get_by_tmsi(bts->network,
1377 tmsi_from_string(mi_string));
Harald Welte2a139372009-02-22 21:14:55 +00001378 break;
1379 case GSM_MI_TYPE_IMSI:
Harald Welte9176bd42009-07-23 18:46:00 +02001380 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Welte2a139372009-02-22 21:14:55 +00001381 break;
1382 case GSM_MI_TYPE_IMEI:
1383 case GSM_MI_TYPE_IMEISV:
1384 /* no sim card... FIXME: what to do ? */
Holger Freyther79f4ae62009-06-02 03:25:04 +00001385 DEBUGPC(DMM, "unimplemented mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +00001386 break;
1387 default:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001388 DEBUGPC(DMM, "unknown mobile identity type\n");
Harald Welte2a139372009-02-22 21:14:55 +00001389 break;
1390 }
1391
Holger Freyther4a49e772009-04-12 05:37:29 +00001392 if (subscr) {
1393 subscr_update(subscr, msg->trx->bts,
1394 GSM_SUBSCRIBER_UPDATE_DETACHED);
Harald Welte2a139372009-02-22 21:14:55 +00001395 DEBUGP(DMM, "Subscriber: %s\n",
1396 subscr->name ? subscr->name : subscr->imsi);
Harald Welte (local)ee4410a2009-08-17 09:39:55 +02001397
1398 subscr->equipment.classmark1 = idi->classmark1;
1399 db_sync_equipment(&subscr->equipment);
1400
Holger Freytherc21cfbc2009-06-02 02:54:57 +00001401 subscr_put(subscr);
Holger Freyther4a49e772009-04-12 05:37:29 +00001402 } else
Harald Welte2a139372009-02-22 21:14:55 +00001403 DEBUGP(DMM, "Unknown Subscriber ?!?\n");
1404
Harald Welteb83d9382009-12-12 21:00:48 +01001405 /* subscriber is detached: should we release lchan? */
1406
Harald Welte2a139372009-02-22 21:14:55 +00001407 return 0;
1408}
1409
Harald Welted2a7f5a2009-06-05 20:08:20 +00001410static int gsm48_rx_mm_status(struct msgb *msg)
1411{
1412 struct gsm48_hdr *gh = msgb_l3(msg);
1413
1414 DEBUGP(DMM, "MM STATUS (reject cause 0x%02x)\n", gh->data[0]);
1415
1416 return 0;
1417}
1418
Harald Weltebf5e8df2009-02-03 12:59:45 +00001419/* Receive a GSM 04.08 Mobility Management (MM) message */
Harald Welte52b1f982008-12-23 20:25:15 +00001420static int gsm0408_rcv_mm(struct msgb *msg)
1421{
1422 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001423 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001424
1425 switch (gh->msg_type & 0xbf) {
1426 case GSM48_MT_MM_LOC_UPD_REQUEST:
Harald Weltea0368542009-06-27 02:58:43 +02001427 DEBUGP(DMM, "LOCATION UPDATING REQUEST: ");
Harald Welte231ad4f2008-12-27 11:15:38 +00001428 rc = mm_rx_loc_upd_req(msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001429 break;
1430 case GSM48_MT_MM_ID_RESP:
Harald Welte231ad4f2008-12-27 11:15:38 +00001431 rc = mm_rx_id_resp(msg);
1432 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001433 case GSM48_MT_MM_CM_SERV_REQ:
Harald Welte4b634542008-12-27 01:55:51 +00001434 rc = gsm48_rx_mm_serv_req(msg);
1435 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001436 case GSM48_MT_MM_STATUS:
Harald Welted2a7f5a2009-06-05 20:08:20 +00001437 rc = gsm48_rx_mm_status(msg);
Harald Welte231ad4f2008-12-27 11:15:38 +00001438 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001439 case GSM48_MT_MM_TMSI_REALL_COMPL:
Harald Welte69b2af22009-01-06 19:47:00 +00001440 DEBUGP(DMM, "TMSI Reallocation Completed. Subscriber: %s\n",
1441 msg->lchan->subscr ?
1442 msg->lchan->subscr->imsi :
1443 "unknown subscriber");
1444 break;
Harald Welte231ad4f2008-12-27 11:15:38 +00001445 case GSM48_MT_MM_IMSI_DETACH_IND:
Harald Welte2a139372009-02-22 21:14:55 +00001446 rc = gsm48_rx_mm_imsi_detach_ind(msg);
1447 break;
1448 case GSM48_MT_MM_CM_REEST_REQ:
1449 DEBUGP(DMM, "CM REESTABLISH REQUEST: Not implemented\n");
1450 break;
1451 case GSM48_MT_MM_AUTH_RESP:
1452 DEBUGP(DMM, "AUTHENTICATION RESPONSE: Not implemented\n");
Harald Welte52b1f982008-12-23 20:25:15 +00001453 break;
1454 default:
1455 fprintf(stderr, "Unknown GSM 04.08 MM msg type 0x%02x\n",
1456 gh->msg_type);
1457 break;
1458 }
1459
1460 return rc;
1461}
Harald Weltebf5e8df2009-02-03 12:59:45 +00001462
Harald Welte2d35ae62009-02-06 12:02:13 +00001463/* Receive a PAGING RESPONSE message from the MS */
Holger Hans Peter Freytherca0fcbe2009-10-23 13:48:54 +02001464static int gsm48_rx_rr_pag_resp(struct msgb *msg)
Harald Welte2d35ae62009-02-06 12:02:13 +00001465{
Harald Welte9176bd42009-07-23 18:46:00 +02001466 struct gsm_bts *bts = msg->lchan->ts->trx->bts;
Harald Welte2d35ae62009-02-06 12:02:13 +00001467 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte61548982009-02-22 21:26:29 +00001468 u_int8_t *classmark2_lv = gh->data + 1;
Holger Hans Peter Freyther3ee5d3e2009-08-21 05:18:21 +02001469 u_int8_t mi_type;
Holger Hans Peter Freytherd1862d72009-08-19 07:54:59 +02001470 char mi_string[GSM48_MI_SIZE];
Harald Welte4bfdfe72009-06-10 23:11:52 +08001471 struct gsm_subscriber *subscr = NULL;
Harald Welte2d35ae62009-02-06 12:02:13 +00001472 int rc = 0;
1473
Holger Hans Peter Freyther3ee5d3e2009-08-21 05:18:21 +02001474 gsm48_paging_extract_mi(msg, mi_string, &mi_type);
Harald Welte2d35ae62009-02-06 12:02:13 +00001475 DEBUGP(DRR, "PAGING RESPONSE: mi_type=0x%02x MI(%s)\n",
1476 mi_type, mi_string);
Harald Welte3ac7f102009-08-10 10:12:45 +02001477
Harald Weltefe18d8f2009-02-22 21:14:24 +00001478 switch (mi_type) {
1479 case GSM_MI_TYPE_TMSI:
Holger Hans Peter Freyther22230252009-08-19 12:53:57 +02001480 subscr = subscr_get_by_tmsi(bts->network,
1481 tmsi_from_string(mi_string));
Harald Weltefe18d8f2009-02-22 21:14:24 +00001482 break;
1483 case GSM_MI_TYPE_IMSI:
Harald Welte9176bd42009-07-23 18:46:00 +02001484 subscr = subscr_get_by_imsi(bts->network, mi_string);
Harald Weltefe18d8f2009-02-22 21:14:24 +00001485 break;
1486 }
Harald Welte2d35ae62009-02-06 12:02:13 +00001487
1488 if (!subscr) {
1489 DEBUGP(DRR, "<- Can't find any subscriber for this ID\n");
Harald Welte09e38af2009-02-16 22:52:23 +00001490 /* FIXME: request id? close channel? */
Harald Welte2d35ae62009-02-06 12:02:13 +00001491 return -EINVAL;
1492 }
1493 DEBUGP(DRR, "<- Channel was requested by %s\n",
Harald Welte76042182009-08-08 16:03:15 +02001494 subscr->name && strlen(subscr->name) ? subscr->name : subscr->imsi);
Holger Freyther053e09d2009-02-14 22:51:06 +00001495
Harald Weltec2e302d2009-07-05 14:08:13 +02001496 subscr->equipment.classmark2_len = *classmark2_lv;
1497 memcpy(subscr->equipment.classmark2, classmark2_lv+1, *classmark2_lv);
1498 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001499
Holger Hans Peter Freyther3ee5d3e2009-08-21 05:18:21 +02001500 rc = gsm48_handle_paging_resp(msg, subscr);
Harald Welte2d35ae62009-02-06 12:02:13 +00001501 return rc;
1502}
1503
Harald Weltef7c43522009-06-09 20:24:21 +00001504static int gsm48_rx_rr_classmark(struct msgb *msg)
1505{
1506 struct gsm48_hdr *gh = msgb_l3(msg);
1507 struct gsm_subscriber *subscr = msg->lchan->subscr;
1508 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
1509 u_int8_t cm2_len, cm3_len = 0;
1510 u_int8_t *cm2, *cm3 = NULL;
1511
1512 DEBUGP(DRR, "CLASSMARK CHANGE ");
1513
1514 /* classmark 2 */
1515 cm2_len = gh->data[0];
1516 cm2 = &gh->data[1];
1517 DEBUGPC(DRR, "CM2(len=%u) ", cm2_len);
1518
1519 if (payload_len > cm2_len + 1) {
1520 /* we must have a classmark3 */
1521 if (gh->data[cm2_len+1] != 0x20) {
1522 DEBUGPC(DRR, "ERR CM3 TAG\n");
1523 return -EINVAL;
1524 }
1525 if (cm2_len > 3) {
1526 DEBUGPC(DRR, "CM2 too long!\n");
1527 return -EINVAL;
1528 }
1529
1530 cm3_len = gh->data[cm2_len+2];
1531 cm3 = &gh->data[cm2_len+3];
1532 if (cm3_len > 14) {
1533 DEBUGPC(DRR, "CM3 len %u too long!\n", cm3_len);
1534 return -EINVAL;
1535 }
1536 DEBUGPC(DRR, "CM3(len=%u)\n", cm3_len);
1537 }
1538 if (subscr) {
Harald Weltec2e302d2009-07-05 14:08:13 +02001539 subscr->equipment.classmark2_len = cm2_len;
1540 memcpy(subscr->equipment.classmark2, cm2, cm2_len);
Harald Weltef7c43522009-06-09 20:24:21 +00001541 if (cm3) {
Harald Weltec2e302d2009-07-05 14:08:13 +02001542 subscr->equipment.classmark3_len = cm3_len;
1543 memcpy(subscr->equipment.classmark3, cm3, cm3_len);
Harald Weltef7c43522009-06-09 20:24:21 +00001544 }
Harald Weltec2e302d2009-07-05 14:08:13 +02001545 db_sync_equipment(&subscr->equipment);
Harald Weltef7c43522009-06-09 20:24:21 +00001546 }
1547
Harald Weltef7c43522009-06-09 20:24:21 +00001548 return 0;
1549}
1550
Harald Weltecf5b3592009-05-01 18:28:42 +00001551static int gsm48_rx_rr_status(struct msgb *msg)
1552{
1553 struct gsm48_hdr *gh = msgb_l3(msg);
1554
1555 DEBUGP(DRR, "STATUS rr_cause = %s\n",
1556 rr_cause_name(gh->data[0]));
1557
1558 return 0;
1559}
1560
Harald Weltef7c43522009-06-09 20:24:21 +00001561static int gsm48_rx_rr_meas_rep(struct msgb *msg)
1562{
Harald Welted12b0fd2009-12-15 21:36:05 +01001563 struct gsm_meas_rep *meas_rep = lchan_next_meas_rep(msg->lchan);
Harald Weltef7c43522009-06-09 20:24:21 +00001564
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001565 /* This shouldn't actually end up here, as RSL treats
1566 * L3 Info of 08.58 MEASUREMENT REPORT different by calling
1567 * directly into gsm48_parse_meas_rep */
1568 DEBUGP(DMEAS, "DIRECT GSM48 MEASUREMENT REPORT ?!? ");
Harald Welted12b0fd2009-12-15 21:36:05 +01001569 gsm48_parse_meas_rep(meas_rep, msg);
Harald Weltef7c43522009-06-09 20:24:21 +00001570
1571 return 0;
1572}
1573
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001574static int gsm48_rx_rr_app_info(struct msgb *msg)
1575{
1576 struct gsm48_hdr *gh = msgb_l3(msg);
1577 u_int8_t apdu_id_flags;
1578 u_int8_t apdu_len;
1579 u_int8_t *apdu_data;
1580
1581 apdu_id_flags = gh->data[0];
1582 apdu_len = gh->data[1];
1583 apdu_data = gh->data+2;
1584
1585 DEBUGP(DNM, "RX APPLICATION INFO id/flags=0x%02x apdu_len=%u apdu=%s",
1586 apdu_id_flags, apdu_len, hexdump(apdu_data, apdu_len));
1587
Harald Welte (local)026531e2009-08-16 10:40:10 +02001588 return db_apdu_blob_store(msg->lchan->subscr, apdu_id_flags, apdu_len, apdu_data);
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001589}
1590
Harald Welted011e8b2009-11-29 22:45:52 +01001591/* Chapter 9.1.16 Handover complete */
Harald Welte1e191c52009-12-14 17:51:15 +01001592static int gsm48_rx_rr_ho_compl(struct msgb *msg)
Harald Welted011e8b2009-11-29 22:45:52 +01001593{
1594 struct gsm48_hdr *gh = msgb_l3(msg);
1595
1596 DEBUGP(DRR, "HANDOVER COMPLETE cause = %s\n",
1597 rr_cause_name(gh->data[0]));
1598
1599 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_COMPL, msg->lchan);
1600 /* FIXME: release old channel */
1601
1602 return 0;
1603}
1604
1605/* Chapter 9.1.17 Handover Failure */
Harald Welte1e191c52009-12-14 17:51:15 +01001606static int gsm48_rx_rr_ho_fail(struct msgb *msg)
Harald Welted011e8b2009-11-29 22:45:52 +01001607{
1608 struct gsm48_hdr *gh = msgb_l3(msg);
1609
1610 DEBUGP(DRR, "HANDOVER FAILED cause = %s\n",
1611 rr_cause_name(gh->data[0]));
1612
1613 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_FAIL, msg->lchan);
1614 /* FIXME: release allocated new channel */
1615
1616 return 0;
1617}
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001618
Harald Weltebf5e8df2009-02-03 12:59:45 +00001619/* Receive a GSM 04.08 Radio Resource (RR) message */
Harald Welte52b1f982008-12-23 20:25:15 +00001620static int gsm0408_rcv_rr(struct msgb *msg)
1621{
1622 struct gsm48_hdr *gh = msgb_l3(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001623 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001624
1625 switch (gh->msg_type) {
1626 case GSM48_MT_RR_CLSM_CHG:
Harald Weltef7c43522009-06-09 20:24:21 +00001627 rc = gsm48_rx_rr_classmark(msg);
Harald Welte52b1f982008-12-23 20:25:15 +00001628 break;
Harald Weltefc977a82008-12-27 10:19:37 +00001629 case GSM48_MT_RR_GPRS_SUSP_REQ:
1630 DEBUGP(DRR, "GRPS SUSPEND REQUEST\n");
1631 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001632 case GSM48_MT_RR_PAG_RESP:
Holger Hans Peter Freytherca0fcbe2009-10-23 13:48:54 +02001633 rc = gsm48_rx_rr_pag_resp(msg);
Harald Welte2d35ae62009-02-06 12:02:13 +00001634 break;
Harald Welte7ccf7782009-02-17 01:43:01 +00001635 case GSM48_MT_RR_CHAN_MODE_MODIF_ACK:
Holger Hans Peter Freytherf520e642009-10-22 15:23:11 +02001636 rc = gsm48_rx_rr_modif_ack(msg);
Harald Welte7ccf7782009-02-17 01:43:01 +00001637 break;
Harald Weltecf5b3592009-05-01 18:28:42 +00001638 case GSM48_MT_RR_STATUS:
1639 rc = gsm48_rx_rr_status(msg);
1640 break;
Harald Weltef7c43522009-06-09 20:24:21 +00001641 case GSM48_MT_RR_MEAS_REP:
1642 rc = gsm48_rx_rr_meas_rep(msg);
1643 break;
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001644 case GSM48_MT_RR_APP_INFO:
1645 rc = gsm48_rx_rr_app_info(msg);
1646 break;
Harald Welte08d91a52009-08-30 15:37:11 +09001647 case GSM48_MT_RR_CIPH_M_COMPL:
1648 DEBUGP(DRR, "CIPHERING MODE COMPLETE\n");
1649 /* FIXME: check for MI (if any) */
1650 break;
Harald Welteccd5a882009-11-29 20:02:20 +01001651 case GSM48_MT_RR_HANDO_COMPL:
Harald Welted011e8b2009-11-29 22:45:52 +01001652 rc = gsm48_rx_rr_ho_compl(msg);
Harald Welteccd5a882009-11-29 20:02:20 +01001653 break;
1654 case GSM48_MT_RR_HANDO_FAIL:
Harald Welted011e8b2009-11-29 22:45:52 +01001655 rc = gsm48_rx_rr_ho_fail(msg);
Harald Welteccd5a882009-11-29 20:02:20 +01001656 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001657 default:
Harald Welte2d35ae62009-02-06 12:02:13 +00001658 fprintf(stderr, "Unimplemented GSM 04.08 RR msg type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001659 gh->msg_type);
1660 break;
1661 }
1662
Harald Welte2d35ae62009-02-06 12:02:13 +00001663 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001664}
1665
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001666int gsm48_send_rr_app_info(struct gsm_lchan *lchan, u_int8_t apdu_id,
Holger Hans Peter Freyther8b77a342009-10-22 15:42:19 +02001667 u_int8_t apdu_len, const u_int8_t *apdu)
Harald Welte (local)6eef5642009-08-15 23:32:44 +02001668{
1669 struct msgb *msg = gsm48_msgb_alloc();
1670 struct gsm48_hdr *gh;
1671
1672 msg->lchan = lchan;
1673
1674 DEBUGP(DRR, "TX APPLICATION INFO id=0x%02x, len=%u\n",
1675 apdu_id, apdu_len);
1676
1677 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 2 + apdu_len);
1678 gh->proto_discr = GSM48_PDISC_RR;
1679 gh->msg_type = GSM48_MT_RR_APP_INFO;
1680 gh->data[0] = apdu_id;
1681 gh->data[1] = apdu_len;
1682 memcpy(gh->data+2, apdu, apdu_len);
1683
1684 return gsm48_sendmsg(msg, NULL);
1685}
1686
Harald Welte4bc90a12008-12-27 16:32:52 +00001687/* Call Control */
1688
Harald Welte7584aea2009-02-11 11:44:12 +00001689/* The entire call control code is written in accordance with Figure 7.10c
1690 * for 'very early assignment', i.e. we allocate a TCH/F during IMMEDIATE
1691 * ASSIGN, then first use that TCH/F for signalling and later MODE MODIFY
1692 * it for voice */
1693
Harald Welte4bfdfe72009-06-10 23:11:52 +08001694static void new_cc_state(struct gsm_trans *trans, int state)
1695{
1696 if (state > 31 || state < 0)
1697 return;
1698
1699 DEBUGP(DCC, "new state %s -> %s\n",
Harald Weltedcaf5652009-07-23 18:56:43 +02001700 cc_state_names[trans->cc.state], cc_state_names[state]);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001701
Harald Weltedcaf5652009-07-23 18:56:43 +02001702 trans->cc.state = state;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001703}
1704
1705static int gsm48_cc_tx_status(struct gsm_trans *trans, void *arg)
Harald Welte4bc90a12008-12-27 16:32:52 +00001706{
1707 struct msgb *msg = gsm48_msgb_alloc();
1708 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1709 u_int8_t *cause, *call_state;
1710
Harald Welte4bc90a12008-12-27 16:32:52 +00001711 gh->msg_type = GSM48_MT_CC_STATUS;
1712
1713 cause = msgb_put(msg, 3);
1714 cause[0] = 2;
1715 cause[1] = GSM48_CAUSE_CS_GSM | GSM48_CAUSE_LOC_USER;
1716 cause[2] = 0x80 | 30; /* response to status inquiry */
1717
1718 call_state = msgb_put(msg, 1);
1719 call_state[0] = 0xc0 | 0x00;
1720
Harald Welte39e2ead2009-07-23 21:13:03 +02001721 return gsm48_sendmsg(msg, trans);
Harald Welte4bc90a12008-12-27 16:32:52 +00001722}
1723
Harald Welte6f4b7532008-12-29 00:39:37 +00001724static int gsm48_tx_simple(struct gsm_lchan *lchan,
1725 u_int8_t pdisc, u_int8_t msg_type)
Harald Welte4bc90a12008-12-27 16:32:52 +00001726{
1727 struct msgb *msg = gsm48_msgb_alloc();
1728 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
1729
1730 msg->lchan = lchan;
1731
Harald Welte6f4b7532008-12-29 00:39:37 +00001732 gh->proto_discr = pdisc;
Harald Welte4bc90a12008-12-27 16:32:52 +00001733 gh->msg_type = msg_type;
1734
Harald Welte39e2ead2009-07-23 21:13:03 +02001735 return gsm48_sendmsg(msg, NULL);
Harald Welte4bc90a12008-12-27 16:32:52 +00001736}
1737
Harald Welte4bfdfe72009-06-10 23:11:52 +08001738static void gsm48_stop_cc_timer(struct gsm_trans *trans)
1739{
Harald Weltedcaf5652009-07-23 18:56:43 +02001740 if (bsc_timer_pending(&trans->cc.timer)) {
1741 DEBUGP(DCC, "stopping pending timer T%x\n", trans->cc.Tcurrent);
1742 bsc_del_timer(&trans->cc.timer);
1743 trans->cc.Tcurrent = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001744 }
1745}
1746
1747static int mncc_recvmsg(struct gsm_network *net, struct gsm_trans *trans,
1748 int msg_type, struct gsm_mncc *mncc)
1749{
1750 struct msgb *msg;
1751
1752 if (trans)
1753 if (trans->lchan)
Harald Welte6f5aee02009-07-23 21:21:14 +02001754 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08001755 "Sending '%s' to MNCC.\n",
1756 trans->lchan->ts->trx->bts->nr,
1757 trans->lchan->ts->trx->nr,
1758 trans->lchan->ts->nr, trans->transaction_id,
1759 (trans->subscr)?(trans->subscr->extension):"-",
1760 get_mncc_name(msg_type));
1761 else
1762 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
1763 "Sending '%s' to MNCC.\n",
1764 (trans->subscr)?(trans->subscr->extension):"-",
1765 get_mncc_name(msg_type));
1766 else
1767 DEBUGP(DCC, "(bts - trx - ts - ti -- sub -) "
1768 "Sending '%s' to MNCC.\n", get_mncc_name(msg_type));
1769
1770 mncc->msg_type = msg_type;
1771
Harald Welte966636f2009-06-26 19:39:35 +02001772 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
Harald Welte4bfdfe72009-06-10 23:11:52 +08001773 if (!msg)
1774 return -ENOMEM;
1775 memcpy(msg->data, mncc, sizeof(struct gsm_mncc));
1776 msgb_enqueue(&net->upqueue, msg);
1777
1778 return 0;
1779}
1780
1781int mncc_release_ind(struct gsm_network *net, struct gsm_trans *trans,
1782 u_int32_t callref, int location, int value)
1783{
1784 struct gsm_mncc rel;
1785
Harald Welte92f70c52009-06-12 01:54:08 +08001786 memset(&rel, 0, sizeof(rel));
Harald Welte4bfdfe72009-06-10 23:11:52 +08001787 rel.callref = callref;
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001788 mncc_set_cause(&rel, location, value);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001789 return mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
1790}
1791
Harald Weltedcaf5652009-07-23 18:56:43 +02001792/* Call Control Specific transaction release.
1793 * gets called by trans_free, DO NOT CALL YOURSELF! */
1794void _gsm48_cc_trans_free(struct gsm_trans *trans)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001795{
Harald Welte4bfdfe72009-06-10 23:11:52 +08001796 gsm48_stop_cc_timer(trans);
1797
1798 /* send release to L4, if callref still exists */
1799 if (trans->callref) {
1800 /* Ressource unavailable */
Harald Welte596fed42009-07-23 19:06:52 +02001801 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001802 GSM48_CAUSE_LOC_PRN_S_LU,
1803 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001804 }
Harald Weltedcaf5652009-07-23 18:56:43 +02001805 if (trans->cc.state != GSM_CSTATE_NULL)
Harald Welte4bfdfe72009-06-10 23:11:52 +08001806 new_cc_state(trans, GSM_CSTATE_NULL);
Harald Weltedcaf5652009-07-23 18:56:43 +02001807 if (trans->lchan)
1808 trau_mux_unmap(&trans->lchan->ts->e1_link, trans->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001809}
1810
1811static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg);
1812
Harald Welte09e38af2009-02-16 22:52:23 +00001813/* call-back from paging the B-end of the connection */
1814static int setup_trig_pag_evt(unsigned int hooknum, unsigned int event,
Harald Welte7ccf7782009-02-17 01:43:01 +00001815 struct msgb *msg, void *_lchan, void *param)
Harald Welte09e38af2009-02-16 22:52:23 +00001816{
Harald Welte7ccf7782009-02-17 01:43:01 +00001817 struct gsm_lchan *lchan = _lchan;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001818 struct gsm_subscriber *subscr = param;
1819 struct gsm_trans *transt, *tmp;
1820 struct gsm_network *net;
Harald Weltec05677b2009-06-26 20:17:06 +02001821
Harald Welte09e38af2009-02-16 22:52:23 +00001822 if (hooknum != GSM_HOOK_RR_PAGING)
1823 return -EINVAL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08001824
1825 if (!subscr)
1826 return -EINVAL;
1827 net = subscr->net;
1828 if (!net) {
1829 DEBUGP(DCC, "Error Network not set!\n");
1830 return -EINVAL;
Harald Welte5a065df2009-02-22 21:13:18 +00001831 }
Harald Welte7584aea2009-02-11 11:44:12 +00001832
Harald Welte4bfdfe72009-06-10 23:11:52 +08001833 /* check all tranactions (without lchan) for subscriber */
1834 llist_for_each_entry_safe(transt, tmp, &net->trans_list, entry) {
1835 if (transt->subscr != subscr || transt->lchan)
1836 continue;
1837 switch (event) {
1838 case GSM_PAGING_SUCCEEDED:
1839 if (!lchan) // paranoid
1840 break;
1841 DEBUGP(DCC, "Paging subscr %s succeeded!\n",
1842 subscr->extension);
1843 /* Assign lchan */
1844 if (!transt->lchan) {
1845 transt->lchan = lchan;
1846 use_lchan(lchan);
1847 }
1848 /* send SETUP request to called party */
Harald Weltedcaf5652009-07-23 18:56:43 +02001849 gsm48_cc_tx_setup(transt, &transt->cc.msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001850 break;
1851 case GSM_PAGING_EXPIRED:
1852 DEBUGP(DCC, "Paging subscr %s expired!\n",
1853 subscr->extension);
1854 /* Temporarily out of order */
Harald Welte596fed42009-07-23 19:06:52 +02001855 mncc_release_ind(transt->subscr->net, transt,
1856 transt->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08001857 GSM48_CAUSE_LOC_PRN_S_LU,
1858 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001859 transt->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02001860 trans_free(transt);
Harald Welte4bfdfe72009-06-10 23:11:52 +08001861 break;
1862 }
1863 }
Harald Welte09e38af2009-02-16 22:52:23 +00001864 return 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00001865}
Harald Welte7584aea2009-02-11 11:44:12 +00001866
Harald Welte805f6442009-07-28 18:25:29 +02001867/* some other part of the code sends us a signal */
1868static int handle_abisip_signal(unsigned int subsys, unsigned int signal,
1869 void *handler_data, void *signal_data)
1870{
1871 struct gsm_lchan *lchan = signal_data;
Harald Welte805f6442009-07-28 18:25:29 +02001872 int rc;
1873
1874 if (subsys != SS_ABISIP)
1875 return 0;
1876
1877 /* in case we use direct BTS-to-BTS RTP */
1878 if (ipacc_rtp_direct)
1879 return 0;
1880
Harald Welte805f6442009-07-28 18:25:29 +02001881 switch (signal) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001882 case S_ABISIP_CRCX_ACK:
Harald Welte805f6442009-07-28 18:25:29 +02001883 /* the BTS has successfully bound a TCH to a local ip/port,
1884 * which means we can connect our UDP socket to it */
Harald Welte2c828992009-12-02 01:56:49 +05301885 if (lchan->abis_ip.rtp_socket) {
1886 rtp_socket_free(lchan->abis_ip.rtp_socket);
1887 lchan->abis_ip.rtp_socket = NULL;
Harald Welte805f6442009-07-28 18:25:29 +02001888 }
1889
Harald Welte2c828992009-12-02 01:56:49 +05301890 lchan->abis_ip.rtp_socket = rtp_socket_create();
1891 if (!lchan->abis_ip.rtp_socket)
Harald Welte805f6442009-07-28 18:25:29 +02001892 goto out_err;
1893
Harald Welte2c828992009-12-02 01:56:49 +05301894 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1895 lchan->abis_ip.bound_ip,
1896 lchan->abis_ip.bound_port);
Harald Welte805f6442009-07-28 18:25:29 +02001897 if (rc < 0)
1898 goto out_err;
1899 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001900 case S_ABISIP_DLCX_IND:
Harald Welte805f6442009-07-28 18:25:29 +02001901 /* the BTS tells us a RTP stream has been disconnected */
Harald Welte2c828992009-12-02 01:56:49 +05301902 if (lchan->abis_ip.rtp_socket) {
1903 rtp_socket_free(lchan->abis_ip.rtp_socket);
1904 lchan->abis_ip.rtp_socket = NULL;
Harald Welte805f6442009-07-28 18:25:29 +02001905 }
1906 break;
1907 }
1908
1909 return 0;
1910out_err:
1911 /* FIXME: do something */
1912 return 0;
1913}
1914
1915/* bind rtp proxy to local IP/port and tell BTS to connect to it */
1916static int ipacc_connect_proxy_bind(struct gsm_lchan *lchan)
1917{
Harald Welte2c828992009-12-02 01:56:49 +05301918 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
Harald Welte805f6442009-07-28 18:25:29 +02001919 int rc;
1920
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001921 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
Harald Welte805f6442009-07-28 18:25:29 +02001922 ntohs(rs->rtp.sin_local.sin_port),
Harald Welte805f6442009-07-28 18:25:29 +02001923 /* FIXME: use RTP payload of bound socket, not BTS*/
Harald Welte2c828992009-12-02 01:56:49 +05301924 lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001925
1926 return rc;
1927}
1928
Harald Welte49f48b82009-02-17 15:29:33 +00001929/* map two ipaccess RTP streams onto each other */
Harald Welte11fa29c2009-02-19 17:24:39 +00001930static int tch_map(struct gsm_lchan *lchan, struct gsm_lchan *remote_lchan)
Harald Welte49f48b82009-02-17 15:29:33 +00001931{
Harald Welte11fa29c2009-02-19 17:24:39 +00001932 struct gsm_bts *bts = lchan->ts->trx->bts;
1933 struct gsm_bts *remote_bts = remote_lchan->ts->trx->bts;
Harald Welte805f6442009-07-28 18:25:29 +02001934 int rc;
Harald Welte49f48b82009-02-17 15:29:33 +00001935
Harald Welte11fa29c2009-02-19 17:24:39 +00001936 DEBUGP(DCC, "Setting up TCH map between (bts=%u,trx=%u,ts=%u) and (bts=%u,trx=%u,ts=%u)\n",
1937 bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
1938 remote_bts->nr, remote_lchan->ts->trx->nr, remote_lchan->ts->nr);
1939
1940 if (bts->type != remote_bts->type) {
1941 DEBUGP(DCC, "Cannot switch calls between different BTS types yet\n");
1942 return -EINVAL;
1943 }
Harald Welte49f48b82009-02-17 15:29:33 +00001944
Harald Welte11fa29c2009-02-19 17:24:39 +00001945 switch (bts->type) {
Mike Habene2d82272009-10-02 12:19:34 +01001946 case GSM_BTS_TYPE_NANOBTS:
Harald Welte805f6442009-07-28 18:25:29 +02001947 if (!ipacc_rtp_direct) {
1948 /* connect the TCH's to our RTP proxy */
1949 rc = ipacc_connect_proxy_bind(lchan);
1950 if (rc < 0)
1951 return rc;
1952 rc = ipacc_connect_proxy_bind(remote_lchan);
1953
1954 /* connect them with each other */
Harald Welte2c828992009-12-02 01:56:49 +05301955 rtp_socket_proxy(lchan->abis_ip.rtp_socket,
1956 remote_lchan->abis_ip.rtp_socket);
Harald Welte805f6442009-07-28 18:25:29 +02001957 } else {
1958 /* directly connect TCH RTP streams to each other */
Harald Welte2c828992009-12-02 01:56:49 +05301959 rc = rsl_ipacc_mdcx(lchan, remote_lchan->abis_ip.bound_ip,
1960 remote_lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301961 remote_lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001962 if (rc < 0)
1963 return rc;
Harald Welte2c828992009-12-02 01:56:49 +05301964 rc = rsl_ipacc_mdcx(remote_lchan, lchan->abis_ip.bound_ip,
1965 lchan->abis_ip.bound_port,
Harald Welte2c828992009-12-02 01:56:49 +05301966 lchan->abis_ip.rtp_payload2);
Harald Welte805f6442009-07-28 18:25:29 +02001967 }
Harald Welte11fa29c2009-02-19 17:24:39 +00001968 break;
1969 case GSM_BTS_TYPE_BS11:
1970 trau_mux_map_lchan(lchan, remote_lchan);
1971 break;
1972 default:
1973 DEBUGP(DCC, "Unknown BTS type %u\n", bts->type);
Harald Welte805f6442009-07-28 18:25:29 +02001974 rc = -EINVAL;
Harald Welte11fa29c2009-02-19 17:24:39 +00001975 break;
1976 }
Harald Welte49f48b82009-02-17 15:29:33 +00001977
1978 return 0;
1979}
1980
Harald Welte4bfdfe72009-06-10 23:11:52 +08001981/* bridge channels of two transactions */
1982static int tch_bridge(struct gsm_network *net, u_int32_t *refs)
Harald Welte7ccf7782009-02-17 01:43:01 +00001983{
Harald Weltedcaf5652009-07-23 18:56:43 +02001984 struct gsm_trans *trans1 = trans_find_by_callref(net, refs[0]);
1985 struct gsm_trans *trans2 = trans_find_by_callref(net, refs[1]);
Harald Welte7ccf7782009-02-17 01:43:01 +00001986
Harald Welte4bfdfe72009-06-10 23:11:52 +08001987 if (!trans1 || !trans2)
Harald Welte7ccf7782009-02-17 01:43:01 +00001988 return -EIO;
1989
Harald Welte4bfdfe72009-06-10 23:11:52 +08001990 if (!trans1->lchan || !trans2->lchan)
1991 return -EIO;
1992
1993 /* through-connect channel */
1994 return tch_map(trans1->lchan, trans2->lchan);
Harald Welte7ccf7782009-02-17 01:43:01 +00001995}
1996
Harald Welte4bfdfe72009-06-10 23:11:52 +08001997/* enable receive of channels to upqueue */
1998static int tch_recv(struct gsm_network *net, struct gsm_mncc *data, int enable)
1999{
2000 struct gsm_trans *trans;
Harald Welte7ccf7782009-02-17 01:43:01 +00002001
Harald Welte4bfdfe72009-06-10 23:11:52 +08002002 /* Find callref */
Harald Weltedcaf5652009-07-23 18:56:43 +02002003 trans = trans_find_by_callref(net, data->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002004 if (!trans)
2005 return -EIO;
2006 if (!trans->lchan)
2007 return 0;
2008
2009 // todo IPACCESS
2010 if (enable)
2011 return trau_recv_lchan(trans->lchan, data->callref);
2012 return trau_mux_unmap(NULL, data->callref);
2013}
2014
2015/* send a frame to channel */
2016static int tch_frame(struct gsm_network *net, struct gsm_trau_frame *frame)
2017{
2018 struct gsm_trans *trans;
2019
2020 /* Find callref */
Harald Weltedcaf5652009-07-23 18:56:43 +02002021 trans = trans_find_by_callref(net, frame->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002022 if (!trans)
2023 return -EIO;
2024 if (!trans->lchan)
2025 return 0;
2026 if (trans->lchan->type != GSM_LCHAN_TCH_F &&
2027 trans->lchan->type != GSM_LCHAN_TCH_H)
2028 return 0;
2029
2030 // todo IPACCESS
2031 return trau_send_lchan(trans->lchan,
2032 (struct decoded_trau_frame *)frame->data);
2033}
2034
2035
2036static int gsm48_cc_rx_status_enq(struct gsm_trans *trans, struct msgb *msg)
2037{
2038 DEBUGP(DCC, "-> STATUS ENQ\n");
2039 return gsm48_cc_tx_status(trans, msg);
2040}
2041
2042static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg);
2043static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg);
2044
2045static void gsm48_cc_timeout(void *arg)
2046{
2047 struct gsm_trans *trans = arg;
2048 int disconnect = 0, release = 0;
Harald Weltec66b71c2009-06-11 14:23:20 +08002049 int mo_cause = GSM48_CC_CAUSE_RECOVERY_TIMER;
2050 int mo_location = GSM48_CAUSE_LOC_USER;
2051 int l4_cause = GSM48_CC_CAUSE_NORMAL_UNSPEC;
2052 int l4_location = GSM48_CAUSE_LOC_PRN_S_LU;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002053 struct gsm_mncc mo_rel, l4_rel;
2054
2055 memset(&mo_rel, 0, sizeof(struct gsm_mncc));
2056 mo_rel.callref = trans->callref;
2057 memset(&l4_rel, 0, sizeof(struct gsm_mncc));
2058 l4_rel.callref = trans->callref;
2059
Harald Weltedcaf5652009-07-23 18:56:43 +02002060 switch(trans->cc.Tcurrent) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002061 case 0x303:
2062 release = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08002063 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002064 break;
2065 case 0x310:
2066 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08002067 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002068 break;
2069 case 0x313:
2070 disconnect = 1;
2071 /* unknown, did not find it in the specs */
2072 break;
2073 case 0x301:
2074 disconnect = 1;
Harald Weltec66b71c2009-06-11 14:23:20 +08002075 l4_cause = GSM48_CC_CAUSE_USER_NOTRESPOND;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002076 break;
2077 case 0x308:
Harald Weltedcaf5652009-07-23 18:56:43 +02002078 if (!trans->cc.T308_second) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002079 /* restart T308 a second time */
Harald Weltedcaf5652009-07-23 18:56:43 +02002080 gsm48_cc_tx_release(trans, &trans->cc.msg);
2081 trans->cc.T308_second = 1;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002082 break; /* stay in release state */
2083 }
Harald Weltedcaf5652009-07-23 18:56:43 +02002084 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002085 return;
2086// release = 1;
2087// l4_cause = 14;
2088// break;
2089 case 0x306:
2090 release = 1;
Harald Weltedcaf5652009-07-23 18:56:43 +02002091 mo_cause = trans->cc.msg.cause.value;
2092 mo_location = trans->cc.msg.cause.location;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002093 break;
2094 case 0x323:
2095 disconnect = 1;
2096 break;
2097 default:
2098 release = 1;
2099 }
2100
2101 if (release && trans->callref) {
2102 /* process release towards layer 4 */
Harald Welte596fed42009-07-23 19:06:52 +02002103 mncc_release_ind(trans->subscr->net, trans, trans->callref,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002104 l4_location, l4_cause);
2105 trans->callref = 0;
2106 }
2107
2108 if (disconnect && trans->callref) {
2109 /* process disconnect towards layer 4 */
2110 mncc_set_cause(&l4_rel, l4_location, l4_cause);
Harald Welte596fed42009-07-23 19:06:52 +02002111 mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &l4_rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002112 }
2113
2114 /* process disconnect towards mobile station */
2115 if (disconnect || release) {
2116 mncc_set_cause(&mo_rel, mo_location, mo_cause);
Harald Weltedcaf5652009-07-23 18:56:43 +02002117 mo_rel.cause.diag[0] = ((trans->cc.Tcurrent & 0xf00) >> 8) + '0';
2118 mo_rel.cause.diag[1] = ((trans->cc.Tcurrent & 0x0f0) >> 4) + '0';
2119 mo_rel.cause.diag[2] = (trans->cc.Tcurrent & 0x00f) + '0';
Harald Welte4bfdfe72009-06-10 23:11:52 +08002120 mo_rel.cause.diag_len = 3;
2121
2122 if (disconnect)
2123 gsm48_cc_tx_disconnect(trans, &mo_rel);
2124 if (release)
2125 gsm48_cc_tx_release(trans, &mo_rel);
2126 }
2127
2128}
2129
2130static void gsm48_start_cc_timer(struct gsm_trans *trans, int current,
2131 int sec, int micro)
2132{
2133 DEBUGP(DCC, "starting timer T%x with %d seconds\n", current, sec);
Harald Weltedcaf5652009-07-23 18:56:43 +02002134 trans->cc.timer.cb = gsm48_cc_timeout;
2135 trans->cc.timer.data = trans;
2136 bsc_schedule_timer(&trans->cc.timer, sec, micro);
2137 trans->cc.Tcurrent = current;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002138}
2139
2140static int gsm48_cc_rx_setup(struct gsm_trans *trans, struct msgb *msg)
2141{
2142 struct gsm48_hdr *gh = msgb_l3(msg);
2143 u_int8_t msg_type = gh->msg_type & 0xbf;
2144 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2145 struct tlv_parsed tp;
2146 struct gsm_mncc setup;
2147
2148 memset(&setup, 0, sizeof(struct gsm_mncc));
2149 setup.callref = trans->callref;
2150 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2151 /* emergency setup is identified by msg_type */
2152 if (msg_type == GSM48_MT_CC_EMERG_SETUP)
2153 setup.emergency = 1;
2154
2155 /* use subscriber as calling party number */
2156 if (trans->subscr) {
2157 setup.fields |= MNCC_F_CALLING;
2158 strncpy(setup.calling.number, trans->subscr->extension,
2159 sizeof(setup.calling.number)-1);
Andreas Eversbergc079be42009-06-15 23:22:09 +02002160 strncpy(setup.imsi, trans->subscr->imsi,
2161 sizeof(setup.imsi)-1);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002162 }
2163 /* bearer capability */
2164 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2165 setup.fields |= MNCC_F_BEARER_CAP;
2166 decode_bearer_cap(&setup.bearer_cap,
2167 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2168 }
2169 /* facility */
2170 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2171 setup.fields |= MNCC_F_FACILITY;
2172 decode_facility(&setup.facility,
2173 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2174 }
2175 /* called party bcd number */
2176 if (TLVP_PRESENT(&tp, GSM48_IE_CALLED_BCD)) {
2177 setup.fields |= MNCC_F_CALLED;
2178 decode_called(&setup.called,
2179 TLVP_VAL(&tp, GSM48_IE_CALLED_BCD)-1);
2180 }
2181 /* user-user */
2182 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2183 setup.fields |= MNCC_F_USERUSER;
2184 decode_useruser(&setup.useruser,
2185 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2186 }
2187 /* ss-version */
2188 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2189 setup.fields |= MNCC_F_SSVERSION;
2190 decode_ssversion(&setup.ssversion,
2191 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2192 }
2193 /* CLIR suppression */
2194 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_SUPP))
2195 setup.clir.sup = 1;
2196 /* CLIR invocation */
2197 if (TLVP_PRESENT(&tp, GSM48_IE_CLIR_INVOC))
2198 setup.clir.inv = 1;
2199 /* cc cap */
2200 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
2201 setup.fields |= MNCC_F_CCCAP;
2202 decode_cccap(&setup.cccap,
2203 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
2204 }
2205
Harald Welte4bfdfe72009-06-10 23:11:52 +08002206 new_cc_state(trans, GSM_CSTATE_INITIATED);
2207
2208 /* indicate setup to MNCC */
Harald Welte596fed42009-07-23 19:06:52 +02002209 mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_IND, &setup);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002210
Harald Welte13cac662009-07-29 12:10:35 +02002211 /* MNCC code will modify the channel asynchronously, we should
2212 * ipaccess-bind only after the modification has been made to the
2213 * lchan->tch_mode */
Harald Welte4bfdfe72009-06-10 23:11:52 +08002214 return 0;
2215}
2216
2217static int gsm48_cc_tx_setup(struct gsm_trans *trans, void *arg)
Harald Welte65e74cc2008-12-29 01:55:35 +00002218{
2219 struct msgb *msg = gsm48_msgb_alloc();
2220 struct gsm48_hdr *gh;
Harald Welte4bfdfe72009-06-10 23:11:52 +08002221 struct gsm_mncc *setup = arg;
Harald Welte78283ef2009-07-23 21:36:44 +02002222 int rc, trans_id;
Harald Welte65e74cc2008-12-29 01:55:35 +00002223
Harald Welte7ccf7782009-02-17 01:43:01 +00002224 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Harald Welte65e74cc2008-12-29 01:55:35 +00002225
Harald Welte4bfdfe72009-06-10 23:11:52 +08002226 /* transaction id must not be assigned */
2227 if (trans->transaction_id != 0xff) { /* unasssigned */
2228 DEBUGP(DCC, "TX Setup with assigned transaction. "
2229 "This is not allowed!\n");
2230 /* Temporarily out of order */
Harald Welte596fed42009-07-23 19:06:52 +02002231 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002232 GSM48_CAUSE_LOC_PRN_S_LU,
2233 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002234 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002235 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002236 return rc;
2237 }
2238
2239 /* Get free transaction_id */
Harald Welte78283ef2009-07-23 21:36:44 +02002240 trans_id = trans_assign_trans_id(trans->subscr, GSM48_PDISC_CC, 0);
2241 if (trans_id < 0) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002242 /* no free transaction ID */
Harald Welte596fed42009-07-23 19:06:52 +02002243 rc = mncc_release_ind(trans->subscr->net, trans, trans->callref,
Andreas Eversberg7563ac92009-06-14 22:14:12 +08002244 GSM48_CAUSE_LOC_PRN_S_LU,
2245 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002246 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002247 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002248 return rc;
2249 }
Harald Welte78283ef2009-07-23 21:36:44 +02002250 trans->transaction_id = trans_id;
Harald Welte49f48b82009-02-17 15:29:33 +00002251
Harald Welte65e74cc2008-12-29 01:55:35 +00002252 gh->msg_type = GSM48_MT_CC_SETUP;
Harald Welte09e38af2009-02-16 22:52:23 +00002253
Harald Welte4bfdfe72009-06-10 23:11:52 +08002254 gsm48_start_cc_timer(trans, 0x303, GSM48_T303);
Harald Welte65e74cc2008-12-29 01:55:35 +00002255
Harald Welte4bfdfe72009-06-10 23:11:52 +08002256 /* bearer capability */
2257 if (setup->fields & MNCC_F_BEARER_CAP)
2258 encode_bearer_cap(msg, 0, &setup->bearer_cap);
2259 /* facility */
2260 if (setup->fields & MNCC_F_FACILITY)
2261 encode_facility(msg, 0, &setup->facility);
2262 /* progress */
2263 if (setup->fields & MNCC_F_PROGRESS)
2264 encode_progress(msg, 0, &setup->progress);
2265 /* calling party BCD number */
2266 if (setup->fields & MNCC_F_CALLING)
2267 encode_calling(msg, &setup->calling);
2268 /* called party BCD number */
2269 if (setup->fields & MNCC_F_CALLED)
2270 encode_called(msg, &setup->called);
2271 /* user-user */
2272 if (setup->fields & MNCC_F_USERUSER)
2273 encode_useruser(msg, 0, &setup->useruser);
2274 /* redirecting party BCD number */
2275 if (setup->fields & MNCC_F_REDIRECTING)
2276 encode_redirecting(msg, &setup->redirecting);
2277 /* signal */
2278 if (setup->fields & MNCC_F_SIGNAL)
2279 encode_signal(msg, setup->signal);
2280
2281 new_cc_state(trans, GSM_CSTATE_CALL_PRESENT);
Harald Welte65e74cc2008-12-29 01:55:35 +00002282
Harald Welte39e2ead2009-07-23 21:13:03 +02002283 return gsm48_sendmsg(msg, trans);
Harald Welte65e74cc2008-12-29 01:55:35 +00002284}
2285
Harald Welte4bfdfe72009-06-10 23:11:52 +08002286static int gsm48_cc_rx_call_conf(struct gsm_trans *trans, struct msgb *msg)
2287{
2288 struct gsm48_hdr *gh = msgb_l3(msg);
2289 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2290 struct tlv_parsed tp;
2291 struct gsm_mncc call_conf;
2292
2293 gsm48_stop_cc_timer(trans);
2294 gsm48_start_cc_timer(trans, 0x310, GSM48_T310);
2295
2296 memset(&call_conf, 0, sizeof(struct gsm_mncc));
2297 call_conf.callref = trans->callref;
2298 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2299#if 0
2300 /* repeat */
2301 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_CIR))
2302 call_conf.repeat = 1;
2303 if (TLVP_PRESENT(&tp, GSM48_IE_REPEAT_SEQ))
2304 call_conf.repeat = 2;
2305#endif
2306 /* bearer capability */
2307 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2308 call_conf.fields |= MNCC_F_BEARER_CAP;
2309 decode_bearer_cap(&call_conf.bearer_cap,
2310 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2311 }
2312 /* cause */
2313 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2314 call_conf.fields |= MNCC_F_CAUSE;
2315 decode_cause(&call_conf.cause,
2316 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2317 }
2318 /* cc cap */
2319 if (TLVP_PRESENT(&tp, GSM48_IE_CC_CAP)) {
2320 call_conf.fields |= MNCC_F_CCCAP;
2321 decode_cccap(&call_conf.cccap,
2322 TLVP_VAL(&tp, GSM48_IE_CC_CAP)-1);
2323 }
2324
2325 new_cc_state(trans, GSM_CSTATE_MO_TERM_CALL_CONF);
2326
Harald Welte596fed42009-07-23 19:06:52 +02002327 return mncc_recvmsg(trans->subscr->net, trans, MNCC_CALL_CONF_IND,
2328 &call_conf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002329}
2330
2331static int gsm48_cc_tx_call_proc(struct gsm_trans *trans, void *arg)
2332{
2333 struct gsm_mncc *proceeding = arg;
2334 struct msgb *msg = gsm48_msgb_alloc();
2335 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2336
Harald Welte4bfdfe72009-06-10 23:11:52 +08002337 gh->msg_type = GSM48_MT_CC_CALL_PROC;
2338
2339 new_cc_state(trans, GSM_CSTATE_MO_CALL_PROC);
2340
2341 /* bearer capability */
2342 if (proceeding->fields & MNCC_F_BEARER_CAP)
2343 encode_bearer_cap(msg, 0, &proceeding->bearer_cap);
2344 /* facility */
2345 if (proceeding->fields & MNCC_F_FACILITY)
2346 encode_facility(msg, 0, &proceeding->facility);
2347 /* progress */
2348 if (proceeding->fields & MNCC_F_PROGRESS)
2349 encode_progress(msg, 0, &proceeding->progress);
2350
Harald Welte39e2ead2009-07-23 21:13:03 +02002351 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002352}
2353
2354static int gsm48_cc_rx_alerting(struct gsm_trans *trans, struct msgb *msg)
2355{
2356 struct gsm48_hdr *gh = msgb_l3(msg);
2357 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2358 struct tlv_parsed tp;
2359 struct gsm_mncc alerting;
2360
2361 gsm48_stop_cc_timer(trans);
2362 gsm48_start_cc_timer(trans, 0x301, GSM48_T301);
2363
2364 memset(&alerting, 0, sizeof(struct gsm_mncc));
2365 alerting.callref = trans->callref;
2366 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2367 /* facility */
2368 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2369 alerting.fields |= MNCC_F_FACILITY;
2370 decode_facility(&alerting.facility,
2371 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2372 }
2373
2374 /* progress */
2375 if (TLVP_PRESENT(&tp, GSM48_IE_PROGR_IND)) {
2376 alerting.fields |= MNCC_F_PROGRESS;
2377 decode_progress(&alerting.progress,
2378 TLVP_VAL(&tp, GSM48_IE_PROGR_IND)-1);
2379 }
2380 /* ss-version */
2381 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2382 alerting.fields |= MNCC_F_SSVERSION;
2383 decode_ssversion(&alerting.ssversion,
2384 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2385 }
2386
2387 new_cc_state(trans, GSM_CSTATE_CALL_RECEIVED);
2388
Harald Welte596fed42009-07-23 19:06:52 +02002389 return mncc_recvmsg(trans->subscr->net, trans, MNCC_ALERT_IND,
2390 &alerting);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002391}
2392
2393static int gsm48_cc_tx_alerting(struct gsm_trans *trans, void *arg)
2394{
2395 struct gsm_mncc *alerting = arg;
2396 struct msgb *msg = gsm48_msgb_alloc();
2397 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2398
Harald Welte4bfdfe72009-06-10 23:11:52 +08002399 gh->msg_type = GSM48_MT_CC_ALERTING;
2400
2401 /* facility */
2402 if (alerting->fields & MNCC_F_FACILITY)
2403 encode_facility(msg, 0, &alerting->facility);
2404 /* progress */
2405 if (alerting->fields & MNCC_F_PROGRESS)
2406 encode_progress(msg, 0, &alerting->progress);
2407 /* user-user */
2408 if (alerting->fields & MNCC_F_USERUSER)
2409 encode_useruser(msg, 0, &alerting->useruser);
2410
2411 new_cc_state(trans, GSM_CSTATE_CALL_DELIVERED);
2412
Harald Welte39e2ead2009-07-23 21:13:03 +02002413 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002414}
2415
2416static int gsm48_cc_tx_progress(struct gsm_trans *trans, void *arg)
2417{
2418 struct gsm_mncc *progress = arg;
2419 struct msgb *msg = gsm48_msgb_alloc();
2420 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2421
Harald Welte4bfdfe72009-06-10 23:11:52 +08002422 gh->msg_type = GSM48_MT_CC_PROGRESS;
2423
2424 /* progress */
2425 encode_progress(msg, 1, &progress->progress);
2426 /* user-user */
2427 if (progress->fields & MNCC_F_USERUSER)
2428 encode_useruser(msg, 0, &progress->useruser);
2429
Harald Welte39e2ead2009-07-23 21:13:03 +02002430 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002431}
2432
2433static int gsm48_cc_tx_connect(struct gsm_trans *trans, void *arg)
2434{
2435 struct gsm_mncc *connect = arg;
2436 struct msgb *msg = gsm48_msgb_alloc();
2437 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2438
Harald Welte4bfdfe72009-06-10 23:11:52 +08002439 gh->msg_type = GSM48_MT_CC_CONNECT;
2440
2441 gsm48_stop_cc_timer(trans);
2442 gsm48_start_cc_timer(trans, 0x313, GSM48_T313);
2443
2444 /* facility */
2445 if (connect->fields & MNCC_F_FACILITY)
2446 encode_facility(msg, 0, &connect->facility);
2447 /* progress */
2448 if (connect->fields & MNCC_F_PROGRESS)
2449 encode_progress(msg, 0, &connect->progress);
2450 /* connected number */
2451 if (connect->fields & MNCC_F_CONNECTED)
2452 encode_connected(msg, &connect->connected);
2453 /* user-user */
2454 if (connect->fields & MNCC_F_USERUSER)
2455 encode_useruser(msg, 0, &connect->useruser);
2456
2457 new_cc_state(trans, GSM_CSTATE_CONNECT_IND);
2458
Harald Welte39e2ead2009-07-23 21:13:03 +02002459 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002460}
2461
2462static int gsm48_cc_rx_connect(struct gsm_trans *trans, struct msgb *msg)
2463{
2464 struct gsm48_hdr *gh = msgb_l3(msg);
2465 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2466 struct tlv_parsed tp;
2467 struct gsm_mncc connect;
2468
2469 gsm48_stop_cc_timer(trans);
2470
2471 memset(&connect, 0, sizeof(struct gsm_mncc));
2472 connect.callref = trans->callref;
2473 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2474 /* use subscriber as connected party number */
2475 if (trans->subscr) {
2476 connect.fields |= MNCC_F_CONNECTED;
2477 strncpy(connect.connected.number, trans->subscr->extension,
2478 sizeof(connect.connected.number)-1);
Andreas Eversbergc079be42009-06-15 23:22:09 +02002479 strncpy(connect.imsi, trans->subscr->imsi,
2480 sizeof(connect.imsi)-1);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002481 }
2482 /* facility */
2483 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2484 connect.fields |= MNCC_F_FACILITY;
2485 decode_facility(&connect.facility,
2486 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2487 }
2488 /* user-user */
2489 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2490 connect.fields |= MNCC_F_USERUSER;
2491 decode_useruser(&connect.useruser,
2492 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2493 }
2494 /* ss-version */
2495 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2496 connect.fields |= MNCC_F_SSVERSION;
2497 decode_ssversion(&connect.ssversion,
2498 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2499 }
2500
2501 new_cc_state(trans, GSM_CSTATE_CONNECT_REQUEST);
2502
Harald Welte596fed42009-07-23 19:06:52 +02002503 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_CNF, &connect);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002504}
2505
2506
2507static int gsm48_cc_rx_connect_ack(struct gsm_trans *trans, struct msgb *msg)
2508{
2509 struct gsm_mncc connect_ack;
2510
2511 gsm48_stop_cc_timer(trans);
2512
2513 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2514
2515 memset(&connect_ack, 0, sizeof(struct gsm_mncc));
2516 connect_ack.callref = trans->callref;
Harald Welte596fed42009-07-23 19:06:52 +02002517 return mncc_recvmsg(trans->subscr->net, trans, MNCC_SETUP_COMPL_IND,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002518 &connect_ack);
2519}
2520
2521static int gsm48_cc_tx_connect_ack(struct gsm_trans *trans, void *arg)
2522{
2523 struct msgb *msg = gsm48_msgb_alloc();
2524 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2525
Harald Welte4bfdfe72009-06-10 23:11:52 +08002526 gh->msg_type = GSM48_MT_CC_CONNECT_ACK;
2527
2528 new_cc_state(trans, GSM_CSTATE_ACTIVE);
2529
Harald Welte39e2ead2009-07-23 21:13:03 +02002530 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002531}
2532
2533static int gsm48_cc_rx_disconnect(struct gsm_trans *trans, struct msgb *msg)
2534{
2535 struct gsm48_hdr *gh = msgb_l3(msg);
2536 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2537 struct tlv_parsed tp;
2538 struct gsm_mncc disc;
2539
2540 gsm48_stop_cc_timer(trans);
2541
2542 new_cc_state(trans, GSM_CSTATE_DISCONNECT_REQ);
2543
2544 memset(&disc, 0, sizeof(struct gsm_mncc));
2545 disc.callref = trans->callref;
2546 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_CAUSE, 0);
2547 /* cause */
2548 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2549 disc.fields |= MNCC_F_CAUSE;
2550 decode_cause(&disc.cause,
2551 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2552 }
2553 /* facility */
2554 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2555 disc.fields |= MNCC_F_FACILITY;
2556 decode_facility(&disc.facility,
2557 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2558 }
2559 /* user-user */
2560 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2561 disc.fields |= MNCC_F_USERUSER;
2562 decode_useruser(&disc.useruser,
2563 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2564 }
2565 /* ss-version */
2566 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2567 disc.fields |= MNCC_F_SSVERSION;
2568 decode_ssversion(&disc.ssversion,
2569 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2570 }
2571
Harald Welte596fed42009-07-23 19:06:52 +02002572 return mncc_recvmsg(trans->subscr->net, trans, MNCC_DISC_IND, &disc);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002573
2574}
2575
Harald Weltec66b71c2009-06-11 14:23:20 +08002576static struct gsm_mncc_cause default_cause = {
2577 .location = GSM48_CAUSE_LOC_PRN_S_LU,
2578 .coding = 0,
2579 .rec = 0,
2580 .rec_val = 0,
2581 .value = GSM48_CC_CAUSE_NORMAL_UNSPEC,
2582 .diag_len = 0,
2583 .diag = { 0 },
2584};
Harald Welte4bfdfe72009-06-10 23:11:52 +08002585
2586static int gsm48_cc_tx_disconnect(struct gsm_trans *trans, void *arg)
2587{
2588 struct gsm_mncc *disc = arg;
2589 struct msgb *msg = gsm48_msgb_alloc();
2590 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2591
Harald Welte4bfdfe72009-06-10 23:11:52 +08002592 gh->msg_type = GSM48_MT_CC_DISCONNECT;
2593
2594 gsm48_stop_cc_timer(trans);
2595 gsm48_start_cc_timer(trans, 0x306, GSM48_T306);
2596
2597 /* cause */
2598 if (disc->fields & MNCC_F_CAUSE)
2599 encode_cause(msg, 1, &disc->cause);
2600 else
2601 encode_cause(msg, 1, &default_cause);
2602
2603 /* facility */
2604 if (disc->fields & MNCC_F_FACILITY)
2605 encode_facility(msg, 0, &disc->facility);
2606 /* progress */
2607 if (disc->fields & MNCC_F_PROGRESS)
2608 encode_progress(msg, 0, &disc->progress);
2609 /* user-user */
2610 if (disc->fields & MNCC_F_USERUSER)
2611 encode_useruser(msg, 0, &disc->useruser);
2612
2613 /* store disconnect cause for T306 expiry */
Harald Weltedcaf5652009-07-23 18:56:43 +02002614 memcpy(&trans->cc.msg, disc, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002615
2616 new_cc_state(trans, GSM_CSTATE_DISCONNECT_IND);
2617
Harald Welte39e2ead2009-07-23 21:13:03 +02002618 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002619}
2620
2621static int gsm48_cc_rx_release(struct gsm_trans *trans, struct msgb *msg)
2622{
2623 struct gsm48_hdr *gh = msgb_l3(msg);
2624 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2625 struct tlv_parsed tp;
2626 struct gsm_mncc rel;
2627 int rc;
2628
2629 gsm48_stop_cc_timer(trans);
2630
2631 memset(&rel, 0, sizeof(struct gsm_mncc));
2632 rel.callref = trans->callref;
2633 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2634 /* cause */
2635 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2636 rel.fields |= MNCC_F_CAUSE;
2637 decode_cause(&rel.cause,
2638 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2639 }
2640 /* facility */
2641 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2642 rel.fields |= MNCC_F_FACILITY;
2643 decode_facility(&rel.facility,
2644 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2645 }
2646 /* user-user */
2647 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2648 rel.fields |= MNCC_F_USERUSER;
2649 decode_useruser(&rel.useruser,
2650 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2651 }
2652 /* ss-version */
2653 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2654 rel.fields |= MNCC_F_SSVERSION;
2655 decode_ssversion(&rel.ssversion,
2656 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2657 }
2658
Harald Weltedcaf5652009-07-23 18:56:43 +02002659 if (trans->cc.state == GSM_CSTATE_RELEASE_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002660 /* release collision 5.4.5 */
Harald Welte596fed42009-07-23 19:06:52 +02002661 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_CNF, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002662 } else {
Harald Welte596fed42009-07-23 19:06:52 +02002663 rc = gsm48_tx_simple(msg->lchan,
Harald Welte6f5aee02009-07-23 21:21:14 +02002664 GSM48_PDISC_CC | (trans->transaction_id << 4),
Harald Welte596fed42009-07-23 19:06:52 +02002665 GSM48_MT_CC_RELEASE_COMPL);
2666 rc = mncc_recvmsg(trans->subscr->net, trans, MNCC_REL_IND, &rel);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002667 }
2668
2669 new_cc_state(trans, GSM_CSTATE_NULL);
2670
2671 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002672 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002673
2674 return rc;
2675}
2676
2677static int gsm48_cc_tx_release(struct gsm_trans *trans, void *arg)
2678{
2679 struct gsm_mncc *rel = arg;
2680 struct msgb *msg = gsm48_msgb_alloc();
2681 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2682
Harald Welte4bfdfe72009-06-10 23:11:52 +08002683 gh->msg_type = GSM48_MT_CC_RELEASE;
2684
2685 trans->callref = 0;
2686
2687 gsm48_stop_cc_timer(trans);
2688 gsm48_start_cc_timer(trans, 0x308, GSM48_T308);
2689
2690 /* cause */
2691 if (rel->fields & MNCC_F_CAUSE)
2692 encode_cause(msg, 0, &rel->cause);
2693 /* facility */
2694 if (rel->fields & MNCC_F_FACILITY)
2695 encode_facility(msg, 0, &rel->facility);
2696 /* user-user */
2697 if (rel->fields & MNCC_F_USERUSER)
2698 encode_useruser(msg, 0, &rel->useruser);
2699
Harald Weltedcaf5652009-07-23 18:56:43 +02002700 trans->cc.T308_second = 0;
2701 memcpy(&trans->cc.msg, rel, sizeof(struct gsm_mncc));
Harald Welte4bfdfe72009-06-10 23:11:52 +08002702
Harald Weltedcaf5652009-07-23 18:56:43 +02002703 if (trans->cc.state != GSM_CSTATE_RELEASE_REQ)
Harald Welte4bfdfe72009-06-10 23:11:52 +08002704 new_cc_state(trans, GSM_CSTATE_RELEASE_REQ);
2705
Harald Welte39e2ead2009-07-23 21:13:03 +02002706 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002707}
2708
2709static int gsm48_cc_rx_release_compl(struct gsm_trans *trans, struct msgb *msg)
2710{
2711 struct gsm48_hdr *gh = msgb_l3(msg);
2712 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2713 struct tlv_parsed tp;
2714 struct gsm_mncc rel;
2715 int rc = 0;
2716
2717 gsm48_stop_cc_timer(trans);
2718
2719 memset(&rel, 0, sizeof(struct gsm_mncc));
2720 rel.callref = trans->callref;
2721 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2722 /* cause */
2723 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
2724 rel.fields |= MNCC_F_CAUSE;
2725 decode_cause(&rel.cause,
2726 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
2727 }
2728 /* facility */
2729 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2730 rel.fields |= MNCC_F_FACILITY;
2731 decode_facility(&rel.facility,
2732 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2733 }
2734 /* user-user */
2735 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
2736 rel.fields |= MNCC_F_USERUSER;
2737 decode_useruser(&rel.useruser,
2738 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
2739 }
2740 /* ss-version */
2741 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2742 rel.fields |= MNCC_F_SSVERSION;
2743 decode_ssversion(&rel.ssversion,
2744 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2745 }
2746
2747 if (trans->callref) {
Harald Weltedcaf5652009-07-23 18:56:43 +02002748 switch (trans->cc.state) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08002749 case GSM_CSTATE_CALL_PRESENT:
Harald Welte596fed42009-07-23 19:06:52 +02002750 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002751 MNCC_REJ_IND, &rel);
2752 break;
2753 case GSM_CSTATE_RELEASE_REQ:
Harald Welte596fed42009-07-23 19:06:52 +02002754 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002755 MNCC_REL_CNF, &rel);
Harald Welteb83d9382009-12-12 21:00:48 +01002756 /* FIXME: in case of multiple calls, we can't simply
2757 * hang up here ! */
2758 lchan_auto_release(msg->lchan);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002759 break;
2760 default:
Harald Welte596fed42009-07-23 19:06:52 +02002761 rc = mncc_recvmsg(trans->subscr->net, trans,
Harald Welte4bfdfe72009-06-10 23:11:52 +08002762 MNCC_REL_IND, &rel);
2763 }
2764 }
2765
2766 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02002767 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002768
2769 return rc;
2770}
2771
2772static int gsm48_cc_tx_release_compl(struct gsm_trans *trans, void *arg)
2773{
2774 struct gsm_mncc *rel = arg;
2775 struct msgb *msg = gsm48_msgb_alloc();
2776 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2777
Harald Welte4bfdfe72009-06-10 23:11:52 +08002778 gh->msg_type = GSM48_MT_CC_RELEASE_COMPL;
2779
2780 trans->callref = 0;
2781
2782 gsm48_stop_cc_timer(trans);
2783
2784 /* cause */
2785 if (rel->fields & MNCC_F_CAUSE)
2786 encode_cause(msg, 0, &rel->cause);
2787 /* facility */
2788 if (rel->fields & MNCC_F_FACILITY)
2789 encode_facility(msg, 0, &rel->facility);
2790 /* user-user */
2791 if (rel->fields & MNCC_F_USERUSER)
2792 encode_useruser(msg, 0, &rel->useruser);
2793
Harald Weltedcaf5652009-07-23 18:56:43 +02002794 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002795
Harald Welte39e2ead2009-07-23 21:13:03 +02002796 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002797}
2798
2799static int gsm48_cc_rx_facility(struct gsm_trans *trans, struct msgb *msg)
2800{
2801 struct gsm48_hdr *gh = msgb_l3(msg);
2802 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2803 struct tlv_parsed tp;
2804 struct gsm_mncc fac;
2805
2806 memset(&fac, 0, sizeof(struct gsm_mncc));
2807 fac.callref = trans->callref;
2808 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_FACILITY, 0);
2809 /* facility */
2810 if (TLVP_PRESENT(&tp, GSM48_IE_FACILITY)) {
2811 fac.fields |= MNCC_F_FACILITY;
2812 decode_facility(&fac.facility,
2813 TLVP_VAL(&tp, GSM48_IE_FACILITY)-1);
2814 }
2815 /* ss-version */
2816 if (TLVP_PRESENT(&tp, GSM48_IE_SS_VERS)) {
2817 fac.fields |= MNCC_F_SSVERSION;
2818 decode_ssversion(&fac.ssversion,
2819 TLVP_VAL(&tp, GSM48_IE_SS_VERS)-1);
2820 }
2821
Harald Welte596fed42009-07-23 19:06:52 +02002822 return mncc_recvmsg(trans->subscr->net, trans, MNCC_FACILITY_IND, &fac);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002823}
2824
2825static int gsm48_cc_tx_facility(struct gsm_trans *trans, void *arg)
2826{
2827 struct gsm_mncc *fac = arg;
2828 struct msgb *msg = gsm48_msgb_alloc();
2829 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2830
Harald Welte4bfdfe72009-06-10 23:11:52 +08002831 gh->msg_type = GSM48_MT_CC_FACILITY;
2832
2833 /* facility */
2834 encode_facility(msg, 1, &fac->facility);
2835
Harald Welte39e2ead2009-07-23 21:13:03 +02002836 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002837}
2838
2839static int gsm48_cc_rx_hold(struct gsm_trans *trans, struct msgb *msg)
2840{
2841 struct gsm_mncc hold;
2842
2843 memset(&hold, 0, sizeof(struct gsm_mncc));
2844 hold.callref = trans->callref;
Harald Welte596fed42009-07-23 19:06:52 +02002845 return mncc_recvmsg(trans->subscr->net, trans, MNCC_HOLD_IND, &hold);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002846}
2847
2848static int gsm48_cc_tx_hold_ack(struct gsm_trans *trans, void *arg)
2849{
2850 struct msgb *msg = gsm48_msgb_alloc();
2851 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2852
Harald Welte4bfdfe72009-06-10 23:11:52 +08002853 gh->msg_type = GSM48_MT_CC_HOLD_ACK;
2854
Harald Welte39e2ead2009-07-23 21:13:03 +02002855 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002856}
2857
2858static int gsm48_cc_tx_hold_rej(struct gsm_trans *trans, void *arg)
2859{
2860 struct gsm_mncc *hold_rej = arg;
2861 struct msgb *msg = gsm48_msgb_alloc();
2862 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2863
Harald Welte4bfdfe72009-06-10 23:11:52 +08002864 gh->msg_type = GSM48_MT_CC_HOLD_REJ;
2865
2866 /* cause */
2867 if (hold_rej->fields & MNCC_F_CAUSE)
2868 encode_cause(msg, 1, &hold_rej->cause);
2869 else
2870 encode_cause(msg, 1, &default_cause);
2871
Harald Welte39e2ead2009-07-23 21:13:03 +02002872 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002873}
2874
2875static int gsm48_cc_rx_retrieve(struct gsm_trans *trans, struct msgb *msg)
2876{
2877 struct gsm_mncc retrieve;
2878
2879 memset(&retrieve, 0, sizeof(struct gsm_mncc));
2880 retrieve.callref = trans->callref;
Harald Welte596fed42009-07-23 19:06:52 +02002881 return mncc_recvmsg(trans->subscr->net, trans, MNCC_RETRIEVE_IND,
2882 &retrieve);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002883}
2884
2885static int gsm48_cc_tx_retrieve_ack(struct gsm_trans *trans, void *arg)
2886{
2887 struct msgb *msg = gsm48_msgb_alloc();
2888 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2889
Harald Welte4bfdfe72009-06-10 23:11:52 +08002890 gh->msg_type = GSM48_MT_CC_RETR_ACK;
2891
Harald Welte39e2ead2009-07-23 21:13:03 +02002892 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002893}
2894
2895static int gsm48_cc_tx_retrieve_rej(struct gsm_trans *trans, void *arg)
2896{
2897 struct gsm_mncc *retrieve_rej = arg;
2898 struct msgb *msg = gsm48_msgb_alloc();
2899 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2900
Harald Welte4bfdfe72009-06-10 23:11:52 +08002901 gh->msg_type = GSM48_MT_CC_RETR_REJ;
2902
2903 /* cause */
2904 if (retrieve_rej->fields & MNCC_F_CAUSE)
2905 encode_cause(msg, 1, &retrieve_rej->cause);
2906 else
2907 encode_cause(msg, 1, &default_cause);
2908
Harald Welte39e2ead2009-07-23 21:13:03 +02002909 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002910}
2911
2912static int gsm48_cc_rx_start_dtmf(struct gsm_trans *trans, struct msgb *msg)
2913{
2914 struct gsm48_hdr *gh = msgb_l3(msg);
2915 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2916 struct tlv_parsed tp;
2917 struct gsm_mncc dtmf;
2918
2919 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2920 dtmf.callref = trans->callref;
2921 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, 0, 0);
2922 /* keypad facility */
2923 if (TLVP_PRESENT(&tp, GSM48_IE_KPD_FACILITY)) {
2924 dtmf.fields |= MNCC_F_KEYPAD;
2925 decode_keypad(&dtmf.keypad,
2926 TLVP_VAL(&tp, GSM48_IE_KPD_FACILITY)-1);
2927 }
2928
Harald Welte596fed42009-07-23 19:06:52 +02002929 return mncc_recvmsg(trans->subscr->net, trans, MNCC_START_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002930}
2931
2932static int gsm48_cc_tx_start_dtmf_ack(struct gsm_trans *trans, void *arg)
2933{
2934 struct gsm_mncc *dtmf = arg;
2935 struct msgb *msg = gsm48_msgb_alloc();
2936 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2937
Harald Welte4bfdfe72009-06-10 23:11:52 +08002938 gh->msg_type = GSM48_MT_CC_START_DTMF_ACK;
2939
2940 /* keypad */
2941 if (dtmf->fields & MNCC_F_KEYPAD)
2942 encode_keypad(msg, dtmf->keypad);
2943
Harald Welte39e2ead2009-07-23 21:13:03 +02002944 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002945}
2946
2947static int gsm48_cc_tx_start_dtmf_rej(struct gsm_trans *trans, void *arg)
2948{
2949 struct gsm_mncc *dtmf = arg;
2950 struct msgb *msg = gsm48_msgb_alloc();
2951 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2952
Harald Welte4bfdfe72009-06-10 23:11:52 +08002953 gh->msg_type = GSM48_MT_CC_START_DTMF_REJ;
2954
2955 /* cause */
2956 if (dtmf->fields & MNCC_F_CAUSE)
2957 encode_cause(msg, 1, &dtmf->cause);
2958 else
2959 encode_cause(msg, 1, &default_cause);
2960
Harald Welte39e2ead2009-07-23 21:13:03 +02002961 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002962}
2963
2964static int gsm48_cc_tx_stop_dtmf_ack(struct gsm_trans *trans, void *arg)
2965{
2966 struct msgb *msg = gsm48_msgb_alloc();
2967 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
2968
Harald Welte4bfdfe72009-06-10 23:11:52 +08002969 gh->msg_type = GSM48_MT_CC_STOP_DTMF_ACK;
2970
Harald Welte39e2ead2009-07-23 21:13:03 +02002971 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002972}
2973
2974static int gsm48_cc_rx_stop_dtmf(struct gsm_trans *trans, struct msgb *msg)
2975{
2976 struct gsm_mncc dtmf;
2977
2978 memset(&dtmf, 0, sizeof(struct gsm_mncc));
2979 dtmf.callref = trans->callref;
2980
Harald Welte596fed42009-07-23 19:06:52 +02002981 return mncc_recvmsg(trans->subscr->net, trans, MNCC_STOP_DTMF_IND, &dtmf);
Harald Welte4bfdfe72009-06-10 23:11:52 +08002982}
2983
2984static int gsm48_cc_rx_modify(struct gsm_trans *trans, struct msgb *msg)
2985{
2986 struct gsm48_hdr *gh = msgb_l3(msg);
2987 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
2988 struct tlv_parsed tp;
2989 struct gsm_mncc modify;
2990
2991 memset(&modify, 0, sizeof(struct gsm_mncc));
2992 modify.callref = trans->callref;
2993 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
2994 /* bearer capability */
2995 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
2996 modify.fields |= MNCC_F_BEARER_CAP;
2997 decode_bearer_cap(&modify.bearer_cap,
2998 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
2999 }
3000
3001 new_cc_state(trans, GSM_CSTATE_MO_ORIG_MODIFY);
3002
Harald Welte596fed42009-07-23 19:06:52 +02003003 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_IND, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003004}
3005
3006static int gsm48_cc_tx_modify(struct gsm_trans *trans, void *arg)
3007{
3008 struct gsm_mncc *modify = arg;
3009 struct msgb *msg = gsm48_msgb_alloc();
3010 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
3011
Harald Welte4bfdfe72009-06-10 23:11:52 +08003012 gh->msg_type = GSM48_MT_CC_MODIFY;
3013
3014 gsm48_start_cc_timer(trans, 0x323, GSM48_T323);
3015
3016 /* bearer capability */
3017 encode_bearer_cap(msg, 1, &modify->bearer_cap);
3018
3019 new_cc_state(trans, GSM_CSTATE_MO_TERM_MODIFY);
3020
Harald Welte39e2ead2009-07-23 21:13:03 +02003021 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003022}
3023
3024static int gsm48_cc_rx_modify_complete(struct gsm_trans *trans, struct msgb *msg)
3025{
3026 struct gsm48_hdr *gh = msgb_l3(msg);
3027 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
3028 struct tlv_parsed tp;
3029 struct gsm_mncc modify;
3030
3031 gsm48_stop_cc_timer(trans);
3032
3033 memset(&modify, 0, sizeof(struct gsm_mncc));
3034 modify.callref = trans->callref;
3035 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, 0);
3036 /* bearer capability */
3037 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
3038 modify.fields |= MNCC_F_BEARER_CAP;
3039 decode_bearer_cap(&modify.bearer_cap,
3040 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
3041 }
3042
3043 new_cc_state(trans, GSM_CSTATE_ACTIVE);
3044
Harald Welte596fed42009-07-23 19:06:52 +02003045 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_CNF, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003046}
3047
3048static int gsm48_cc_tx_modify_complete(struct gsm_trans *trans, void *arg)
3049{
3050 struct gsm_mncc *modify = arg;
3051 struct msgb *msg = gsm48_msgb_alloc();
3052 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
3053
Harald Welte4bfdfe72009-06-10 23:11:52 +08003054 gh->msg_type = GSM48_MT_CC_MODIFY_COMPL;
3055
3056 /* bearer capability */
3057 encode_bearer_cap(msg, 1, &modify->bearer_cap);
3058
3059 new_cc_state(trans, GSM_CSTATE_ACTIVE);
3060
Harald Welte39e2ead2009-07-23 21:13:03 +02003061 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003062}
3063
3064static int gsm48_cc_rx_modify_reject(struct gsm_trans *trans, struct msgb *msg)
3065{
3066 struct gsm48_hdr *gh = msgb_l3(msg);
3067 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
3068 struct tlv_parsed tp;
3069 struct gsm_mncc modify;
3070
3071 gsm48_stop_cc_timer(trans);
3072
3073 memset(&modify, 0, sizeof(struct gsm_mncc));
3074 modify.callref = trans->callref;
3075 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_BEARER_CAP, GSM48_IE_CAUSE);
3076 /* bearer capability */
3077 if (TLVP_PRESENT(&tp, GSM48_IE_BEARER_CAP)) {
3078 modify.fields |= GSM48_IE_BEARER_CAP;
3079 decode_bearer_cap(&modify.bearer_cap,
3080 TLVP_VAL(&tp, GSM48_IE_BEARER_CAP)-1);
3081 }
3082 /* cause */
3083 if (TLVP_PRESENT(&tp, GSM48_IE_CAUSE)) {
3084 modify.fields |= MNCC_F_CAUSE;
3085 decode_cause(&modify.cause,
3086 TLVP_VAL(&tp, GSM48_IE_CAUSE)-1);
3087 }
3088
3089 new_cc_state(trans, GSM_CSTATE_ACTIVE);
3090
Harald Welte596fed42009-07-23 19:06:52 +02003091 return mncc_recvmsg(trans->subscr->net, trans, MNCC_MODIFY_REJ, &modify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003092}
3093
3094static int gsm48_cc_tx_modify_reject(struct gsm_trans *trans, void *arg)
3095{
3096 struct gsm_mncc *modify = arg;
3097 struct msgb *msg = gsm48_msgb_alloc();
3098 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
3099
Harald Welte4bfdfe72009-06-10 23:11:52 +08003100 gh->msg_type = GSM48_MT_CC_MODIFY_REJECT;
3101
3102 /* bearer capability */
3103 encode_bearer_cap(msg, 1, &modify->bearer_cap);
3104 /* cause */
3105 encode_cause(msg, 1, &modify->cause);
3106
3107 new_cc_state(trans, GSM_CSTATE_ACTIVE);
3108
Harald Welte39e2ead2009-07-23 21:13:03 +02003109 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003110}
3111
3112static int gsm48_cc_tx_notify(struct gsm_trans *trans, void *arg)
3113{
3114 struct gsm_mncc *notify = arg;
3115 struct msgb *msg = gsm48_msgb_alloc();
3116 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
3117
Harald Welte4bfdfe72009-06-10 23:11:52 +08003118 gh->msg_type = GSM48_MT_CC_NOTIFY;
3119
3120 /* notify */
3121 encode_notify(msg, notify->notify);
3122
Harald Welte39e2ead2009-07-23 21:13:03 +02003123 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003124}
3125
3126static int gsm48_cc_rx_notify(struct gsm_trans *trans, struct msgb *msg)
3127{
3128 struct gsm48_hdr *gh = msgb_l3(msg);
3129 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
3130// struct tlv_parsed tp;
3131 struct gsm_mncc notify;
3132
3133 memset(&notify, 0, sizeof(struct gsm_mncc));
3134 notify.callref = trans->callref;
3135// tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len);
3136 if (payload_len >= 1)
3137 decode_notify(&notify.notify, gh->data);
3138
Harald Welte596fed42009-07-23 19:06:52 +02003139 return mncc_recvmsg(trans->subscr->net, trans, MNCC_NOTIFY_IND, &notify);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003140}
3141
3142static int gsm48_cc_tx_userinfo(struct gsm_trans *trans, void *arg)
3143{
3144 struct gsm_mncc *user = arg;
3145 struct msgb *msg = gsm48_msgb_alloc();
3146 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
3147
Harald Welte4bfdfe72009-06-10 23:11:52 +08003148 gh->msg_type = GSM48_MT_CC_USER_INFO;
3149
3150 /* user-user */
3151 if (user->fields & MNCC_F_USERUSER)
3152 encode_useruser(msg, 1, &user->useruser);
3153 /* more data */
3154 if (user->more)
3155 encode_more(msg);
3156
Harald Welte39e2ead2009-07-23 21:13:03 +02003157 return gsm48_sendmsg(msg, trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003158}
3159
3160static int gsm48_cc_rx_userinfo(struct gsm_trans *trans, struct msgb *msg)
3161{
3162 struct gsm48_hdr *gh = msgb_l3(msg);
3163 unsigned int payload_len = msgb_l3len(msg) - sizeof(*gh);
3164 struct tlv_parsed tp;
3165 struct gsm_mncc user;
3166
3167 memset(&user, 0, sizeof(struct gsm_mncc));
3168 user.callref = trans->callref;
3169 tlv_parse(&tp, &rsl_att_tlvdef, gh->data, payload_len, GSM48_IE_USER_USER, 0);
3170 /* user-user */
3171 if (TLVP_PRESENT(&tp, GSM48_IE_USER_USER)) {
3172 user.fields |= MNCC_F_USERUSER;
3173 decode_useruser(&user.useruser,
3174 TLVP_VAL(&tp, GSM48_IE_USER_USER)-1);
3175 }
3176 /* more data */
3177 if (TLVP_PRESENT(&tp, GSM48_IE_MORE_DATA))
3178 user.more = 1;
3179
Harald Welte596fed42009-07-23 19:06:52 +02003180 return mncc_recvmsg(trans->subscr->net, trans, MNCC_USERINFO_IND, &user);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003181}
3182
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02003183static int _gsm48_lchan_modify(struct gsm_trans *trans, void *arg)
Harald Welte4bfdfe72009-06-10 23:11:52 +08003184{
3185 struct gsm_mncc *mode = arg;
3186
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +01003187 return gsm48_lchan_modify(trans->lchan, mode->lchan_mode);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003188}
3189
3190static struct downstate {
3191 u_int32_t states;
3192 int type;
3193 int (*rout) (struct gsm_trans *trans, void *arg);
3194} downstatelist[] = {
3195 /* mobile originating call establishment */
3196 {SBIT(GSM_CSTATE_INITIATED), /* 5.2.1.2 */
3197 MNCC_CALL_PROC_REQ, gsm48_cc_tx_call_proc},
3198 {SBIT(GSM_CSTATE_INITIATED) | SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.2 | 5.2.1.5 */
3199 MNCC_ALERT_REQ, gsm48_cc_tx_alerting},
3200 {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 */
3201 MNCC_SETUP_RSP, gsm48_cc_tx_connect},
3202 {SBIT(GSM_CSTATE_MO_CALL_PROC), /* 5.2.1.4.2 */
3203 MNCC_PROGRESS_REQ, gsm48_cc_tx_progress},
3204 /* mobile terminating call establishment */
3205 {SBIT(GSM_CSTATE_NULL), /* 5.2.2.1 */
3206 MNCC_SETUP_REQ, gsm48_cc_tx_setup},
3207 {SBIT(GSM_CSTATE_CONNECT_REQUEST),
3208 MNCC_SETUP_COMPL_REQ, gsm48_cc_tx_connect_ack},
3209 /* signalling during call */
3210 {SBIT(GSM_CSTATE_ACTIVE),
3211 MNCC_NOTIFY_REQ, gsm48_cc_tx_notify},
3212 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ),
3213 MNCC_FACILITY_REQ, gsm48_cc_tx_facility},
3214 {ALL_STATES,
3215 MNCC_START_DTMF_RSP, gsm48_cc_tx_start_dtmf_ack},
3216 {ALL_STATES,
3217 MNCC_START_DTMF_REJ, gsm48_cc_tx_start_dtmf_rej},
3218 {ALL_STATES,
3219 MNCC_STOP_DTMF_RSP, gsm48_cc_tx_stop_dtmf_ack},
3220 {SBIT(GSM_CSTATE_ACTIVE),
3221 MNCC_HOLD_CNF, gsm48_cc_tx_hold_ack},
3222 {SBIT(GSM_CSTATE_ACTIVE),
3223 MNCC_HOLD_REJ, gsm48_cc_tx_hold_rej},
3224 {SBIT(GSM_CSTATE_ACTIVE),
3225 MNCC_RETRIEVE_CNF, gsm48_cc_tx_retrieve_ack},
3226 {SBIT(GSM_CSTATE_ACTIVE),
3227 MNCC_RETRIEVE_REJ, gsm48_cc_tx_retrieve_rej},
3228 {SBIT(GSM_CSTATE_ACTIVE),
3229 MNCC_MODIFY_REQ, gsm48_cc_tx_modify},
3230 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
3231 MNCC_MODIFY_RSP, gsm48_cc_tx_modify_complete},
3232 {SBIT(GSM_CSTATE_MO_ORIG_MODIFY),
3233 MNCC_MODIFY_REJ, gsm48_cc_tx_modify_reject},
3234 {SBIT(GSM_CSTATE_ACTIVE),
3235 MNCC_USERINFO_REQ, gsm48_cc_tx_userinfo},
3236 /* clearing */
3237 {SBIT(GSM_CSTATE_INITIATED),
3238 MNCC_REJ_REQ, gsm48_cc_tx_release_compl},
3239 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_DISCONNECT_IND) - SBIT(GSM_CSTATE_RELEASE_REQ) - SBIT(GSM_CSTATE_DISCONNECT_REQ), /* 5.4.4 */
3240 MNCC_DISC_REQ, gsm48_cc_tx_disconnect},
3241 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3242 MNCC_REL_REQ, gsm48_cc_tx_release},
3243 /* special */
3244 {ALL_STATES,
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +02003245 MNCC_LCHAN_MODIFY, _gsm48_lchan_modify},
Harald Welte4bfdfe72009-06-10 23:11:52 +08003246};
3247
3248#define DOWNSLLEN \
3249 (sizeof(downstatelist) / sizeof(struct downstate))
3250
3251
3252int mncc_send(struct gsm_network *net, int msg_type, void *arg)
3253{
Harald Welte1a6f7982009-08-09 18:52:33 +02003254 int i, rc = 0;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003255 struct gsm_trans *trans = NULL, *transt;
Harald Welte1a6f7982009-08-09 18:52:33 +02003256 struct gsm_lchan *lchan = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003257 struct gsm_bts *bts = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003258 struct gsm_mncc *data = arg, rel;
3259
3260 /* handle special messages */
3261 switch(msg_type) {
3262 case MNCC_BRIDGE:
3263 return tch_bridge(net, arg);
3264 case MNCC_FRAME_DROP:
3265 return tch_recv(net, arg, 0);
3266 case MNCC_FRAME_RECV:
3267 return tch_recv(net, arg, 1);
3268 case GSM_TRAU_FRAME:
3269 return tch_frame(net, arg);
3270 }
3271
3272 memset(&rel, 0, sizeof(struct gsm_mncc));
3273 rel.callref = data->callref;
3274
3275 /* Find callref */
Harald Weltedcaf5652009-07-23 18:56:43 +02003276 trans = trans_find_by_callref(net, data->callref);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003277
3278 /* Callref unknown */
3279 if (!trans) {
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003280 struct gsm_subscriber *subscr;
3281
Harald Welte4a3464c2009-07-04 10:11:24 +02003282 if (msg_type != MNCC_SETUP_REQ) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003283 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3284 "Received '%s' from MNCC with "
3285 "unknown callref %d\n", data->called.number,
3286 get_mncc_name(msg_type), data->callref);
3287 /* Invalid call reference */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003288 return mncc_release_ind(net, NULL, data->callref,
3289 GSM48_CAUSE_LOC_PRN_S_LU,
3290 GSM48_CC_CAUSE_INVAL_TRANS_ID);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003291 }
Andreas Eversbergc079be42009-06-15 23:22:09 +02003292 if (!data->called.number[0] && !data->imsi[0]) {
3293 DEBUGP(DCC, "(bts - trx - ts - ti) "
3294 "Received '%s' from MNCC with "
3295 "no number or IMSI\n", get_mncc_name(msg_type));
3296 /* Invalid number */
3297 return mncc_release_ind(net, NULL, data->callref,
3298 GSM48_CAUSE_LOC_PRN_S_LU,
3299 GSM48_CC_CAUSE_INV_NR_FORMAT);
3300 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003301 /* New transaction due to setup, find subscriber */
Andreas Eversbergc079be42009-06-15 23:22:09 +02003302 if (data->called.number[0])
Harald Welte9176bd42009-07-23 18:46:00 +02003303 subscr = subscr_get_by_extension(net,
3304 data->called.number);
Andreas Eversbergc079be42009-06-15 23:22:09 +02003305 else
Harald Welte9176bd42009-07-23 18:46:00 +02003306 subscr = subscr_get_by_imsi(net, data->imsi);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003307 /* If subscriber is not found */
3308 if (!subscr) {
3309 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3310 "Received '%s' from MNCC with "
3311 "unknown subscriber %s\n", data->called.number,
3312 get_mncc_name(msg_type), data->called.number);
3313 /* Unknown subscriber */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003314 return mncc_release_ind(net, NULL, data->callref,
3315 GSM48_CAUSE_LOC_PRN_S_LU,
3316 GSM48_CC_CAUSE_UNASSIGNED_NR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003317 }
3318 /* If subscriber is not "attached" */
3319 if (!subscr->lac) {
3320 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3321 "Received '%s' from MNCC with "
3322 "detached subscriber %s\n", data->called.number,
3323 get_mncc_name(msg_type), data->called.number);
3324 subscr_put(subscr);
3325 /* Temporarily out of order */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003326 return mncc_release_ind(net, NULL, data->callref,
3327 GSM48_CAUSE_LOC_PRN_S_LU,
3328 GSM48_CC_CAUSE_DEST_OOO);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003329 }
3330 /* Create transaction */
Harald Weltedcaf5652009-07-23 18:56:43 +02003331 trans = trans_alloc(subscr, GSM48_PDISC_CC, 0xff, data->callref);
3332 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003333 DEBUGP(DCC, "No memory for trans.\n");
3334 subscr_put(subscr);
3335 /* Ressource unavailable */
Andreas Eversberg7563ac92009-06-14 22:14:12 +08003336 mncc_release_ind(net, NULL, data->callref,
3337 GSM48_CAUSE_LOC_PRN_S_LU,
3338 GSM48_CC_CAUSE_RESOURCE_UNAVAIL);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003339 return -ENOMEM;
3340 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003341 /* Find lchan */
Harald Welte1a6f7982009-08-09 18:52:33 +02003342 lchan = lchan_for_subscr(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003343 /* If subscriber has no lchan */
3344 if (!lchan) {
3345 /* find transaction with this subscriber already paging */
3346 llist_for_each_entry(transt, &net->trans_list, entry) {
3347 /* Transaction of our lchan? */
3348 if (transt == trans ||
3349 transt->subscr != subscr)
3350 continue;
3351 DEBUGP(DCC, "(bts %d trx - ts - ti -- sub %s) "
3352 "Received '%s' from MNCC with "
3353 "unallocated channel, paging already "
3354 "started.\n", bts->nr,
3355 data->called.number,
3356 get_mncc_name(msg_type));
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003357 subscr_put(subscr);
3358 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003359 return 0;
3360 }
3361 /* store setup informations until paging was successfull */
Harald Weltedcaf5652009-07-23 18:56:43 +02003362 memcpy(&trans->cc.msg, data, sizeof(struct gsm_mncc));
Harald Weltea1b28582009-08-01 19:31:47 +02003363 /* Trigger paging */
3364 paging_request(net, subscr, RSL_CHANNEED_TCH_F,
3365 setup_trig_pag_evt, subscr);
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003366 subscr_put(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003367 return 0;
3368 }
3369 /* Assign lchan */
3370 trans->lchan = lchan;
3371 use_lchan(lchan);
Holger Hans Peter Freytherccf53c62009-10-27 14:21:14 +01003372 subscr_put(subscr);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003373 }
3374 lchan = trans->lchan;
3375
3376 /* if paging did not respond yet */
3377 if (!lchan) {
3378 DEBUGP(DCC, "(bts - trx - ts - ti -- sub %s) "
3379 "Received '%s' from MNCC in paging state\n",
3380 (trans->subscr)?(trans->subscr->extension):"-",
3381 get_mncc_name(msg_type));
Harald Weltec66b71c2009-06-11 14:23:20 +08003382 mncc_set_cause(&rel, GSM48_CAUSE_LOC_PRN_S_LU,
3383 GSM48_CC_CAUSE_NORM_CALL_CLEAR);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003384 if (msg_type == MNCC_REL_REQ)
3385 rc = mncc_recvmsg(net, trans, MNCC_REL_CNF, &rel);
3386 else
3387 rc = mncc_recvmsg(net, trans, MNCC_REL_IND, &rel);
3388 trans->callref = 0;
Harald Weltedcaf5652009-07-23 18:56:43 +02003389 trans_free(trans);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003390 return rc;
3391 }
3392
3393 DEBUGP(DCC, "(bts %d trx %d ts %d ti %02x sub %s) "
3394 "Received '%s' from MNCC in state %d (%s)\n",
3395 lchan->ts->trx->bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
3396 trans->transaction_id,
3397 (lchan->subscr)?(lchan->subscr->extension):"-",
Harald Weltedcaf5652009-07-23 18:56:43 +02003398 get_mncc_name(msg_type), trans->cc.state,
3399 cc_state_names[trans->cc.state]);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003400
3401 /* Find function for current state and message */
3402 for (i = 0; i < DOWNSLLEN; i++)
3403 if ((msg_type == downstatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003404 && ((1 << trans->cc.state) & downstatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003405 break;
3406 if (i == DOWNSLLEN) {
3407 DEBUGP(DCC, "Message unhandled at this state.\n");
3408 return 0;
3409 }
3410
3411 rc = downstatelist[i].rout(trans, arg);
3412
3413 return rc;
3414}
3415
3416
3417static struct datastate {
3418 u_int32_t states;
3419 int type;
3420 int (*rout) (struct gsm_trans *trans, struct msgb *msg);
3421} datastatelist[] = {
3422 /* mobile originating call establishment */
3423 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3424 GSM48_MT_CC_SETUP, gsm48_cc_rx_setup},
3425 {SBIT(GSM_CSTATE_NULL), /* 5.2.1.2 */
3426 GSM48_MT_CC_EMERG_SETUP, gsm48_cc_rx_setup},
3427 {SBIT(GSM_CSTATE_CONNECT_IND), /* 5.2.1.2 */
3428 GSM48_MT_CC_CONNECT_ACK, gsm48_cc_rx_connect_ack},
3429 /* mobile terminating call establishment */
3430 {SBIT(GSM_CSTATE_CALL_PRESENT), /* 5.2.2.3.2 */
3431 GSM48_MT_CC_CALL_CONF, gsm48_cc_rx_call_conf},
3432 {SBIT(GSM_CSTATE_CALL_PRESENT) | SBIT(GSM_CSTATE_MO_TERM_CALL_CONF), /* ???? | 5.2.2.3.2 */
3433 GSM48_MT_CC_ALERTING, gsm48_cc_rx_alerting},
3434 {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 */
3435 GSM48_MT_CC_CONNECT, gsm48_cc_rx_connect},
3436 /* signalling during call */
3437 {ALL_STATES - SBIT(GSM_CSTATE_NULL),
3438 GSM48_MT_CC_FACILITY, gsm48_cc_rx_facility},
3439 {SBIT(GSM_CSTATE_ACTIVE),
3440 GSM48_MT_CC_NOTIFY, gsm48_cc_rx_notify},
3441 {ALL_STATES,
3442 GSM48_MT_CC_START_DTMF, gsm48_cc_rx_start_dtmf},
3443 {ALL_STATES,
3444 GSM48_MT_CC_STOP_DTMF, gsm48_cc_rx_stop_dtmf},
3445 {ALL_STATES,
3446 GSM48_MT_CC_STATUS_ENQ, gsm48_cc_rx_status_enq},
3447 {SBIT(GSM_CSTATE_ACTIVE),
3448 GSM48_MT_CC_HOLD, gsm48_cc_rx_hold},
3449 {SBIT(GSM_CSTATE_ACTIVE),
3450 GSM48_MT_CC_RETR, gsm48_cc_rx_retrieve},
3451 {SBIT(GSM_CSTATE_ACTIVE),
3452 GSM48_MT_CC_MODIFY, gsm48_cc_rx_modify},
3453 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3454 GSM48_MT_CC_MODIFY_COMPL, gsm48_cc_rx_modify_complete},
3455 {SBIT(GSM_CSTATE_MO_TERM_MODIFY),
3456 GSM48_MT_CC_MODIFY_REJECT, gsm48_cc_rx_modify_reject},
3457 {SBIT(GSM_CSTATE_ACTIVE),
3458 GSM48_MT_CC_USER_INFO, gsm48_cc_rx_userinfo},
3459 /* clearing */
3460 {ALL_STATES - SBIT(GSM_CSTATE_NULL) - SBIT(GSM_CSTATE_RELEASE_REQ), /* 5.4.3.2 */
3461 GSM48_MT_CC_DISCONNECT, gsm48_cc_rx_disconnect},
3462 {ALL_STATES - SBIT(GSM_CSTATE_NULL), /* 5.4.4.1.2.2 */
3463 GSM48_MT_CC_RELEASE, gsm48_cc_rx_release},
3464 {ALL_STATES, /* 5.4.3.4 */
3465 GSM48_MT_CC_RELEASE_COMPL, gsm48_cc_rx_release_compl},
3466};
3467
3468#define DATASLLEN \
3469 (sizeof(datastatelist) / sizeof(struct datastate))
3470
Harald Welte4bc90a12008-12-27 16:32:52 +00003471static int gsm0408_rcv_cc(struct msgb *msg)
3472{
3473 struct gsm48_hdr *gh = msgb_l3(msg);
3474 u_int8_t msg_type = gh->msg_type & 0xbf;
Harald Welte6f5aee02009-07-23 21:21:14 +02003475 u_int8_t transaction_id = ((gh->proto_discr & 0xf0) ^ 0x80) >> 4; /* flip */
Harald Welte4bfdfe72009-06-10 23:11:52 +08003476 struct gsm_lchan *lchan = msg->lchan;
Harald Weltedcaf5652009-07-23 18:56:43 +02003477 struct gsm_trans *trans = NULL;
Harald Welte4bfdfe72009-06-10 23:11:52 +08003478 int i, rc = 0;
Harald Welte4bc90a12008-12-27 16:32:52 +00003479
Harald Welte4bfdfe72009-06-10 23:11:52 +08003480 if (msg_type & 0x80) {
3481 DEBUGP(DCC, "MSG 0x%2x not defined for PD error\n", msg_type);
3482 return -EINVAL;
Harald Welte4bc90a12008-12-27 16:32:52 +00003483 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003484
3485 /* Find transaction */
Harald Welteb8b40732009-07-23 21:58:40 +02003486 trans = trans_find_by_id(lchan->subscr, GSM48_PDISC_CC, transaction_id);
Harald Weltedcaf5652009-07-23 18:56:43 +02003487
Harald Welte6f5aee02009-07-23 21:21:14 +02003488 DEBUGP(DCC, "(bts %d trx %d ts %d ti %x sub %s) "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003489 "Received '%s' from MS in state %d (%s)\n",
3490 lchan->ts->trx->bts->nr, lchan->ts->trx->nr, lchan->ts->nr,
3491 transaction_id, (lchan->subscr)?(lchan->subscr->extension):"-",
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +02003492 gsm0408_cc_msg_names[msg_type], trans?(trans->cc.state):0,
Harald Weltedcaf5652009-07-23 18:56:43 +02003493 cc_state_names[trans?(trans->cc.state):0]);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003494
3495 /* Create transaction */
3496 if (!trans) {
Harald Welte6f5aee02009-07-23 21:21:14 +02003497 DEBUGP(DCC, "Unknown transaction ID %x, "
Harald Welte4bfdfe72009-06-10 23:11:52 +08003498 "creating new trans.\n", transaction_id);
3499 /* Create transaction */
Harald Weltedcaf5652009-07-23 18:56:43 +02003500 trans = trans_alloc(lchan->subscr, GSM48_PDISC_CC,
3501 transaction_id, new_callref++);
3502 if (!trans) {
Harald Welte4bfdfe72009-06-10 23:11:52 +08003503 DEBUGP(DCC, "No memory for trans.\n");
3504 rc = gsm48_tx_simple(msg->lchan,
Harald Welte6f5aee02009-07-23 21:21:14 +02003505 GSM48_PDISC_CC | (transaction_id << 4),
Harald Welte4bfdfe72009-06-10 23:11:52 +08003506 GSM48_MT_CC_RELEASE_COMPL);
3507 return -ENOMEM;
3508 }
Harald Welte4bfdfe72009-06-10 23:11:52 +08003509 /* Assign transaction */
Harald Welte4bfdfe72009-06-10 23:11:52 +08003510 trans->lchan = lchan;
3511 use_lchan(lchan);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003512 }
3513
3514 /* find function for current state and message */
3515 for (i = 0; i < DATASLLEN; i++)
3516 if ((msg_type == datastatelist[i].type)
Harald Weltedcaf5652009-07-23 18:56:43 +02003517 && ((1 << trans->cc.state) & datastatelist[i].states))
Harald Welte4bfdfe72009-06-10 23:11:52 +08003518 break;
3519 if (i == DATASLLEN) {
3520 DEBUGP(DCC, "Message unhandled at this state.\n");
3521 return 0;
3522 }
3523
3524 rc = datastatelist[i].rout(trans, msg);
Harald Welte4bc90a12008-12-27 16:32:52 +00003525
3526 return rc;
3527}
3528
Harald Welte52b1f982008-12-23 20:25:15 +00003529/* here we pass in a msgb from the RSL->RLL. We expect the l3 pointer to be set */
Harald Welte (local)daef6062009-08-14 11:41:12 +02003530int gsm0408_rcvmsg(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +00003531{
3532 struct gsm48_hdr *gh = msgb_l3(msg);
3533 u_int8_t pdisc = gh->proto_discr & 0x0f;
Harald Welte8470bf22008-12-25 23:28:35 +00003534 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00003535
3536 switch (pdisc) {
3537 case GSM48_PDISC_CC:
3538 rc = gsm0408_rcv_cc(msg);
3539 break;
3540 case GSM48_PDISC_MM:
3541 rc = gsm0408_rcv_mm(msg);
3542 break;
3543 case GSM48_PDISC_RR:
3544 rc = gsm0408_rcv_rr(msg);
3545 break;
Harald Weltebcae43f2008-12-27 21:45:37 +00003546 case GSM48_PDISC_SMS:
Harald Welte (local)daef6062009-08-14 11:41:12 +02003547 rc = gsm0411_rcv_sms(msg, link_id);
Harald Weltebcae43f2008-12-27 21:45:37 +00003548 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003549 case GSM48_PDISC_MM_GPRS:
Harald Weltebcae43f2008-12-27 21:45:37 +00003550 case GSM48_PDISC_SM_GPRS:
Mike Haben59d284e2009-09-26 19:00:03 +02003551 fprintf(stderr, "Unimplemented GSM 04.08 discriminator 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00003552 pdisc);
3553 break;
Harald Welte6eafe912009-10-16 08:32:58 +02003554 case GSM48_PDISC_NC_SS:
3555 rc = handle_rcv_ussd(msg);
3556 break;
Harald Welte52b1f982008-12-23 20:25:15 +00003557 default:
Mike Haben59d284e2009-09-26 19:00:03 +02003558 fprintf(stderr, "Unknown GSM 04.08 discriminator 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00003559 pdisc);
3560 break;
3561 }
3562
3563 return rc;
3564}
Harald Welte8470bf22008-12-25 23:28:35 +00003565
Harald Welte4bfdfe72009-06-10 23:11:52 +08003566/* dequeue messages to layer 4 */
3567int bsc_upqueue(struct gsm_network *net)
3568{
3569 struct gsm_mncc *mncc;
3570 struct msgb *msg;
3571 int work = 0;
3572
3573 if (net)
3574 while ((msg = msgb_dequeue(&net->upqueue))) {
3575 mncc = (struct gsm_mncc *)msg->data;
3576 if (net->mncc_recv)
3577 net->mncc_recv(net, mncc->msg_type, mncc);
3578 work = 1; /* work done */
Harald Welte316c8252009-06-26 19:40:48 +02003579 talloc_free(msg);
Harald Welte4bfdfe72009-06-10 23:11:52 +08003580 }
3581
3582 return work;
3583}
Harald Weltedcaf5652009-07-23 18:56:43 +02003584
Harald Welte805f6442009-07-28 18:25:29 +02003585/*
3586 * This will be ran by the linker when loading the DSO. We use it to
3587 * do system initialization, e.g. registration of signal handlers.
3588 */
3589static __attribute__((constructor)) void on_dso_load_0408(void)
3590{
Harald Welte805f6442009-07-28 18:25:29 +02003591 register_signal_handler(SS_LCHAN, gsm0408_handle_lchan_signal, NULL);
3592 register_signal_handler(SS_ABISIP, handle_abisip_signal, NULL);
3593}