blob: 52ed9fa5b2d3895f4612a195413ce1f1e098a189 [file] [log] [blame]
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte59b04682009-06-10 05:40:52 +08002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Weltea22d36b2010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte59b04682009-06-10 05:40:52 +08005 *
6 * 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>
25#include <stdlib.h>
26#include <errno.h>
27#include <sys/types.h>
28#include <netinet/in.h>
29#include <arpa/inet.h>
30
31#include <openbsc/gsm_data.h>
32#include <openbsc/gsm_04_08.h>
Harald Weltef4625b12010-02-20 16:24:02 +010033#include <osmocore/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080034#include <openbsc/abis_rsl.h>
35#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020036#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080037#include <openbsc/debug.h>
Harald Weltef4625b12010-02-20 16:24:02 +010038#include <osmocore/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080039#include <openbsc/paging.h>
40#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010041#include <openbsc/meas_rep.h>
Harald Welte50517742009-12-20 15:42:44 +010042#include <openbsc/rtp_proxy.h>
Harald Welte1fa8bac2010-03-01 21:59:06 +010043#include <osmocore/rsl.h>
Harald Welte59b04682009-06-10 05:40:52 +080044
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080045#include <osmocore/talloc.h>
46
Harald Welte59b04682009-06-10 05:40:52 +080047#define RSL_ALLOC_SIZE 1024
48#define RSL_ALLOC_HEADROOM 128
49
50#define MAX(a, b) (a) >= (b) ? (a) : (b)
51
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080052static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
53
Harald Welte59b04682009-06-10 05:40:52 +080054static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
55{
56 /* mask off the transparent bit ? */
57 msg_type &= 0xfe;
58
59 if ((msg_type & 0xf0) == 0x00)
60 return ABIS_RSL_MDISC_RLL;
61 if ((msg_type & 0xf0) == 0x10) {
62 if (msg_type >= 0x19 && msg_type <= 0x22)
63 return ABIS_RSL_MDISC_TRX;
64 else
65 return ABIS_RSL_MDISC_COM_CHAN;
66 }
67 if ((msg_type & 0xe0) == 0x20)
68 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 Welte59b04682009-06-10 05:40:52 +080081/* 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 Welte37884ed2009-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 Weltecf2ec4a2009-12-17 23:10:46 +010095 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +080096 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 Weltecf2ec4a2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800101 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 Weltecf2ec4a2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800106 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 Weltecf2ec4a2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800111 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 Weltecf2ec4a2009-12-17 23:10:46 +0100116 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800117 chan_nr, ts->pchan);
118 /* FIXME: we should not return first sdcch4 !!! */
119 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100120 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800121 return NULL;
122 }
123
124 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800125 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800126 if (lchan->conn)
127 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800128
129 return lchan;
130}
131
Holger Hans Peter Freyther942ff172009-10-22 11:47:45 +0200132/* See Table 10.5.25 of GSM04.08 */
Harald Welte6f40df02010-12-23 12:59:52 +0100133static u_int8_t ts2chan_nr(const struct gsm_bts_trx_ts *ts, uint8_t lchan_nr)
Harald Welte59b04682009-06-10 05:40:52 +0800134{
Harald Welte59b04682009-06-10 05:40:52 +0800135 u_int8_t cbits, chan_nr;
136
137 switch (ts->pchan) {
138 case GSM_PCHAN_TCH_F:
Harald Welte37884ed2009-10-24 10:25:50 +0200139 case GSM_PCHAN_PDCH:
140 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte59b04682009-06-10 05:40:52 +0800141 cbits = 0x01;
142 break;
143 case GSM_PCHAN_TCH_H:
144 cbits = 0x02;
Harald Welte6f40df02010-12-23 12:59:52 +0100145 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800146 break;
147 case GSM_PCHAN_CCCH_SDCCH4:
148 cbits = 0x04;
Harald Welte6f40df02010-12-23 12:59:52 +0100149 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800150 break;
151 case GSM_PCHAN_SDCCH8_SACCH8C:
152 cbits = 0x08;
Harald Welte6f40df02010-12-23 12:59:52 +0100153 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800154 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 Welte6f40df02010-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 Welte59b04682009-06-10 05:40:52 +0800171/* 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
204static struct msgb *rsl_msgb_alloc(void)
205{
Harald Welte9cfc9352009-06-26 19:39:35 +0200206 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
207 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800208}
209
210#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 Welted2dd9de2009-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 Weltede4477a2009-12-24 12:20:20 +0100228static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200229{
Harald Welte59b04682009-06-10 05:40:52 +0800230 int i;
231
Harald Weltede4477a2009-12-24 12:20:20 +0100232 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200233 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200234 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100235 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800236}
237
238/* Send a BCCH_INFO message as per Chapter 8.5.1 */
239int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
240 const u_int8_t *data, int len)
241{
242 struct abis_rsl_dchan_hdr *dh;
243 struct msgb *msg = rsl_msgb_alloc();
244
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
252 msg->trx = trx;
253
254 return abis_rsl_sendmsg(msg);
255}
256
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200257int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte59b04682009-06-10 05:40:52 +0800258 const u_int8_t *data, int len)
259{
260 struct abis_rsl_common_hdr *ch;
261 struct msgb *msg = rsl_msgb_alloc();
262
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);
268 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
269
270 msg->trx = trx;
271
272 return abis_rsl_sendmsg(msg);
273}
274
Harald Welte91afe4c2009-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 Welteed831842009-06-27 03:09:08 +0200278 struct msgb *msg;
Harald Welte91afe4c2009-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 Welteed831842009-06-27 03:09:08 +0200285 msg = rsl_msgb_alloc();
286
Harald Welte91afe4c2009-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 Welte91afe4c2009-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 Welteed831842009-06-27 03:09:08 +0200305 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200306 u_int8_t chan_nr = lchan2chan_nr(lchan);
307 int ctl_lvl;
308
Harald Weltec4dcda02009-08-09 14:45:18 +0200309 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200310 if (ctl_lvl < 0)
311 return ctl_lvl;
312
Harald Welteed831842009-06-27 03:09:08 +0200313 msg = rsl_msgb_alloc();
314
Harald Welte91afe4c2009-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 Welte39274f42009-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 Freyther21d63ff2010-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 Welte39274f42009-07-29 15:41:29 +0200341
342 /* set TCH Speech/Data */
343 cm->spd_ind = lchan->rsl_cmode;
344
Harald Welte951e3512009-11-27 08:55:16 +0100345 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
346 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100347 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100348 "but tch_mode != signalling\n");
349
Harald Welte39274f42009-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 Welte59b04682009-06-10 05:40:52 +0800395/* Chapter 8.4.1 */
396#if 0
397int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
398 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;
405 struct msgb *msg = rsl_msgb_alloc();
406
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,
416 (u_int8_t *) chan_ident);
417#if 0
418 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
419 (u_int8_t *) &encr_info);
420#endif
421 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
422 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
423 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
424
425 msg->trx = trx;
426
427 return abis_rsl_sendmsg(msg);
428}
429#endif
430
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200431int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welteb90d7bd2009-12-17 00:31:10 +0100432 u_int8_t ta, u_int8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800433{
434 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200435 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200436 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200437 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800438
439 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800440 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200441 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800442
Harald Welte39274f42009-07-29 15:41:29 +0200443 rc = channel_mode_from_lchan(&cm, lchan);
444 if (rc < 0)
445 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800446
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800447 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200448 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800449
Harald Welteed831842009-06-27 03:09:08 +0200450 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800451 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 Welte59b04682009-06-10 05:40:52 +0800456 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
457 (u_int8_t *) &cm);
Holger Hans Peter Freyther11b01402010-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 */
laforgef723cf02010-06-20 21:38:19 +0200466 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200467 len = msgb_put(msg, 1);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800468 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-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 Freyther11b01402010-06-30 11:56:43 +0800475
476 /* update the calculated size */
477 msg->l3h = len + 1;
478 *len = msgb_l3len(msg);
479
Harald Welted2dd9de2009-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 Welteb90d7bd2009-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 Welte59b04682009-06-10 05:40:52 +0800496 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
497 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
498 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
499
Holger Hans Peter Freyther6fe8ab92010-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 Welte59b04682009-06-10 05:40:52 +0800504 msg->trx = lchan->ts->trx;
505
506 return abis_rsl_sendmsg(msg);
507}
508
Harald Welte8e770492009-07-29 11:38:15 +0200509/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800510int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
511{
512 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200513 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200514 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800515
516 u_int8_t chan_nr = lchan2chan_nr(lchan);
517 struct rsl_ie_chan_mode cm;
518
Harald Welte39274f42009-07-29 15:41:29 +0200519 rc = channel_mode_from_lchan(&cm, lchan);
520 if (rc < 0)
521 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800522
Harald Welteed831842009-06-27 03:09:08 +0200523 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800524 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 Welted2dd9de2009-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 Freyther3cce58f2009-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 Welted2dd9de2009-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 Munaut01f1caf2009-09-27 11:13:18 +0200555 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-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 Welte59b04682009-06-10 05:40:52 +0800574
575 msg->trx = lchan->ts->trx;
576
577 return abis_rsl_sendmsg(msg);
578}
579
Harald Welte85a163c2009-08-10 11:43:22 +0200580/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-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)c4e9c9c2009-12-27 18:16:36 +0100593 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200594
595 return abis_rsl_sendmsg(msg);
596}
597
Holger Hans Peter Freyther10ea12f2010-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 Freyther456fb9d2010-06-08 11:53:33 +0800609 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800610}
611
Harald Welte85a163c2009-08-10 11:43:22 +0200612/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800613static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800614{
615 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800616 struct msgb *msg;
Harald Welte59b04682009-06-10 05:40:52 +0800617
Holger Hans Peter Freyther10ea12f2010-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 Welte59b04682009-06-10 05:40:52 +0800625 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
626 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
627 dh->chan_nr = lchan2chan_nr(lchan);
628
629 msg->lchan = lchan;
630 msg->trx = lchan->ts->trx;
631
Holger Hans Peter Freyther10ea12f2010-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 Freyther456fb9d2010-06-08 11:53:33 +0800640 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-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 Welte59b04682009-06-10 05:40:52 +0800646
Harald Welte85a163c2009-08-10 11:43:22 +0200647 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800648 return abis_rsl_sendmsg(msg);
649}
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;
655 struct msgb *msg = rsl_msgb_alloc();
656
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);
662 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
663 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
664
665 msg->trx = bts->c0;
666
667 return abis_rsl_sendmsg(msg);
668}
669
Harald Welte59b04682009-06-10 05:40:52 +0800670int 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
687/* Chapter 8.5.6 */
688int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
689{
690 struct msgb *msg = rsl_msgb_alloc();
691 struct abis_rsl_dchan_hdr *dh;
692 u_int8_t buf[MACBLOCK_SIZE];
693
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
698 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 }
708
709 msg->trx = bts->c0;
710
711 return abis_rsl_sendmsg(msg);
712}
713
Harald Welte4684e632009-08-10 09:51:40 +0200714/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200715int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-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 Welte874a5b42009-08-10 11:26:14 +0200722 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200723 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200724 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200725
Harald Weltede4477a2009-12-24 12:20:20 +0100726 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100727 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200728
729 msg->trx = lchan->ts->trx;
730
Harald Welte4684e632009-08-10 09:51:40 +0200731 return abis_rsl_sendmsg(msg);
732}
733
734
Harald Welte59b04682009-06-10 05:40:52 +0800735/* Send "DATA REQUEST" message with given L3 Info payload */
736/* Chapter 8.3.1 */
737int rsl_data_request(struct msgb *msg, u_int8_t link_id)
738{
Harald Welte59b04682009-06-10 05:40:52 +0800739 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100740 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800741 return -EINVAL;
742 }
743
Harald Weltea22d36b2010-03-04 10:33:10 +0100744 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
745 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800746
747 msg->trx = msg->lchan->ts->trx;
748
749 return abis_rsl_sendmsg(msg);
750}
751
Harald Welteed9a5ab2009-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 Weltea22d36b2010-03-04 10:33:10 +0100756 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200757
Harald Weltea22d36b2010-03-04 10:33:10 +0100758 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
759 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200760 msg->trx = lchan->ts->trx;
761
762 return abis_rsl_sendmsg(msg);
763}
764
Harald Welte0f2e3c12009-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 Freytherbcea9a72010-06-08 11:57:45 +0800770int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200771{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200772
Harald Weltea22d36b2010-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 Freytherbcea9a72010-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 Welte0f2e3c12009-08-08 13:15:07 +0200779
Harald Weltec88a4432009-12-29 10:44:17 +0100780 /* FIXME: start some timer in case we don't receive a REL ACK ? */
781
Harald Welte0f2e3c12009-08-08 13:15:07 +0200782 msg->trx = lchan->ts->trx;
783
784 return abis_rsl_sendmsg(msg);
785}
786
Holger Hans Peter Freyther68914a02010-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 Welte59b04682009-06-10 05:40:52 +0800793/* 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 */
800 if (rslh->ie_chan != RSL_IE_CHAN_NR)
801 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100802
Harald Weltec88a4432009-12-29 10:44:17 +0100803 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-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 Freyther68914a02010-04-10 00:12:31 +0200807 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100808
Holger Hans Peter Freytherc08f6f02010-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 Welte6720a432009-11-29 22:45:52 +0100816 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
817
Harald Welte59b04682009-06-10 05:40:52 +0800818 return 0;
819}
820
821/* Chapter 8.4.3: Channel Activate NACK */
822static int rsl_rx_chan_act_nack(struct msgb *msg)
823{
824 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
825 struct tlv_parsed tp;
826
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100827 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100828 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100829
Harald Welte59b04682009-06-10 05:40:52 +0800830 /* BTS has rejected channel activation ?!? */
831 if (dh->ie_chan != RSL_IE_CHAN_NR)
832 return -EINVAL;
833
834 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-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 Weltef1a168d2009-07-28 17:58:09 +0200838 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100839 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200840 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100841 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200842 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200843
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100844 LOGPC(DRSL, LOGL_ERROR, "\n");
845
Harald Welte6720a432009-11-29 22:45:52 +0100846 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
847
Harald Weltecddb9802009-08-09 19:50:08 +0200848 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800849 return 0;
850}
851
852/* 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 Weltecf2ec4a2009-12-17 23:10:46 +0100858 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100859 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100860 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800861
862 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
863
Harald Weltef1a168d2009-07-28 17:58:09 +0200864 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100865 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200866 TLVP_LEN(&tp, RSL_IE_CAUSE));
867
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100868 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800869 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +0200870 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800871 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800872}
873
Harald Weltec20bd1d2009-11-29 19:07:28 +0100874static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
875 const char *prefix)
876{
Harald Welte0e4fa782009-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 Weltec20bd1d2009-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 Welte0e4fa782009-12-16 16:52:07 +0100886 int i;
887
Harald Weltec20bd1d2009-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 Welte0e4fa782009-12-16 16:52:07 +0100899 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-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 Welte0b833f82009-12-19 18:33:05 +0100915 if (mr->num_cell == 7)
916 return;
Harald Welte0e4fa782009-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 Welte350c2d32009-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 Welte0e4fa782009-12-16 16:52:07 +0100921 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100922}
923
Harald Welte59b04682009-06-10 05:40:52 +0800924static 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 Weltef9476812009-12-15 21:36:05 +0100928 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100929 u_int8_t len;
930 const u_int8_t *val;
931 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800932
Harald Welte4baa9c52009-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 Weltec88a4432009-12-29 10:44:17 +0100935 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800936 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100937 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100938 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100939 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100940
Harald Weltef9476812009-12-15 21:36:05 +0100941 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100942 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100943
Harald Welte59b04682009-06-10 05:40:52 +0800944 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
945
Harald Weltec20bd1d2009-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 Weltef9476812009-12-15 21:36:05 +0100952 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-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 Weltef9476812009-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 Welte59b04682009-06-10 05:40:52 +0800963 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100964
Harald Weltef9476812009-12-15 21:36:05 +0100965 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100966
967 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800968 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +0100969 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +0100970 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
971
Harald Weltea1467eb2009-06-20 18:44:35 +0200972 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +0100973 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-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 Weltec20bd1d2009-11-29 19:07:28 +0100976 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +0100977 mr->flags |= MEAS_REP_F_FPC;
978 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +0200979 }
Harald Welte59b04682009-06-10 05:40:52 +0800980 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +0200981 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100982 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100983 if (rc < 0)
984 return rc;
985 }
986
Harald Weltef9476812009-12-15 21:36:05 +0100987 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +0800988
Harald Weltef9476812009-12-15 21:36:05 +0100989 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +0100990
Harald Welte59b04682009-06-10 05:40:52 +0800991 return 0;
992}
993
Harald Welte6720a432009-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)c4e9c9c2009-12-27 18:16:36 +01001000 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-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 Welte59b04682009-06-10 05:40:52 +08001015static int abis_rsl_rx_dchan(struct msgb *msg)
1016{
1017 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1018 int rc = 0;
1019 char *ts_name;
1020
1021 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001022 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001023
Harald Welte59b04682009-06-10 05:40:52 +08001024 switch (rslh->c.msg_type) {
1025 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001026 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001027 rc = rsl_rx_chan_act_ack(msg);
1028 break;
1029 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001030 rc = rsl_rx_chan_act_nack(msg);
1031 break;
1032 case RSL_MT_CONN_FAIL:
1033 rc = rsl_rx_conn_fail(msg);
1034 break;
1035 case RSL_MT_MEAS_RES:
1036 rc = rsl_rx_meas_res(msg);
1037 break;
Harald Welte6720a432009-11-29 22:45:52 +01001038 case RSL_MT_HANDO_DET:
1039 rc = rsl_rx_hando_det(msg);
1040 break;
Harald Welte59b04682009-06-10 05:40:52 +08001041 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001042 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001043 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welteab2534c2009-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 Freyther4a00c062010-05-31 21:33:15 +08001047 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther10ea12f2010-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 Welte59b04682009-06-10 05:40:52 +08001051 lchan_free(msg->lchan);
1052 break;
1053 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001054 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001055 break;
1056 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001057 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001058 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001059 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001060 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001061 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001062 break;
1063 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001064 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001065 break;
1066 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001067 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001068 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001069 break;
1070 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001071 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001072 break;
Harald Welte59b04682009-06-10 05:40:52 +08001073 case RSL_MT_PHY_CONTEXT_CONF:
1074 case RSL_MT_PREPROC_MEAS_RES:
1075 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 Weltede4477a2009-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 Welte59b04682009-06-10 05:40:52 +08001083 break;
1084 default:
Harald Weltede4477a2009-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 Welte59b04682009-06-10 05:40:52 +08001087 return -EINVAL;
1088 }
1089
1090 return rc;
1091}
1092
1093static int rsl_rx_error_rep(struct msgb *msg)
1094{
1095 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001096 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001097
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001098 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-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 Weltede4477a2009-12-24 12:20:20 +01001103 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001104 TLVP_LEN(&tp, RSL_IE_CAUSE));
1105
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001106 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001107
1108 return 0;
1109}
1110
1111static int abis_rsl_rx_trx(struct msgb *msg)
1112{
1113 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1114 int rc = 0;
1115
1116 switch (rslh->msg_type) {
1117 case RSL_MT_ERROR_REPORT:
1118 rc = rsl_rx_error_rep(msg);
1119 break;
1120 case RSL_MT_RF_RES_IND:
1121 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001122 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001123 break;
1124 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001125 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001126 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1127 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001128 break;
1129 default:
Harald Welte (local)ab788cf2009-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 Welte59b04682009-06-10 05:40:52 +08001132 return -EINVAL;
1133 }
1134 return rc;
1135}
1136
Harald Welte427dbc42009-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 Freyther10ea12f2010-05-31 21:38:24 +08001142 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001143}
1144
Holger Hans Peter Freyther4a00c062010-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 Freyther10ea12f2010-05-31 21:38:24 +08001150 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001151}
1152
laforge50312e82010-06-21 12:08:52 +02001153#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1154
Harald Weltea00fdd72010-12-23 14:39:29 +01001155/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1156static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1157 unsigned int num_req_refs,
1158 struct gsm48_req_ref *rqd_refs,
1159 uint8_t wait_ind)
1160{
1161 uint8_t buf[GSM_MACBLOCK_LEN];
1162 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1163
1164 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1165 memset(iar, 0, sizeof(*iar));
1166 iar->proto_discr = GSM48_PDISC_RR;
1167 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1168 iar->page_mode = GSM48_PM_SAME;
1169
1170 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1171 iar->wait_ind1 = wait_ind;
1172
1173 if (num_req_refs >= 2)
1174 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1175 else
1176 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1177 iar->wait_ind2 = wait_ind;
1178
1179 if (num_req_refs >= 3)
1180 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1181 else
1182 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1183 iar->wait_ind3 = wait_ind;
1184
1185 if (num_req_refs >= 4)
1186 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1187 else
1188 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1189 iar->wait_ind4 = wait_ind;
1190
1191 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1192}
1193
Harald Welte59b04682009-06-10 05:40:52 +08001194/* MS has requested a channel on the RACH */
1195static int rsl_rx_chan_rqd(struct msgb *msg)
1196{
1197 struct gsm_bts *bts = msg->trx->bts;
1198 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1199 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001200 enum gsm_chan_t lctype;
1201 enum gsm_chreq_reason_t chreq_reason;
1202 struct gsm_lchan *lchan;
1203 u_int8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001204 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001205
1206 u_int16_t arfcn;
1207 u_int8_t ts_number, subch;
1208
1209 /* parse request reference to be used in immediate assign */
1210 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1211 return -EINVAL;
1212
1213 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1214
1215 /* parse access delay and use as TA */
1216 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1217 return -EINVAL;
1218 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1219
1220 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1221 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001222 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1223 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001224
Harald Weltebdbb7442009-12-22 19:07:32 +01001225 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001226
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001227 /*
1228 * We want LOCATION UPDATES to succeed and will assign a TCH
1229 * if we have no SDCCH available.
1230 */
1231 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1232
Harald Welte59b04682009-06-10 05:40:52 +08001233 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001234 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001235 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001236 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001237 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001238 counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001239 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1240 if (bts->network->T3122)
1241 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001242 return -ENOMEM;
1243 }
1244
Harald Weltec88a4432009-12-29 10:44:17 +01001245 if (lchan->state != LCHAN_S_NONE)
1246 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001247 "in state %s\n", gsm_lchan_name(lchan),
1248 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001249 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001250
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001251 /* save the RACH data as we need it after the CHAN ACT ACK */
1252 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1253 if (!lchan->rqd_ref) {
1254 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1255 lchan_free(lchan);
1256 return -ENOMEM;
1257 }
1258
1259 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1260 lchan->rqd_ta = rqd_ta;
1261
Harald Welte59b04682009-06-10 05:40:52 +08001262 ts_number = lchan->ts->nr;
1263 arfcn = lchan->ts->trx->arfcn;
1264 subch = lchan->nr;
1265
Harald Welted2dd9de2009-08-30 15:37:11 +09001266 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001267 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001268 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001269 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001270 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001271
1272 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001273 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001274
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001275 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1276 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1277 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1278 rqd_ref->ra);
1279 return 0;
1280}
1281
1282static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1283{
1284 struct gsm_bts *bts = lchan->ts->trx->bts;
1285 u_int8_t buf[GSM_MACBLOCK_LEN];
1286 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1287
Harald Welte59b04682009-06-10 05:40:52 +08001288 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001289 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001290 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001291 ia->proto_discr = GSM48_PDISC_RR;
1292 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1293 ia->page_mode = GSM48_PM_SAME;
1294 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001295
Harald Welte59b04682009-06-10 05:40:52 +08001296 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001297 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1298 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001299 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001300 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001301 } else {
laforgee06d5982010-06-20 15:18:46 +02001302 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1303 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001304 }
Harald Welte07f32182010-06-28 18:41:27 +02001305 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1306 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001307
Harald Welte427dbc42009-08-10 00:26:10 +02001308 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1309 lchan->T3101.cb = t3101_expired;
1310 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001311 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001312
1313 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001314 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001315}
1316
1317/* MS has requested a channel on the RACH */
1318static int rsl_rx_ccch_load(struct msgb *msg)
1319{
1320 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1321 u_int16_t pg_buf_space;
1322 u_int16_t rach_slot_count = -1;
1323 u_int16_t rach_busy_count = -1;
1324 u_int16_t rach_access_count = -1;
1325
1326 switch (rslh->data[0]) {
1327 case RSL_IE_PAGING_LOAD:
1328 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001329 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1330 /* paging load below configured threshold, use 50 as default */
1331 pg_buf_space = 50;
1332 }
Harald Welte59b04682009-06-10 05:40:52 +08001333 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1334 break;
1335 case RSL_IE_RACH_LOAD:
1336 if (msg->data_len >= 7) {
1337 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1338 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1339 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1340 }
1341 break;
1342 default:
1343 break;
1344 }
1345
1346 return 0;
1347}
1348
1349static int abis_rsl_rx_cchan(struct msgb *msg)
1350{
1351 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1352 int rc = 0;
1353
1354 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1355
1356 switch (rslh->c.msg_type) {
1357 case RSL_MT_CHAN_RQD:
1358 /* MS has requested a channel on the RACH */
1359 rc = rsl_rx_chan_rqd(msg);
1360 break;
1361 case RSL_MT_CCCH_LOAD_IND:
1362 /* current load on the CCCH */
1363 rc = rsl_rx_ccch_load(msg);
1364 break;
1365 case RSL_MT_DELETE_IND:
1366 /* CCCH overloaded, IMM_ASSIGN was dropped */
1367 case RSL_MT_CBCH_LOAD_IND:
1368 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001369 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1370 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001371 break;
1372 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001373 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1374 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001375 return -EINVAL;
1376 }
1377
1378 return rc;
1379}
1380
1381static int rsl_rx_rll_err_ind(struct msgb *msg)
1382{
1383 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1384 u_int8_t *rlm_cause = rllh->data;
1385
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001386 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001387 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001388 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001389
1390 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001391
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001392 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1393 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001394 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001395 }
Harald Welte692f5852009-07-04 09:40:05 +02001396
Harald Welte59b04682009-06-10 05:40:52 +08001397 return 0;
1398}
1399
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001400static void rsl_handle_release(struct gsm_lchan *lchan)
1401{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001402 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001403 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001404
1405 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001406 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001407 return;
1408
1409 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1410 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1411 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001412 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001413 gsm_lchan_name(lchan), sapi);
1414 return;
1415 }
1416
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001417
1418
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001419 /* wait a bit to send the RF Channel Release */
1420 lchan->T3111.cb = t3111_expired;
1421 lchan->T3111.data = lchan;
1422 bts = lchan->ts->trx->bts;
1423 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001424}
1425
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001426/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001427 0x02, 0x06,
1428 0x01, 0x20,
1429 0x02, 0x00,
1430 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1431
1432static int abis_rsl_rx_rll(struct msgb *msg)
1433{
1434 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1435 int rc = 0;
1436 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001437 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001438
1439 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001440 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001441 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001442
1443 switch (rllh->c.msg_type) {
1444 case RSL_MT_DATA_IND:
1445 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001446 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001447 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1448 rllh->data[0] == RSL_IE_L3_INFO) {
1449 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001450 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001451 }
1452 break;
1453 case RSL_MT_EST_IND:
1454 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001455 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001456 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001457 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001458 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001459 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1460 rllh->data[0] == RSL_IE_L3_INFO) {
1461 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001462 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001463 }
1464 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001465 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001466 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001467 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001468 rll_indication(msg->lchan, rllh->link_id,
1469 BSC_RLLR_IND_EST_CONF);
1470 break;
Harald Welte59b04682009-06-10 05:40:52 +08001471 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001472 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001473 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001474 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001475 rll_indication(msg->lchan, rllh->link_id,
1476 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001477 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001478 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001479 break;
1480 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001481 /* BTS informs us of having received UA from MS,
1482 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001483 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001484 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001485 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001486 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001487 break;
1488 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001489 rc = rsl_rx_rll_err_ind(msg);
1490 break;
1491 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001492 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1493 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001494 break;
1495 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001496 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1497 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001498 }
Harald Welte59b04682009-06-10 05:40:52 +08001499 return rc;
1500}
1501
Harald Welteb284b472009-12-02 01:58:23 +05301502static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001503{
Harald Welteb284b472009-12-02 01:58:23 +05301504 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001505 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301506 switch (lchan->type) {
1507 case GSM_LCHAN_TCH_F:
1508 return 0x00;
1509 case GSM_LCHAN_TCH_H:
1510 return 0x03;
1511 default:
1512 break;
1513 }
Harald Welte98d79f92009-07-28 18:11:56 +02001514 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301515 switch (lchan->type) {
1516 case GSM_LCHAN_TCH_F:
1517 return 0x01;
1518 /* there's no half-rate EFR */
1519 default:
1520 break;
1521 }
Harald Welte98d79f92009-07-28 18:11:56 +02001522 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301523 switch (lchan->type) {
1524 case GSM_LCHAN_TCH_F:
1525 return 0x02;
1526 case GSM_LCHAN_TCH_H:
1527 return 0x05;
1528 default:
1529 break;
1530 }
1531 default:
1532 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001533 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001534 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301535 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001536 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001537}
1538
Sylvain Munaut1338a552009-12-20 22:06:40 +01001539static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1540{
Holger Hans Peter Freyther6651b692010-11-14 21:09:08 +01001541 struct gsm_network *net = lchan->ts->trx->bts->network;
1542
1543 /* allow to hardcode the rtp payload */
1544 if (net->hardcoded_rtp_payload != 0)
1545 return net->hardcoded_rtp_payload;
1546
Sylvain Munaut1338a552009-12-20 22:06:40 +01001547 switch (lchan->tch_mode) {
1548 case GSM48_CMODE_SPEECH_V1:
1549 switch (lchan->type) {
1550 case GSM_LCHAN_TCH_F:
1551 return RTP_PT_GSM_FULL;
1552 case GSM_LCHAN_TCH_H:
1553 return RTP_PT_GSM_HALF;
1554 default:
1555 break;
1556 }
1557 case GSM48_CMODE_SPEECH_EFR:
1558 switch (lchan->type) {
1559 case GSM_LCHAN_TCH_F:
1560 return RTP_PT_GSM_EFR;
1561 /* there's no half-rate EFR */
1562 default:
1563 break;
1564 }
1565 case GSM48_CMODE_SPEECH_AMR:
1566 switch (lchan->type) {
1567 case GSM_LCHAN_TCH_F:
1568 return RTP_PT_AMR_FULL;
1569 case GSM_LCHAN_TCH_H:
1570 return RTP_PT_AMR_HALF;
1571 default:
1572 break;
1573 }
1574 default:
1575 break;
1576 }
1577 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1578 "tch_mode == 0x%02x\n & lchan_type == %d",
1579 lchan->tch_mode, lchan->type);
1580 return 0;
1581}
1582
Harald Welte59b04682009-06-10 05:40:52 +08001583/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001584static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1585{
1586 struct in_addr ip;
1587 u_int16_t port, conn_id;
1588
1589 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1590 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1591 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1592 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1593 }
1594
1595 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1596 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1597 port = ntohs(port);
1598 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1599 lchan->abis_ip.bound_port = port;
1600 }
1601
1602 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1603 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1604 conn_id = ntohs(conn_id);
1605 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1606 lchan->abis_ip.conn_id = conn_id;
1607 }
1608
1609 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1610 lchan->abis_ip.rtp_payload2 =
1611 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1612 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1613 lchan->abis_ip.rtp_payload2);
1614 }
1615
1616 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1617 lchan->abis_ip.speech_mode =
1618 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1619 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1620 lchan->abis_ip.speech_mode);
1621 }
1622
1623 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1624 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1625 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1626 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1627 }
1628
1629 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1630 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1631 port = ntohs(port);
1632 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1633 lchan->abis_ip.connect_port = port;
1634 }
1635}
1636
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001637int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001638{
1639 struct msgb *msg = rsl_msgb_alloc();
1640 struct abis_rsl_dchan_hdr *dh;
1641
1642 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001643 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001644 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1645 dh->chan_nr = lchan2chan_nr(lchan);
1646
Harald Welte98d79f92009-07-28 18:11:56 +02001647 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001648 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001649 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001650 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001651 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001652
Sylvain Munaut1338a552009-12-20 22:06:40 +01001653 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1654 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1655 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001656
Harald Welte59b04682009-06-10 05:40:52 +08001657 msg->trx = lchan->ts->trx;
1658
1659 return abis_rsl_sendmsg(msg);
1660}
1661
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001662int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001663 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001664{
1665 struct msgb *msg = rsl_msgb_alloc();
1666 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001667 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001668 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001669
1670 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001671 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001672 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1673 dh->chan_nr = lchan2chan_nr(lchan);
1674
Harald Weltebffa4992009-12-19 16:42:06 +01001675 /* we need to store these now as MDCX_ACK does not return them :( */
1676 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1677 lchan->abis_ip.connect_port = port;
1678 lchan->abis_ip.connect_ip = ip;
1679
Harald Weltefb4a9e92009-07-29 12:12:18 +02001680 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001681 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001682 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001683
Harald Welte98d79f92009-07-28 18:11:56 +02001684 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001685 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1686 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1687 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1688 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001689
Harald Weltebffa4992009-12-19 16:42:06 +01001690 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1691 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1692 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1693 *att_ip = ia.s_addr;
1694 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1695 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001696 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001697 if (rtp_payload2)
1698 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1699
Harald Welte59b04682009-06-10 05:40:52 +08001700 msg->trx = lchan->ts->trx;
1701
1702 return abis_rsl_sendmsg(msg);
1703}
1704
Harald Welte9947d9f2009-12-20 16:51:09 +01001705/* tell BTS to connect RTP stream to our local RTP socket */
1706int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1707{
1708 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1709 int rc;
1710
1711 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1712 ntohs(rs->rtp.sin_local.sin_port),
1713 /* FIXME: use RTP payload of bound socket, not BTS*/
1714 lchan->abis_ip.rtp_payload2);
1715
1716 return rc;
1717}
1718
Harald Welte6f40df02010-12-23 12:59:52 +01001719int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001720{
1721 struct msgb *msg = rsl_msgb_alloc();
1722 struct abis_rsl_dchan_hdr *dh;
Harald Welte2b361522010-03-28 14:42:09 +08001723 u_int8_t msg_type;
1724
1725 if (act)
1726 msg_type = RSL_MT_IPAC_PDCH_ACT;
1727 else
1728 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001729
1730 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001731 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001732 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte6f40df02010-12-23 12:59:52 +01001733 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001734
Harald Welte6f40df02010-12-23 12:59:52 +01001735 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001736 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001737
Harald Welte6f40df02010-12-23 12:59:52 +01001738 msg->trx = ts->trx;
Harald Welteaed946e2009-10-24 10:29:22 +02001739
1740 return abis_rsl_sendmsg(msg);
1741}
1742
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001743static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001744{
1745 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1746 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301747 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001748
1749 /* the BTS has acknowledged a local bind, it now tells us the IP
1750 * address and port number to which it has bound the given logical
1751 * channel */
1752
1753 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1754 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1755 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001756 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001757 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001758 return -EINVAL;
1759 }
Harald Welte50517742009-12-20 15:42:44 +01001760
Harald Weltebffa4992009-12-19 16:42:06 +01001761 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001762
1763 /* in case we don't use direct BTS-to-BTS RTP */
1764 if (!ipacc_rtp_direct) {
1765 int rc;
1766 /* the BTS has successfully bound a TCH to a local ip/port,
1767 * which means we can connect our UDP socket to it */
1768 if (lchan->abis_ip.rtp_socket) {
1769 rtp_socket_free(lchan->abis_ip.rtp_socket);
1770 lchan->abis_ip.rtp_socket = NULL;
1771 }
1772
1773 lchan->abis_ip.rtp_socket = rtp_socket_create();
1774 if (!lchan->abis_ip.rtp_socket)
1775 goto out_err;
1776
1777 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1778 lchan->abis_ip.bound_ip,
1779 lchan->abis_ip.bound_port);
1780 if (rc < 0)
1781 goto out_err;
1782 }
1783
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001784 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001785
1786 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001787out_err:
1788 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001789}
1790
Harald Weltebffa4992009-12-19 16:42:06 +01001791static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1792{
1793 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1794 struct tlv_parsed tv;
1795 struct gsm_lchan *lchan = msg->lchan;
1796
1797 /* the BTS has acknowledged a remote connect request and
1798 * it now tells us the IP address and port number to which it has
1799 * connected the given logical channel */
1800
1801 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1802 ipac_parse_rtp(lchan, &tv);
1803 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1804
1805 return 0;
1806}
1807
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001808static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001809{
1810 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1811 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001812 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001813
1814 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001815
Harald Weltef1a168d2009-07-28 17:58:09 +02001816 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001817 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001818 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001819
Harald Welte50517742009-12-20 15:42:44 +01001820 /* the BTS tells us a RTP stream has been disconnected */
1821 if (lchan->abis_ip.rtp_socket) {
1822 rtp_socket_free(lchan->abis_ip.rtp_socket);
1823 lchan->abis_ip.rtp_socket = NULL;
1824 }
1825
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001826 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001827
Harald Welte59b04682009-06-10 05:40:52 +08001828 return 0;
1829}
1830
1831static int abis_rsl_rx_ipacc(struct msgb *msg)
1832{
1833 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001834 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001835 int rc = 0;
1836
1837 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001838 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001839
1840 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001841 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001842 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001843 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001844 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001845 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001846 /* somehow the BTS was unable to bind the lchan to its local
1847 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001848 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001849 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001850 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001851 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001852 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001853 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001854 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001855 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001856 /* somehow the BTS was unable to connect the lchan to a remote
1857 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001858 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001859 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001860 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001861 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001862 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001863 break;
1864 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001865 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001866 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001867 break;
1868 }
1869 DEBUGPC(DRSL, "\n");
1870
1871 return rc;
1872}
1873
1874
1875/* Entry-point where L2 RSL from BTS enters */
1876int abis_rsl_rcvmsg(struct msgb *msg)
1877{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001878 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001879 int rc = 0;
1880
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001881 if (!msg) {
1882 DEBUGP(DRSL, "Empty RSL msg?..\n");
1883 return -1;
1884 }
1885
1886 if (msgb_l2len(msg) < sizeof(*rslh)) {
1887 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1888 return -1;
1889 }
1890
1891 rslh = msgb_l2(msg);
1892
Harald Welte59b04682009-06-10 05:40:52 +08001893 switch (rslh->msg_discr & 0xfe) {
1894 case ABIS_RSL_MDISC_RLL:
1895 rc = abis_rsl_rx_rll(msg);
1896 break;
1897 case ABIS_RSL_MDISC_DED_CHAN:
1898 rc = abis_rsl_rx_dchan(msg);
1899 break;
1900 case ABIS_RSL_MDISC_COM_CHAN:
1901 rc = abis_rsl_rx_cchan(msg);
1902 break;
1903 case ABIS_RSL_MDISC_TRX:
1904 rc = abis_rsl_rx_trx(msg);
1905 break;
1906 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001907 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001908 rslh->msg_discr);
1909 break;
1910 case ABIS_RSL_MDISC_IPACCESS:
1911 rc = abis_rsl_rx_ipacc(msg);
1912 break;
1913 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001914 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1915 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001916 return -EINVAL;
1917 }
1918 msgb_free(msg);
1919 return rc;
1920}
1921
Harald Welte59b04682009-06-10 05:40:52 +08001922/* From Table 10.5.33 of GSM 04.08 */
1923int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1924{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301925 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1926 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1927 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001928 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301929 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1930 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001931 }
1932}
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08001933
1934int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1935 uint8_t cb_command, const uint8_t *data, int len)
1936{
1937 struct abis_rsl_dchan_hdr *dh;
1938 struct msgb *cb_cmd;
1939
1940 cb_cmd = rsl_msgb_alloc();
1941 if (!cb_cmd)
1942 return -1;
1943
1944 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1945 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1946 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1947
1948 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1949 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1950
1951 cb_cmd->trx = bts->c0;
1952
1953 return abis_rsl_sendmsg(cb_cmd);
1954}