blob: c07698530d59133ed7cd741abf00e8f3007c1b7b [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Welte3c9c5f92010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte8470bf22008-12-25 23:28:35 +00005 *
Harald Welte52b1f982008-12-23 20:25:15 +00006 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
21 *
22 */
23
24#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000025#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000026#include <errno.h>
27#include <sys/types.h>
Harald Welte75099262009-02-16 21:12:08 +000028#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000029#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000030
Harald Welte8470bf22008-12-25 23:28:35 +000031#include <openbsc/gsm_data.h>
32#include <openbsc/gsm_04_08.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010033#include <osmocore/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000034#include <openbsc/abis_rsl.h>
35#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020036#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000037#include <openbsc/debug.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010038#include <osmocore/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000039#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000040#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010041#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010042#include <openbsc/rtp_proxy.h>
Harald Welte2e411c72010-03-01 21:59:06 +010043#include <osmocore/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000044
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080045#include <osmocore/talloc.h>
46
Harald Welte8470bf22008-12-25 23:28:35 +000047#define RSL_ALLOC_SIZE 1024
48#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000049
Holger Freyther3b72a892009-02-04 00:31:39 +000050#define MAX(a, b) (a) >= (b) ? (a) : (b)
51
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080052static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
53
Harald Welte52b1f982008-12-23 20:25:15 +000054static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
55{
56 /* mask off the transparent bit ? */
57 msg_type &= 0xfe;
58
Harald Welte8470bf22008-12-25 23:28:35 +000059 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000060 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000061 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000062 if (msg_type >= 0x19 && msg_type <= 0x22)
63 return ABIS_RSL_MDISC_TRX;
64 else
65 return ABIS_RSL_MDISC_COM_CHAN;
66 }
Harald Welte2d5b6382008-12-27 19:46:06 +000067 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000068 return ABIS_RSL_MDISC_DED_CHAN;
69
70 return ABIS_RSL_MDISC_LOC;
71}
72
73static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
74 u_int8_t msg_type)
75{
76 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
77 dh->c.msg_type = msg_type;
78 dh->ie_chan = RSL_IE_CHAN_NR;
79}
80
Harald Welte8470bf22008-12-25 23:28:35 +000081/* determine logical channel based on TRX and channel number IE */
82struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
83{
84 struct gsm_lchan *lchan;
85 u_int8_t ts_nr = chan_nr & 0x07;
86 u_int8_t cbits = chan_nr >> 3;
87 u_int8_t lch_idx;
88 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
89
90 if (cbits == 0x01) {
91 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020092 if (ts->pchan != GSM_PCHAN_TCH_F &&
93 ts->pchan != GSM_PCHAN_PDCH &&
94 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +010095 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +000096 chan_nr, ts->pchan);
97 } else if ((cbits & 0x1e) == 0x02) {
98 lch_idx = cbits & 0x1; /* TCH/H */
99 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000101 chan_nr, ts->pchan);
102 } else if ((cbits & 0x1c) == 0x04) {
103 lch_idx = cbits & 0x3; /* SDCCH/4 */
104 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000106 chan_nr, ts->pchan);
107 } else if ((cbits & 0x18) == 0x08) {
108 lch_idx = cbits & 0x7; /* SDCCH/8 */
109 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000111 chan_nr, ts->pchan);
112 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
113 lch_idx = 0;
114 if (ts->pchan != GSM_PCHAN_CCCH &&
115 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100116 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000117 chan_nr, ts->pchan);
118 /* FIXME: we should not return first sdcch4 !!! */
119 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100120 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000121 return NULL;
122 }
123
124 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800125 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800126 if (lchan->conn)
127 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000128
129 return lchan;
130}
131
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200132/* See Table 10.5.25 of GSM04.08 */
Harald Welte53cd7ac2010-12-23 12:59:52 +0100133static u_int8_t ts2chan_nr(const struct gsm_bts_trx_ts *ts, uint8_t lchan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +0000134{
Harald Welte8470bf22008-12-25 23:28:35 +0000135 u_int8_t cbits, chan_nr;
136
137 switch (ts->pchan) {
138 case GSM_PCHAN_TCH_F:
Harald Weltea1499d02009-10-24 10:25:50 +0200139 case GSM_PCHAN_PDCH:
140 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000141 cbits = 0x01;
142 break;
143 case GSM_PCHAN_TCH_H:
144 cbits = 0x02;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100145 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000146 break;
147 case GSM_PCHAN_CCCH_SDCCH4:
148 cbits = 0x04;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100149 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000150 break;
151 case GSM_PCHAN_SDCCH8_SACCH8C:
152 cbits = 0x08;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100153 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000154 break;
155 default:
156 case GSM_PCHAN_CCCH:
157 cbits = 0x10;
158 break;
159 }
160
161 chan_nr = (cbits << 3) | (ts->nr & 0x7);
162
163 return chan_nr;
164}
165
Harald Welte53cd7ac2010-12-23 12:59:52 +0100166u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
167{
168 return ts2chan_nr(lchan->ts, lchan->nr);
169}
170
Harald Welte52b1f982008-12-23 20:25:15 +0000171/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
172u_int64_t str_to_imsi(const char *imsi_str)
173{
174 u_int64_t ret;
175
176 ret = strtoull(imsi_str, NULL, 10);
177
178 return ret;
179}
180
181/* Table 5 Clause 7 TS 05.02 */
182unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
183{
184 if (!bs_ccch_sdcch_comb)
185 return 9 - bs_ag_blks_res;
186 else
187 return 3 - bs_ag_blks_res;
188}
189
190/* Chapter 6.5.2 of TS 05.02 */
191unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
192 unsigned int n_pag_blocks)
193{
194 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
195}
196
197/* Chapter 6.5.2 of TS 05.02 */
198unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
199 int n_pag_blocks)
200{
201 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
202}
203
Harald Welte8470bf22008-12-25 23:28:35 +0000204static struct msgb *rsl_msgb_alloc(void)
205{
Harald Welte966636f2009-06-26 19:39:35 +0200206 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
207 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000208}
209
Harald Welte362322e2009-02-15 14:36:38 +0000210#define MACBLOCK_SIZE 23
211static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
212{
213 memcpy(out, in, len);
214
215 if (len < MACBLOCK_SIZE)
216 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
217}
218
Harald Welte08d91a52009-08-30 15:37:11 +0900219/* Chapter 9.3.7: Encryption Information */
220static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
221{
222 *out++ = lchan->encr.alg_id & 0xff;
223 if (lchan->encr.key_len)
224 memcpy(out, lchan->encr.key, lchan->encr.key_len);
225 return lchan->encr.key_len + 1;
226}
227
Harald Welte5b8ed432009-12-24 12:20:20 +0100228static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200229{
Harald Welte7f93cea2009-02-23 00:02:59 +0000230 int i;
231
Harald Welte5b8ed432009-12-24 12:20:20 +0100232 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200233 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200234 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100235 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000236}
237
Harald Welte52b1f982008-12-23 20:25:15 +0000238/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000239int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000240 const u_int8_t *data, int len)
241{
242 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000243 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000244
245 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
246 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
247 dh->chan_nr = RSL_CHAN_BCCH;
248
249 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
250 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
251
Harald Weltee79769b2009-02-07 00:48:17 +0000252 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000253
254 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000255}
256
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200257int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000258 const u_int8_t *data, int len)
259{
260 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000261 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000262
263 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
264 ch->msg_discr = ABIS_RSL_MDISC_TRX;
265 ch->msg_type = RSL_MT_SACCH_FILL;
266
267 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000268 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000269
Harald Weltee79769b2009-02-07 00:48:17 +0000270 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000271
272 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000273}
274
Harald Weltefcd24452009-06-20 18:15:19 +0200275int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
276{
277 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200278 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200279 u_int8_t chan_nr = lchan2chan_nr(lchan);
280
281 db = abs(db);
282 if (db > 30)
283 return -EINVAL;
284
Harald Welteeab33352009-06-27 03:09:08 +0200285 msg = rsl_msgb_alloc();
286
Harald Weltefcd24452009-06-20 18:15:19 +0200287 lchan->bs_power = db/2;
288 if (fpc)
289 lchan->bs_power |= 0x10;
290
291 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
292 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
293 dh->chan_nr = chan_nr;
294
295 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
296
297 msg->trx = lchan->ts->trx;
298
299 return abis_rsl_sendmsg(msg);
300}
301
Harald Weltefcd24452009-06-20 18:15:19 +0200302int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
303{
304 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200305 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200306 u_int8_t chan_nr = lchan2chan_nr(lchan);
307 int ctl_lvl;
308
Harald Welte66b6a8d2009-08-09 14:45:18 +0200309 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200310 if (ctl_lvl < 0)
311 return ctl_lvl;
312
Harald Welteeab33352009-06-27 03:09:08 +0200313 msg = rsl_msgb_alloc();
314
Harald Weltefcd24452009-06-20 18:15:19 +0200315 lchan->ms_power = ctl_lvl;
316
317 if (fpc)
318 lchan->ms_power |= 0x20;
319
320 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
321 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
322 dh->chan_nr = chan_nr;
323
324 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
325
326 msg->trx = lchan->ts->trx;
327
328 return abis_rsl_sendmsg(msg);
329}
330
Harald Welte9943c5b2009-07-29 15:41:29 +0200331static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
332 struct gsm_lchan *lchan)
333{
334 memset(cm, 0, sizeof(cm));
335
336 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800337 if (lchan->ts->trx->bts->network->dtx_enabled)
338 cm->dtx_dtu = 0x03;
339 else
340 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200341
342 /* set TCH Speech/Data */
343 cm->spd_ind = lchan->rsl_cmode;
344
Harald Welte1a79d362009-11-27 08:55:16 +0100345 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
346 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100347 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100348 "but tch_mode != signalling\n");
349
Harald Welte9943c5b2009-07-29 15:41:29 +0200350 switch (lchan->type) {
351 case GSM_LCHAN_SDCCH:
352 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
353 break;
354 case GSM_LCHAN_TCH_F:
355 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
356 break;
357 case GSM_LCHAN_TCH_H:
358 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
359 break;
360 case GSM_LCHAN_NONE:
361 case GSM_LCHAN_UNKNOWN:
362 default:
363 return -EINVAL;
364 }
365
366 switch (lchan->tch_mode) {
367 case GSM48_CMODE_SIGN:
368 cm->chan_rate = 0;
369 break;
370 case GSM48_CMODE_SPEECH_V1:
371 cm->chan_rate = RSL_CMOD_SP_GSM1;
372 break;
373 case GSM48_CMODE_SPEECH_EFR:
374 cm->chan_rate = RSL_CMOD_SP_GSM2;
375 break;
376 case GSM48_CMODE_SPEECH_AMR:
377 cm->chan_rate = RSL_CMOD_SP_GSM3;
378 break;
379 case GSM48_CMODE_DATA_14k5:
380 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
381 break;
382 case GSM48_CMODE_DATA_12k0:
383 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
384 break;
385 case GSM48_CMODE_DATA_6k0:
386 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
387 break;
388 default:
389 return -EINVAL;
390 }
391
392 return 0;
393}
394
Harald Welte52b1f982008-12-23 20:25:15 +0000395/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000396#if 0
Harald Weltee79769b2009-02-07 00:48:17 +0000397int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000398 u_int8_t act_type,
399 struct rsl_ie_chan_mode *chan_mode,
400 struct rsl_ie_chan_ident *chan_ident,
401 u_int8_t bs_power, u_int8_t ms_power,
402 u_int8_t ta)
403{
404 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000405 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000406
407 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
408 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
409 dh->chan_nr = chan_nr;
410
411 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
412 /* For compatibility with Phase 1 */
413 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
414 (u_int8_t *) chan_mode);
415 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Harald Welte702d8702008-12-26 20:25:35 +0000416 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000417#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000418 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
419 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000420#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000421 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000422 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
423 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
424
Harald Weltee79769b2009-02-07 00:48:17 +0000425 msg->trx = trx;
426
Harald Welte8470bf22008-12-25 23:28:35 +0000427 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000428}
Harald Welteddab3c72009-02-28 13:19:15 +0000429#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000430
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200431int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte8d77b952009-12-17 00:31:10 +0100432 u_int8_t ta, u_int8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000433{
434 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200435 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200436 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200437 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000438
439 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000440 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200441 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000442
Harald Welte9943c5b2009-07-29 15:41:29 +0200443 rc = channel_mode_from_lchan(&cm, lchan);
444 if (rc < 0)
445 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000446
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800447 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200448 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000449
Harald Welteeab33352009-06-27 03:09:08 +0200450 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000451 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
452 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
453 dh->chan_nr = chan_nr;
454
455 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000456 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
457 (u_int8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800458
459 /*
460 * The Channel Identification is needed for Phase1 phones
461 * and it contains the GSM48 Channel Description and the
462 * Mobile Allocation. The GSM 08.58 asks for the Mobile
463 * Allocation to have a length of zero. We are using the
464 * msgb_l3len to calculate the length of both messages.
465 */
laforge694a5cf2010-06-20 21:38:19 +0200466 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200467 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800468 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800469
470 if (lchan->ts->hopping.enabled)
471 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
472 lchan->ts->hopping.ma_data);
473 else
474 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800475
476 /* update the calculated size */
477 msg->l3h = len + 1;
478 *len = msgb_l3len(msg);
479
Harald Welte08d91a52009-08-30 15:37:11 +0900480 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
481 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
482 rc = build_encr_info(encr_info, lchan);
483 if (rc > 0)
484 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
485 }
486
Harald Welte8d77b952009-12-17 00:31:10 +0100487 switch (act_type) {
488 case RSL_ACT_INTER_ASYNC:
489 case RSL_ACT_INTER_SYNC:
490 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
491 break;
492 default:
493 break;
494 }
495
Harald Welted4c9bf32009-02-15 16:56:18 +0000496 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
497 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000498 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
499
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100500 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
501 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
502 (u_int8_t *) &lchan->mr_conf);
503
Harald Weltee79769b2009-02-07 00:48:17 +0000504 msg->trx = lchan->ts->trx;
505
Harald Welte4b634542008-12-27 01:55:51 +0000506 return abis_rsl_sendmsg(msg);
507}
508
Harald Welte470abb72009-07-29 11:38:15 +0200509/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000510int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
511{
512 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200513 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200514 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000515
516 u_int8_t chan_nr = lchan2chan_nr(lchan);
517 struct rsl_ie_chan_mode cm;
518
Harald Welte9943c5b2009-07-29 15:41:29 +0200519 rc = channel_mode_from_lchan(&cm, lchan);
520 if (rc < 0)
521 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000522
Harald Welteeab33352009-06-27 03:09:08 +0200523 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000524 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
525 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
526 dh->chan_nr = chan_nr;
527
528 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
529 (u_int8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900530
531 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
532 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
533 rc = build_encr_info(encr_info, lchan);
534 if (rc > 0)
535 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
536 }
537
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100538 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
539 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
540 (u_int8_t *) &lchan->mr_conf);
541 }
542
Harald Welte08d91a52009-08-30 15:37:11 +0900543 msg->trx = lchan->ts->trx;
544
545 return abis_rsl_sendmsg(msg);
546}
547
548/* Chapter 8.4.6: Send the encryption command with given L3 info */
549int rsl_encryption_cmd(struct msgb *msg)
550{
551 struct abis_rsl_dchan_hdr *dh;
552 struct gsm_lchan *lchan = msg->lchan;
553 u_int8_t chan_nr = lchan2chan_nr(lchan);
554 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut82aa6842009-09-27 11:13:18 +0200555 u_int8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900556 int rc;
557
558 /* First push the L3 IE tag and length */
559 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
560
561 /* then the link identifier (SAPI0, main sign link) */
562 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
563
564 /* then encryption information */
565 rc = build_encr_info(encr_info, lchan);
566 if (rc <= 0)
567 return rc;
568 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
569
570 /* and finally the DCHAN header */
571 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
572 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
573 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000574
575 msg->trx = lchan->ts->trx;
576
577 return abis_rsl_sendmsg(msg);
578}
579
Harald Welte115d1032009-08-10 11:43:22 +0200580/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200581int rsl_deact_sacch(struct gsm_lchan *lchan)
582{
583 struct abis_rsl_dchan_hdr *dh;
584 struct msgb *msg = rsl_msgb_alloc();
585
586 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
587 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
588 dh->chan_nr = lchan2chan_nr(lchan);
589
590 msg->lchan = lchan;
591 msg->trx = lchan->ts->trx;
592
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100593 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200594
595 return abis_rsl_sendmsg(msg);
596}
597
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800598static void error_timeout_cb(void *data)
599{
600 struct gsm_lchan *lchan = data;
601 if (lchan->state != LCHAN_S_REL_ERR) {
602 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
603 gsm_lchan_name(lchan), lchan->state);
604 return;
605 }
606
607 /* go back to the none state */
608 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800609 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800610}
611
Harald Welte115d1032009-08-10 11:43:22 +0200612/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800613static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000614{
615 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800616 struct msgb *msg;
Harald Welte52b1f982008-12-23 20:25:15 +0000617
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800618 if (lchan->state == LCHAN_S_REL_ERR) {
619 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
620 gsm_lchan_name(lchan));
621 return -1;
622 }
623
624 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000625 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
626 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000627 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000628
Harald Welte8470bf22008-12-25 23:28:35 +0000629 msg->lchan = lchan;
630 msg->trx = lchan->ts->trx;
631
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800632 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
633
634 if (error) {
635 /*
636 * the nanoBTS sends RLL release indications after the channel release. This can
637 * be a problem when we have reassigned the channel to someone else and then can
638 * not figure out who used this channel.
639 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800640 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800641 lchan->error_timer.data = lchan;
642 lchan->error_timer.cb = error_timeout_cb;
643 bsc_schedule_timer(&lchan->error_timer,
644 msg->trx->bts->network->T3111 + 2, 0);
645 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000646
Harald Welte115d1032009-08-10 11:43:22 +0200647 /* BTS will respond by RF CHAN REL ACK */
Harald Welte8470bf22008-12-25 23:28:35 +0000648 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000649}
650
651int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
652 u_int8_t *ms_ident, u_int8_t chan_needed)
653{
654 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000655 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000656
657 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
658 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
659 dh->chan_nr = RSL_CHAN_PCH_AGCH;
660
661 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000662 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000663 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
664
Harald Welte8470bf22008-12-25 23:28:35 +0000665 msg->trx = bts->c0;
666
667 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000668}
669
670int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
671{
672 int i, len = strlen(str_in);
673
674 for (i = 0; i < len; i++) {
675 int num = str_in[i] - 0x30;
676 if (num < 0 || num > 9)
677 return -1;
678 if (i % 2 == 0)
679 bcd_out[i/2] = num;
680 else
681 bcd_out[i/2] |= (num << 4);
682 }
683
684 return 0;
685}
686
Harald Welte702d8702008-12-26 20:25:35 +0000687/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000688int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
689{
Harald Welte8470bf22008-12-25 23:28:35 +0000690 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000691 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000692 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000693
694 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
695 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
696 dh->chan_nr = RSL_CHAN_PCH_AGCH;
697
Harald Welte362322e2009-02-15 14:36:38 +0000698 switch (bts->type) {
699 case GSM_BTS_TYPE_BS11:
700 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
701 break;
702 default:
703 /* If phase 2, construct a FULL_IMM_ASS_INFO */
704 pad_macblock(buf, val, len);
705 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
706 break;
707 }
Harald Welte52b1f982008-12-23 20:25:15 +0000708
Harald Welte8470bf22008-12-25 23:28:35 +0000709 msg->trx = bts->c0;
710
711 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000712}
713
Harald Welte67fa91b2009-08-10 09:51:40 +0200714/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200715int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200716{
717 struct msgb *msg = rsl_msgb_alloc();
718 struct abis_rsl_dchan_hdr *dh;
719
720 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
721 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200722 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200723 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte31c48932009-08-10 10:07:33 +0200724 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200725
Harald Welte5b8ed432009-12-24 12:20:20 +0100726 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100727 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200728
729 msg->trx = lchan->ts->trx;
730
Harald Welte67fa91b2009-08-10 09:51:40 +0200731 return abis_rsl_sendmsg(msg);
732}
733
734
Harald Welte8470bf22008-12-25 23:28:35 +0000735/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000736/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000737int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000738{
Harald Welte8470bf22008-12-25 23:28:35 +0000739 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100740 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000741 return -EINVAL;
742 }
Harald Welte52b1f982008-12-23 20:25:15 +0000743
Harald Welte3c9c5f92010-03-04 10:33:10 +0100744 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
745 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000746
Harald Welte8470bf22008-12-25 23:28:35 +0000747 msg->trx = msg->lchan->ts->trx;
748
749 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000750}
751
Harald Welteedcc5272009-08-09 13:47:35 +0200752/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
753/* Chapter 8.3.1 */
754int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
755{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100756 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200757
Harald Welte3c9c5f92010-03-04 10:33:10 +0100758 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
759 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200760 msg->trx = lchan->ts->trx;
761
762 return abis_rsl_sendmsg(msg);
763}
764
Harald Welted2dc1de2009-08-08 13:15:07 +0200765/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
766 This is what higher layers should call. The BTS then responds with
767 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
768 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
769 lchan_free() */
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800770int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200771{
Harald Welted2dc1de2009-08-08 13:15:07 +0200772
Harald Welte3c9c5f92010-03-04 10:33:10 +0100773 struct msgb *msg;
774
775 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
776 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800777 /* 0 is normal release, 1 is local end */
778 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200779
Harald Welte8e93b792009-12-29 10:44:17 +0100780 /* FIXME: start some timer in case we don't receive a REL ACK ? */
781
Harald Welted2dc1de2009-08-08 13:15:07 +0200782 msg->trx = lchan->ts->trx;
783
784 return abis_rsl_sendmsg(msg);
785}
786
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200787int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
788{
789 lchan->state = state;
790 return 0;
791}
792
Harald Welte702d8702008-12-26 20:25:35 +0000793/* Chapter 8.4.2: Channel Activate Acknowledge */
794static int rsl_rx_chan_act_ack(struct msgb *msg)
795{
796 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
797
798 /* BTS has confirmed channel activation, we now need
799 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000800 if (rslh->ie_chan != RSL_IE_CHAN_NR)
801 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100802
Harald Welte8e93b792009-12-29 10:44:17 +0100803 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100804 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
805 gsm_lchan_name(msg->lchan),
806 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200807 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100808
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800809 if (msg->lchan->rqd_ref) {
810 rsl_send_imm_assignment(msg->lchan);
811 talloc_free(msg->lchan->rqd_ref);
812 msg->lchan->rqd_ref = NULL;
813 msg->lchan->rqd_ta = 0;
814 }
815
Harald Welted011e8b2009-11-29 22:45:52 +0100816 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
817
Harald Welte4b634542008-12-27 01:55:51 +0000818 return 0;
819}
Harald Welte702d8702008-12-26 20:25:35 +0000820
Harald Welte4b634542008-12-27 01:55:51 +0000821/* Chapter 8.4.3: Channel Activate NACK */
822static int rsl_rx_chan_act_nack(struct msgb *msg)
823{
Harald Welte6dab0552009-05-01 17:21:37 +0000824 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
825 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000826
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100827 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100828 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100829
Harald Welte6dab0552009-05-01 17:21:37 +0000830 /* BTS has rejected channel activation ?!? */
831 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000832 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000833
834 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100835 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
836 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
837 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200838 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100839 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200840 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100841 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200842 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200843
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100844 LOGPC(DRSL, LOGL_ERROR, "\n");
845
Harald Welted011e8b2009-11-29 22:45:52 +0100846 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
847
Harald Welte3073a9f2009-08-09 19:50:08 +0200848 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000849 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000850}
851
Harald Welte7f93cea2009-02-23 00:02:59 +0000852/* Chapter 8.4.4: Connection Failure Indication */
853static int rsl_rx_conn_fail(struct msgb *msg)
854{
855 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
856 struct tlv_parsed tp;
857
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100858 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100859 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100860 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000861
862 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
863
Harald Welte8830e072009-07-28 17:58:09 +0200864 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100865 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200866 TLVP_LEN(&tp, RSL_IE_CAUSE));
867
Harald Welte (local)fc057502009-12-26 22:33:09 +0100868 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000869 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +0200870 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800871 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000872}
873
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100874static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
875 const char *prefix)
876{
Harald Welte6739dfb2009-12-16 16:52:07 +0100877 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
878 prefix, rxlev2dbm(mru->full.rx_lev),
879 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100880 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
881 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
882}
883
884static void print_meas_rep(struct gsm_meas_rep *mr)
885{
Harald Welte6739dfb2009-12-16 16:52:07 +0100886 int i;
887
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100888 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
889
890 if (mr->flags & MEAS_REP_F_DL_DTX)
891 DEBUGPC(DMEAS, "DTXd ");
892
893 print_meas_rep_uni(&mr->ul, "ul");
894 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
895 if (mr->flags & MEAS_REP_F_MS_TO)
896 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
897
898 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100899 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100900 DEBUGPC(DMEAS, "L1_FPC=%u ",
901 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
902 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
903 }
904
905 if (mr->flags & MEAS_REP_F_UL_DTX)
906 DEBUGPC(DMEAS, "DTXu ");
907 if (mr->flags & MEAS_REP_F_BA1)
908 DEBUGPC(DMEAS, "BA1 ");
909 if (!(mr->flags & MEAS_REP_F_DL_VALID))
910 DEBUGPC(DMEAS, "NOT VALID ");
911 else
912 print_meas_rep_uni(&mr->dl, "dl");
913
914 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100915 if (mr->num_cell == 7)
916 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100917 for (i = 0; i < mr->num_cell; i++) {
918 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100919 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
920 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100921 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100922}
923
Harald Welte440fed02009-05-01 18:43:47 +0000924static int rsl_rx_meas_res(struct msgb *msg)
925{
926 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
927 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100928 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100929 u_int8_t len;
930 const u_int8_t *val;
931 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000932
Harald Welteb8bfc562009-12-21 13:27:11 +0100933 /* check if this channel is actually active */
934 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100935 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800936 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100937 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100938 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100939 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100940
Harald Welted12b0fd2009-12-15 21:36:05 +0100941 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100942 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100943
Harald Welte440fed02009-05-01 18:43:47 +0000944 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
945
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100946 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
947 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
948 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
949 return -EIO;
950
951 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100952 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100953
954 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
955 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
956 if (len >= 3) {
957 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100958 mr->flags |= MEAS_REP_F_DL_DTX;
959 mr->ul.full.rx_lev = val[0] & 0x3f;
960 mr->ul.sub.rx_lev = val[1] & 0x3f;
961 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
962 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000963 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100964
Harald Welted12b0fd2009-12-15 21:36:05 +0100965 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100966
967 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000968 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100969 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100970 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
971
Harald Weltefe9af262009-06-20 18:44:35 +0200972 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100973 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100974 mr->flags |= MEAS_REP_F_MS_L1;
975 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100976 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100977 mr->flags |= MEAS_REP_F_FPC;
978 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200979 }
Harald Weltef7c43522009-06-09 20:24:21 +0000980 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherddd918f2009-10-22 15:43:55 +0200981 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100982 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100983 if (rc < 0)
984 return rc;
985 }
986
Harald Welted12b0fd2009-12-15 21:36:05 +0100987 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +0000988
Harald Welted12b0fd2009-12-15 21:36:05 +0100989 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +0100990
Harald Welte75d34a82009-05-23 06:11:13 +0000991 return 0;
Harald Welte440fed02009-05-01 18:43:47 +0000992}
993
Harald Welted011e8b2009-11-29 22:45:52 +0100994/* Chapter 8.4.7 */
995static int rsl_rx_hando_det(struct msgb *msg)
996{
997 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
998 struct tlv_parsed tp;
999
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001000 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001001
1002 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1003
1004 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1005 DEBUGPC(DRSL, "access delay = %u\n",
1006 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1007 else
1008 DEBUGPC(DRSL, "\n");
1009
1010 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1011
1012 return 0;
1013}
1014
Harald Welte52b1f982008-12-23 20:25:15 +00001015static int abis_rsl_rx_dchan(struct msgb *msg)
1016{
Harald Welte8470bf22008-12-25 23:28:35 +00001017 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1018 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001019 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001020
Harald Welte8470bf22008-12-25 23:28:35 +00001021 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001022 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001023
Harald Welte8470bf22008-12-25 23:28:35 +00001024 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001025 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001026 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001027 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001028 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001029 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001030 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001031 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001032 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001033 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001034 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001035 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001036 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001037 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001038 case RSL_MT_HANDO_DET:
1039 rc = rsl_rx_hando_det(msg);
1040 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001041 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001042 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001043 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welte1887f9d2009-12-29 10:52:38 +01001044 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1045 gsm_lchan_name(msg->lchan),
1046 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001047 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001048 /* we have an error timer pending to release that */
1049 if (msg->lchan->state != LCHAN_S_REL_ERR)
1050 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte2d5b6382008-12-27 19:46:06 +00001051 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001052 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001053 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001054 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001055 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001056 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001057 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001058 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001059 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001060 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001061 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001062 break;
1063 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001064 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001065 break;
1066 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001067 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001068 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001069 break;
1070 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001071 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001072 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001073 case RSL_MT_PHY_CONTEXT_CONF:
1074 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001075 case RSL_MT_TALKER_DET:
1076 case RSL_MT_LISTENER_DET:
1077 case RSL_MT_REMOTE_CODEC_CONF_REP:
1078 case RSL_MT_MR_CODEC_MOD_ACK:
1079 case RSL_MT_MR_CODEC_MOD_NACK:
1080 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001081 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1082 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001083 break;
1084 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001085 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1086 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001087 return -EINVAL;
1088 }
Harald Weltef325eb42009-02-19 17:07:39 +00001089
Harald Welte8470bf22008-12-25 23:28:35 +00001090 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001091}
1092
Harald Welte702d8702008-12-26 20:25:35 +00001093static int rsl_rx_error_rep(struct msgb *msg)
1094{
1095 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001096 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001097
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001098 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001099
1100 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1101
1102 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001103 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001104 TLVP_LEN(&tp, RSL_IE_CAUSE));
1105
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001106 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001107
1108 return 0;
1109}
1110
Harald Welte52b1f982008-12-23 20:25:15 +00001111static int abis_rsl_rx_trx(struct msgb *msg)
1112{
Harald Welte702d8702008-12-26 20:25:35 +00001113 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001114 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001115
1116 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001117 case RSL_MT_ERROR_REPORT:
1118 rc = rsl_rx_error_rep(msg);
1119 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001120 case RSL_MT_RF_RES_IND:
1121 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001122 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001123 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001124 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001125 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001126 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1127 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001128 break;
1129 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001130 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1131 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001132 return -EINVAL;
1133 }
Harald Welte8470bf22008-12-25 23:28:35 +00001134 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001135}
1136
Harald Welteb7e81162009-08-10 00:26:10 +02001137/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1138static void t3101_expired(void *data)
1139{
1140 struct gsm_lchan *lchan = data;
1141
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001142 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001143}
1144
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001145/* If T3111 expires, we will send the RF Channel Request */
1146static void t3111_expired(void *data)
1147{
1148 struct gsm_lchan *lchan = data;
1149
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001150 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001151}
1152
laforgecfa4a012010-06-21 12:08:52 +02001153#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1154
Harald Welte8470bf22008-12-25 23:28:35 +00001155/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001156static int rsl_rx_chan_rqd(struct msgb *msg)
1157{
Harald Welte702d8702008-12-26 20:25:35 +00001158 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001159 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1160 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001161 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001162 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001163 struct gsm_lchan *lchan;
1164 u_int8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001165 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001166
Harald Welte52b1f982008-12-23 20:25:15 +00001167 u_int16_t arfcn;
1168 u_int8_t ts_number, subch;
1169
Harald Welte8470bf22008-12-25 23:28:35 +00001170 /* parse request reference to be used in immediate assign */
1171 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1172 return -EINVAL;
1173
1174 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1175
1176 /* parse access delay and use as TA */
1177 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1178 return -EINVAL;
1179 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1180
1181 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1182 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001183 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1184 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001185
Harald Welteffa55a42009-12-22 19:07:32 +01001186 counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001187
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001188 /*
1189 * We want LOCATION UPDATES to succeed and will assign a TCH
1190 * if we have no SDCCH available.
1191 */
1192 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1193
Harald Welte8470bf22008-12-25 23:28:35 +00001194 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001195 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001196 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001197 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001198 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Welteffa55a42009-12-22 19:07:32 +01001199 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte8470bf22008-12-25 23:28:35 +00001200 /* FIXME: send some kind of reject ?!? */
1201 return -ENOMEM;
1202 }
1203
Harald Welte8e93b792009-12-29 10:44:17 +01001204 if (lchan->state != LCHAN_S_NONE)
1205 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001206 "in state %s\n", gsm_lchan_name(lchan),
1207 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001208 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001209
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001210 /* save the RACH data as we need it after the CHAN ACT ACK */
1211 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1212 if (!lchan->rqd_ref) {
1213 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1214 lchan_free(lchan);
1215 return -ENOMEM;
1216 }
1217
1218 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1219 lchan->rqd_ta = rqd_ta;
1220
Harald Welte8470bf22008-12-25 23:28:35 +00001221 ts_number = lchan->ts->nr;
1222 arfcn = lchan->ts->trx->arfcn;
1223 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001224
Harald Welte08d91a52009-08-30 15:37:11 +09001225 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001226 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001227 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001228 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001229 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001230
1231 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001232 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001233
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001234 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1235 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1236 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1237 rqd_ref->ra);
1238 return 0;
1239}
1240
1241static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1242{
1243 struct gsm_bts *bts = lchan->ts->trx->bts;
1244 u_int8_t buf[GSM_MACBLOCK_LEN];
1245 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1246
Harald Welte52b1f982008-12-23 20:25:15 +00001247 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001248 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001249 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001250 ia->proto_discr = GSM48_PDISC_RR;
1251 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1252 ia->page_mode = GSM48_PM_SAME;
1253 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001254
Harald Welte8470bf22008-12-25 23:28:35 +00001255 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001256 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1257 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001258 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001259 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001260 } else {
laforge09108bf2010-06-20 15:18:46 +02001261 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1262 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001263 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001264 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1265 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001266
Harald Welteb7e81162009-08-10 00:26:10 +02001267 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1268 lchan->T3101.cb = t3101_expired;
1269 lchan->T3101.data = lchan;
Holger Hans Peter Freytherc4d88ad2009-11-21 21:18:38 +01001270 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001271
Harald Welte52b1f982008-12-23 20:25:15 +00001272 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001273 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001274}
1275
Harald Welteea280442009-02-02 22:29:56 +00001276/* MS has requested a channel on the RACH */
1277static int rsl_rx_ccch_load(struct msgb *msg)
1278{
1279 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1280 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +00001281 u_int16_t rach_slot_count = -1;
1282 u_int16_t rach_busy_count = -1;
1283 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001284
1285 switch (rslh->data[0]) {
1286 case RSL_IE_PAGING_LOAD:
1287 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001288 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1289 /* paging load below configured threshold, use 50 as default */
1290 pg_buf_space = 50;
1291 }
Holger Freyther392209c2009-02-10 00:06:19 +00001292 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001293 break;
1294 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001295 if (msg->data_len >= 7) {
1296 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1297 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1298 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1299 }
Harald Welteea280442009-02-02 22:29:56 +00001300 break;
1301 default:
1302 break;
1303 }
1304
1305 return 0;
1306}
1307
Harald Welte52b1f982008-12-23 20:25:15 +00001308static int abis_rsl_rx_cchan(struct msgb *msg)
1309{
Harald Welteea280442009-02-02 22:29:56 +00001310 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001311 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001312
Harald Welte8470bf22008-12-25 23:28:35 +00001313 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1314
1315 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001316 case RSL_MT_CHAN_RQD:
1317 /* MS has requested a channel on the RACH */
1318 rc = rsl_rx_chan_rqd(msg);
1319 break;
Harald Welteea280442009-02-02 22:29:56 +00001320 case RSL_MT_CCCH_LOAD_IND:
1321 /* current load on the CCCH */
1322 rc = rsl_rx_ccch_load(msg);
1323 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001324 case RSL_MT_DELETE_IND:
1325 /* CCCH overloaded, IMM_ASSIGN was dropped */
1326 case RSL_MT_CBCH_LOAD_IND:
1327 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001328 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1329 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001330 break;
1331 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001332 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1333 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001334 return -EINVAL;
1335 }
Harald Welte8470bf22008-12-25 23:28:35 +00001336
1337 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001338}
1339
Harald Welte4b634542008-12-27 01:55:51 +00001340static int rsl_rx_rll_err_ind(struct msgb *msg)
1341{
1342 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1343 u_int8_t *rlm_cause = rllh->data;
1344
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001345 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001346 gsm_lchan_name(msg->lchan),
Harald Weltee95daf192010-03-25 12:13:02 +08001347 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001348
1349 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001350
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001351 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1352 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001353 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001354 }
Harald Welte81543bc2009-07-04 09:40:05 +02001355
Harald Welte4b634542008-12-27 01:55:51 +00001356 return 0;
1357}
Harald Weltef325eb42009-02-19 17:07:39 +00001358
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001359static void rsl_handle_release(struct gsm_lchan *lchan)
1360{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001361 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001362 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001363
1364 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001365 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001366 return;
1367
1368 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1369 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1370 continue;
1371 LOGP(DRSL, LOGL_NOTICE, "%s waiting for SAPI=%d to be released.\n",
1372 gsm_lchan_name(lchan), sapi);
1373 return;
1374 }
1375
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001376
1377
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001378 /* wait a bit to send the RF Channel Release */
1379 lchan->T3111.cb = t3111_expired;
1380 lchan->T3111.data = lchan;
1381 bts = lchan->ts->trx->bts;
1382 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001383}
1384
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001385/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001386 0x02, 0x06,
1387 0x01, 0x20,
1388 0x02, 0x00,
1389 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1390
1391static int abis_rsl_rx_rll(struct msgb *msg)
1392{
1393 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001394 int rc = 0;
1395 char *ts_name;
Harald Welte (local)daef6062009-08-14 11:41:12 +02001396 u_int8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001397
1398 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001399 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001400 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001401
1402 switch (rllh->c.msg_type) {
1403 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001404 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001405 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001406 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1407 rllh->data[0] == RSL_IE_L3_INFO) {
1408 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001409 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001410 }
Harald Welte52b1f982008-12-23 20:25:15 +00001411 break;
1412 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001413 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001414 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001415 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welteb7e81162009-08-10 00:26:10 +02001416 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001417 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001418 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1419 rllh->data[0] == RSL_IE_L3_INFO) {
1420 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001421 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001422 }
Harald Welte52b1f982008-12-23 20:25:15 +00001423 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001424 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001425 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001426 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001427 rll_indication(msg->lchan, rllh->link_id,
1428 BSC_RLLR_IND_EST_CONF);
1429 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001430 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001431 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001432 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001433 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001434 rll_indication(msg->lchan, rllh->link_id,
1435 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001436 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001437 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001438 break;
1439 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001440 /* BTS informs us of having received UA from MS,
1441 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001442 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001443 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001444 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001445 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001446 break;
1447 case RSL_MT_ERROR_IND:
1448 rc = rsl_rx_rll_err_ind(msg);
1449 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001450 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001451 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1452 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001453 break;
1454 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001455 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1456 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001457 }
Harald Welte8470bf22008-12-25 23:28:35 +00001458 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001459}
1460
Harald Welte0603c9d2009-12-02 01:58:23 +05301461static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001462{
Harald Welte0603c9d2009-12-02 01:58:23 +05301463 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001464 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301465 switch (lchan->type) {
1466 case GSM_LCHAN_TCH_F:
1467 return 0x00;
1468 case GSM_LCHAN_TCH_H:
1469 return 0x03;
1470 default:
1471 break;
1472 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001473 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301474 switch (lchan->type) {
1475 case GSM_LCHAN_TCH_F:
1476 return 0x01;
1477 /* there's no half-rate EFR */
1478 default:
1479 break;
1480 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001481 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301482 switch (lchan->type) {
1483 case GSM_LCHAN_TCH_F:
1484 return 0x02;
1485 case GSM_LCHAN_TCH_H:
1486 return 0x05;
1487 default:
1488 break;
1489 }
1490 default:
1491 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001492 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001493 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301494 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001495 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001496}
1497
Sylvain Munautb54dda42009-12-20 22:06:40 +01001498static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1499{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001500 struct gsm_network *net = lchan->ts->trx->bts->network;
1501
1502 /* allow to hardcode the rtp payload */
1503 if (net->hardcoded_rtp_payload != 0)
1504 return net->hardcoded_rtp_payload;
1505
Sylvain Munautb54dda42009-12-20 22:06:40 +01001506 switch (lchan->tch_mode) {
1507 case GSM48_CMODE_SPEECH_V1:
1508 switch (lchan->type) {
1509 case GSM_LCHAN_TCH_F:
1510 return RTP_PT_GSM_FULL;
1511 case GSM_LCHAN_TCH_H:
1512 return RTP_PT_GSM_HALF;
1513 default:
1514 break;
1515 }
1516 case GSM48_CMODE_SPEECH_EFR:
1517 switch (lchan->type) {
1518 case GSM_LCHAN_TCH_F:
1519 return RTP_PT_GSM_EFR;
1520 /* there's no half-rate EFR */
1521 default:
1522 break;
1523 }
1524 case GSM48_CMODE_SPEECH_AMR:
1525 switch (lchan->type) {
1526 case GSM_LCHAN_TCH_F:
1527 return RTP_PT_AMR_FULL;
1528 case GSM_LCHAN_TCH_H:
1529 return RTP_PT_AMR_HALF;
1530 default:
1531 break;
1532 }
1533 default:
1534 break;
1535 }
1536 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1537 "tch_mode == 0x%02x\n & lchan_type == %d",
1538 lchan->tch_mode, lchan->type);
1539 return 0;
1540}
1541
Harald Welte75099262009-02-16 21:12:08 +00001542/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001543static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1544{
1545 struct in_addr ip;
1546 u_int16_t port, conn_id;
1547
1548 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1549 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1550 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1551 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1552 }
1553
1554 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1555 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1556 port = ntohs(port);
1557 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1558 lchan->abis_ip.bound_port = port;
1559 }
1560
1561 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1562 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1563 conn_id = ntohs(conn_id);
1564 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1565 lchan->abis_ip.conn_id = conn_id;
1566 }
1567
1568 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1569 lchan->abis_ip.rtp_payload2 =
1570 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1571 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1572 lchan->abis_ip.rtp_payload2);
1573 }
1574
1575 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1576 lchan->abis_ip.speech_mode =
1577 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1578 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1579 lchan->abis_ip.speech_mode);
1580 }
1581
1582 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1583 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1584 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1585 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1586 }
1587
1588 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1589 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1590 port = ntohs(port);
1591 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1592 lchan->abis_ip.connect_port = port;
1593 }
1594}
1595
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001596int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001597{
1598 struct msgb *msg = rsl_msgb_alloc();
1599 struct abis_rsl_dchan_hdr *dh;
1600
1601 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001602 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001603 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1604 dh->chan_nr = lchan2chan_nr(lchan);
1605
Harald Weltef4e79f22009-07-28 18:11:56 +02001606 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001607 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001608 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001609 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001610 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001611
Sylvain Munautb54dda42009-12-20 22:06:40 +01001612 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1613 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1614 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001615
Harald Welte75099262009-02-16 21:12:08 +00001616 msg->trx = lchan->ts->trx;
1617
1618 return abis_rsl_sendmsg(msg);
1619}
1620
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001621int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte5e3d91b2009-12-19 16:42:06 +01001622 u_int8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001623{
1624 struct msgb *msg = rsl_msgb_alloc();
1625 struct abis_rsl_dchan_hdr *dh;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001626 u_int32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001627 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001628
1629 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001630 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001631 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1632 dh->chan_nr = lchan2chan_nr(lchan);
1633
Harald Welte5e3d91b2009-12-19 16:42:06 +01001634 /* we need to store these now as MDCX_ACK does not return them :( */
1635 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1636 lchan->abis_ip.connect_port = port;
1637 lchan->abis_ip.connect_ip = ip;
1638
Harald Welte58ca5b72009-07-29 12:12:18 +02001639 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001640 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001641 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001642
Harald Weltef4e79f22009-07-28 18:11:56 +02001643 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001644 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1645 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1646 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1647 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001648
Harald Welte5e3d91b2009-12-19 16:42:06 +01001649 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1650 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1651 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1652 *att_ip = ia.s_addr;
1653 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1654 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001655 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001656 if (rtp_payload2)
1657 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1658
Harald Welte75099262009-02-16 21:12:08 +00001659 msg->trx = lchan->ts->trx;
1660
1661 return abis_rsl_sendmsg(msg);
1662}
1663
Harald Weltea72273e2009-12-20 16:51:09 +01001664/* tell BTS to connect RTP stream to our local RTP socket */
1665int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1666{
1667 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1668 int rc;
1669
1670 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1671 ntohs(rs->rtp.sin_local.sin_port),
1672 /* FIXME: use RTP payload of bound socket, not BTS*/
1673 lchan->abis_ip.rtp_payload2);
1674
1675 return rc;
1676}
1677
Harald Welte53cd7ac2010-12-23 12:59:52 +01001678int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001679{
1680 struct msgb *msg = rsl_msgb_alloc();
1681 struct abis_rsl_dchan_hdr *dh;
Harald Welte4563eab2010-03-28 14:42:09 +08001682 u_int8_t msg_type;
1683
1684 if (act)
1685 msg_type = RSL_MT_IPAC_PDCH_ACT;
1686 else
1687 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001688
1689 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001690 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001691 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte53cd7ac2010-12-23 12:59:52 +01001692 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001693
Harald Welte53cd7ac2010-12-23 12:59:52 +01001694 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001695 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001696
Harald Welte53cd7ac2010-12-23 12:59:52 +01001697 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001698
1699 return abis_rsl_sendmsg(msg);
1700}
1701
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001702static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001703{
1704 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1705 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301706 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001707
1708 /* the BTS has acknowledged a local bind, it now tells us the IP
1709 * address and port number to which it has bound the given logical
1710 * channel */
1711
1712 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1713 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1714 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001715 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001716 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001717 return -EINVAL;
1718 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001719
Harald Welte5e3d91b2009-12-19 16:42:06 +01001720 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001721
1722 /* in case we don't use direct BTS-to-BTS RTP */
1723 if (!ipacc_rtp_direct) {
1724 int rc;
1725 /* the BTS has successfully bound a TCH to a local ip/port,
1726 * which means we can connect our UDP socket to it */
1727 if (lchan->abis_ip.rtp_socket) {
1728 rtp_socket_free(lchan->abis_ip.rtp_socket);
1729 lchan->abis_ip.rtp_socket = NULL;
1730 }
1731
1732 lchan->abis_ip.rtp_socket = rtp_socket_create();
1733 if (!lchan->abis_ip.rtp_socket)
1734 goto out_err;
1735
1736 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1737 lchan->abis_ip.bound_ip,
1738 lchan->abis_ip.bound_port);
1739 if (rc < 0)
1740 goto out_err;
1741 }
1742
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001743 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001744
Harald Welte75099262009-02-16 21:12:08 +00001745 return 0;
Harald Welte17f5bf62009-12-20 15:42:44 +01001746out_err:
1747 return -EIO;
Harald Welte75099262009-02-16 21:12:08 +00001748}
1749
Harald Welte5e3d91b2009-12-19 16:42:06 +01001750static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1751{
1752 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1753 struct tlv_parsed tv;
1754 struct gsm_lchan *lchan = msg->lchan;
1755
1756 /* the BTS has acknowledged a remote connect request and
1757 * it now tells us the IP address and port number to which it has
1758 * connected the given logical channel */
1759
1760 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1761 ipac_parse_rtp(lchan, &tv);
1762 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1763
1764 return 0;
1765}
1766
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001767static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001768{
1769 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1770 struct tlv_parsed tv;
Harald Welte17f5bf62009-12-20 15:42:44 +01001771 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001772
1773 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001774
Harald Welte8830e072009-07-28 17:58:09 +02001775 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001776 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001777 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001778
Harald Welte17f5bf62009-12-20 15:42:44 +01001779 /* the BTS tells us a RTP stream has been disconnected */
1780 if (lchan->abis_ip.rtp_socket) {
1781 rtp_socket_free(lchan->abis_ip.rtp_socket);
1782 lchan->abis_ip.rtp_socket = NULL;
1783 }
1784
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001785 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001786
Harald Welte75099262009-02-16 21:12:08 +00001787 return 0;
1788}
1789
1790static int abis_rsl_rx_ipacc(struct msgb *msg)
1791{
1792 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001793 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001794 int rc = 0;
1795
1796 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001797 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001798
1799 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001800 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001801 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001802 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001803 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001804 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001805 /* somehow the BTS was unable to bind the lchan to its local
1806 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001807 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001808 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001809 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001810 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001811 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001812 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001813 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001814 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001815 /* somehow the BTS was unable to connect the lchan to a remote
1816 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001817 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001818 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001819 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001820 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001821 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001822 break;
1823 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001824 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001825 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001826 break;
1827 }
Harald Welte6dab0552009-05-01 17:21:37 +00001828 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001829
1830 return rc;
1831}
1832
1833
Harald Welte52b1f982008-12-23 20:25:15 +00001834/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001835int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001836{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001837 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001838 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001839
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001840 if (!msg) {
1841 DEBUGP(DRSL, "Empty RSL msg?..\n");
1842 return -1;
1843 }
1844
1845 if (msgb_l2len(msg) < sizeof(*rslh)) {
1846 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1847 return -1;
1848 }
1849
1850 rslh = msgb_l2(msg);
1851
Harald Welte52b1f982008-12-23 20:25:15 +00001852 switch (rslh->msg_discr & 0xfe) {
1853 case ABIS_RSL_MDISC_RLL:
1854 rc = abis_rsl_rx_rll(msg);
1855 break;
1856 case ABIS_RSL_MDISC_DED_CHAN:
1857 rc = abis_rsl_rx_dchan(msg);
1858 break;
1859 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001860 rc = abis_rsl_rx_cchan(msg);
1861 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001862 case ABIS_RSL_MDISC_TRX:
1863 rc = abis_rsl_rx_trx(msg);
1864 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001865 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001866 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001867 rslh->msg_discr);
1868 break;
Harald Welte75099262009-02-16 21:12:08 +00001869 case ABIS_RSL_MDISC_IPACCESS:
1870 rc = abis_rsl_rx_ipacc(msg);
1871 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001872 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001873 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1874 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001875 return -EINVAL;
1876 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001877 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001878 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001879}
Holger Freyther3b72a892009-02-04 00:31:39 +00001880
Holger Freyther3b72a892009-02-04 00:31:39 +00001881/* From Table 10.5.33 of GSM 04.08 */
1882int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1883{
Harald Weltea43f7892009-12-01 18:04:30 +05301884 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1885 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1886 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001887 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301888 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1889 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001890 }
1891}
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001892
1893int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1894 uint8_t cb_command, const uint8_t *data, int len)
1895{
1896 struct abis_rsl_dchan_hdr *dh;
1897 struct msgb *cb_cmd;
1898
1899 cb_cmd = rsl_msgb_alloc();
1900 if (!cb_cmd)
1901 return -1;
1902
1903 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1904 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1905 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1906
1907 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1908 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1909
1910 cb_cmd->trx = bts->c0;
1911
1912 return abis_rsl_sendmsg(cb_cmd);
1913}