blob: 7ca1de6475128659df0721c41ff714785c576438 [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 Welteb5586242009-12-09 19:18:32 +0100133u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +0800134{
135 struct gsm_bts_trx_ts *ts = lchan->ts;
136 u_int8_t cbits, chan_nr;
137
138 switch (ts->pchan) {
139 case GSM_PCHAN_TCH_F:
Harald Welte37884ed2009-10-24 10:25:50 +0200140 case GSM_PCHAN_PDCH:
141 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte59b04682009-06-10 05:40:52 +0800142 cbits = 0x01;
143 break;
144 case GSM_PCHAN_TCH_H:
145 cbits = 0x02;
146 cbits += lchan->nr;
147 break;
148 case GSM_PCHAN_CCCH_SDCCH4:
149 cbits = 0x04;
150 cbits += lchan->nr;
151 break;
152 case GSM_PCHAN_SDCCH8_SACCH8C:
153 cbits = 0x08;
154 cbits += lchan->nr;
155 break;
156 default:
157 case GSM_PCHAN_CCCH:
158 cbits = 0x10;
159 break;
160 }
161
162 chan_nr = (cbits << 3) | (ts->nr & 0x7);
163
164 return chan_nr;
165}
166
167/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
168u_int64_t str_to_imsi(const char *imsi_str)
169{
170 u_int64_t ret;
171
172 ret = strtoull(imsi_str, NULL, 10);
173
174 return ret;
175}
176
177/* Table 5 Clause 7 TS 05.02 */
178unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
179{
180 if (!bs_ccch_sdcch_comb)
181 return 9 - bs_ag_blks_res;
182 else
183 return 3 - bs_ag_blks_res;
184}
185
186/* Chapter 6.5.2 of TS 05.02 */
187unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
188 unsigned int n_pag_blocks)
189{
190 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
191}
192
193/* Chapter 6.5.2 of TS 05.02 */
194unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
195 int n_pag_blocks)
196{
197 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
198}
199
200static struct msgb *rsl_msgb_alloc(void)
201{
Harald Welte9cfc9352009-06-26 19:39:35 +0200202 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
203 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800204}
205
206#define MACBLOCK_SIZE 23
207static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
208{
209 memcpy(out, in, len);
210
211 if (len < MACBLOCK_SIZE)
212 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
213}
214
Harald Welted2dd9de2009-08-30 15:37:11 +0900215/* Chapter 9.3.7: Encryption Information */
216static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
217{
218 *out++ = lchan->encr.alg_id & 0xff;
219 if (lchan->encr.key_len)
220 memcpy(out, lchan->encr.key, lchan->encr.key_len);
221 return lchan->encr.key_len + 1;
222}
223
Harald Weltede4477a2009-12-24 12:20:20 +0100224static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200225{
Harald Welte59b04682009-06-10 05:40:52 +0800226 int i;
227
Harald Weltede4477a2009-12-24 12:20:20 +0100228 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200229 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200230 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100231 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800232}
233
234/* Send a BCCH_INFO message as per Chapter 8.5.1 */
235int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
236 const u_int8_t *data, int len)
237{
238 struct abis_rsl_dchan_hdr *dh;
239 struct msgb *msg = rsl_msgb_alloc();
240
241 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
242 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
243 dh->chan_nr = RSL_CHAN_BCCH;
244
245 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
246 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
247
248 msg->trx = trx;
249
250 return abis_rsl_sendmsg(msg);
251}
252
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200253int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte59b04682009-06-10 05:40:52 +0800254 const u_int8_t *data, int len)
255{
256 struct abis_rsl_common_hdr *ch;
257 struct msgb *msg = rsl_msgb_alloc();
258
259 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
260 ch->msg_discr = ABIS_RSL_MDISC_TRX;
261 ch->msg_type = RSL_MT_SACCH_FILL;
262
263 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
264 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
265
266 msg->trx = trx;
267
268 return abis_rsl_sendmsg(msg);
269}
270
Harald Welte91afe4c2009-06-20 18:15:19 +0200271int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
272{
273 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200274 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200275 u_int8_t chan_nr = lchan2chan_nr(lchan);
276
277 db = abs(db);
278 if (db > 30)
279 return -EINVAL;
280
Harald Welteed831842009-06-27 03:09:08 +0200281 msg = rsl_msgb_alloc();
282
Harald Welte91afe4c2009-06-20 18:15:19 +0200283 lchan->bs_power = db/2;
284 if (fpc)
285 lchan->bs_power |= 0x10;
286
287 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
288 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
289 dh->chan_nr = chan_nr;
290
291 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
292
293 msg->trx = lchan->ts->trx;
294
295 return abis_rsl_sendmsg(msg);
296}
297
Harald Welte91afe4c2009-06-20 18:15:19 +0200298int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
299{
300 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200301 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200302 u_int8_t chan_nr = lchan2chan_nr(lchan);
303 int ctl_lvl;
304
Harald Weltec4dcda02009-08-09 14:45:18 +0200305 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200306 if (ctl_lvl < 0)
307 return ctl_lvl;
308
Harald Welteed831842009-06-27 03:09:08 +0200309 msg = rsl_msgb_alloc();
310
Harald Welte91afe4c2009-06-20 18:15:19 +0200311 lchan->ms_power = ctl_lvl;
312
313 if (fpc)
314 lchan->ms_power |= 0x20;
315
316 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
317 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
318 dh->chan_nr = chan_nr;
319
320 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
321
322 msg->trx = lchan->ts->trx;
323
324 return abis_rsl_sendmsg(msg);
325}
326
Harald Welte39274f42009-07-29 15:41:29 +0200327static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
328 struct gsm_lchan *lchan)
329{
330 memset(cm, 0, sizeof(cm));
331
332 /* FIXME: what to do with data calls ? */
333 cm->dtx_dtu = 0x00;
334
335 /* set TCH Speech/Data */
336 cm->spd_ind = lchan->rsl_cmode;
337
Harald Welte951e3512009-11-27 08:55:16 +0100338 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
339 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100340 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100341 "but tch_mode != signalling\n");
342
Harald Welte39274f42009-07-29 15:41:29 +0200343 switch (lchan->type) {
344 case GSM_LCHAN_SDCCH:
345 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
346 break;
347 case GSM_LCHAN_TCH_F:
348 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
349 break;
350 case GSM_LCHAN_TCH_H:
351 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
352 break;
353 case GSM_LCHAN_NONE:
354 case GSM_LCHAN_UNKNOWN:
355 default:
356 return -EINVAL;
357 }
358
359 switch (lchan->tch_mode) {
360 case GSM48_CMODE_SIGN:
361 cm->chan_rate = 0;
362 break;
363 case GSM48_CMODE_SPEECH_V1:
364 cm->chan_rate = RSL_CMOD_SP_GSM1;
365 break;
366 case GSM48_CMODE_SPEECH_EFR:
367 cm->chan_rate = RSL_CMOD_SP_GSM2;
368 break;
369 case GSM48_CMODE_SPEECH_AMR:
370 cm->chan_rate = RSL_CMOD_SP_GSM3;
371 break;
372 case GSM48_CMODE_DATA_14k5:
373 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
374 break;
375 case GSM48_CMODE_DATA_12k0:
376 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
377 break;
378 case GSM48_CMODE_DATA_6k0:
379 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
380 break;
381 default:
382 return -EINVAL;
383 }
384
385 return 0;
386}
387
Harald Welte59b04682009-06-10 05:40:52 +0800388/* Chapter 8.4.1 */
389#if 0
390int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
391 u_int8_t act_type,
392 struct rsl_ie_chan_mode *chan_mode,
393 struct rsl_ie_chan_ident *chan_ident,
394 u_int8_t bs_power, u_int8_t ms_power,
395 u_int8_t ta)
396{
397 struct abis_rsl_dchan_hdr *dh;
398 struct msgb *msg = rsl_msgb_alloc();
399
400 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
401 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
402 dh->chan_nr = chan_nr;
403
404 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
405 /* For compatibility with Phase 1 */
406 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
407 (u_int8_t *) chan_mode);
408 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
409 (u_int8_t *) chan_ident);
410#if 0
411 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
412 (u_int8_t *) &encr_info);
413#endif
414 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
415 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
416 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
417
418 msg->trx = trx;
419
420 return abis_rsl_sendmsg(msg);
421}
422#endif
423
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200424int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welteb90d7bd2009-12-17 00:31:10 +0100425 u_int8_t ta, u_int8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800426{
427 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200428 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200429 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200430 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800431
432 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800433 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200434 struct gsm48_chan_desc cd;
435 uint8_t *msgb_cd;
Harald Welte59b04682009-06-10 05:40:52 +0800436
Harald Welte39274f42009-07-29 15:41:29 +0200437 rc = channel_mode_from_lchan(&cm, lchan);
438 if (rc < 0)
439 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800440
laforgef723cf02010-06-20 21:38:19 +0200441 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800442
Harald Welteed831842009-06-27 03:09:08 +0200443 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800444 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
445 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
446 dh->chan_nr = chan_nr;
447
448 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800449 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
450 (u_int8_t *) &cm);
Harald Welteb90d7bd2009-12-17 00:31:10 +0100451 /* For compatibility with Phase 1 */
laforgef723cf02010-06-20 21:38:19 +0200452 /* RSL IE TAG */
453 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200454 /* RSL IE LEN: 04.08_cd_tag + CD */
455 len = msgb_put(msg, 1);
456 *len = 1 + sizeof(struct gsm48_chan_desc);
457 msgb_v_put(msg, 1 + sizeof(struct gsm48_chan_desc) + 2 +
458 lchan->ts->hopping.ma_len);
laforgef723cf02010-06-20 21:38:19 +0200459 /* GSM 04.08 Chan Desc 2 (TAG + fixed 3 byte length V) */
460 msgb_v_put(msg, GSM48_IE_CHANDESC_2);
461 msgb_cd = msgb_put(msg, sizeof(cd));
462 memcpy(msgb_cd, &cd, sizeof(cd));
Harald Weltedea24e92010-06-29 17:53:45 +0200463 if (lchan->ts->hopping.enabled) {
464 /* RSL IE LEN: += 04.08_ma_tag + 04.08_ma_len + ma_len */
465 *len += 2 + lchan->ts->hopping.ma_len;
466 /* GSM 04.08 Mobile Allocation: TLV */
467 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
468 lchan->ts->hopping.ma_data);
469 }
laforgef723cf02010-06-20 21:38:19 +0200470
Harald Welted2dd9de2009-08-30 15:37:11 +0900471 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
472 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
473 rc = build_encr_info(encr_info, lchan);
474 if (rc > 0)
475 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
476 }
477
Harald Welteb90d7bd2009-12-17 00:31:10 +0100478 switch (act_type) {
479 case RSL_ACT_INTER_ASYNC:
480 case RSL_ACT_INTER_SYNC:
481 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
482 break;
483 default:
484 break;
485 }
486
Harald Welte59b04682009-06-10 05:40:52 +0800487 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
488 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
489 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
490
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100491 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
492 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
493 (u_int8_t *) &lchan->mr_conf);
494
Harald Welte59b04682009-06-10 05:40:52 +0800495 msg->trx = lchan->ts->trx;
496
497 return abis_rsl_sendmsg(msg);
498}
499
Harald Welte8e770492009-07-29 11:38:15 +0200500/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800501int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
502{
503 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200504 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200505 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800506
507 u_int8_t chan_nr = lchan2chan_nr(lchan);
508 struct rsl_ie_chan_mode cm;
509
Harald Welte39274f42009-07-29 15:41:29 +0200510 rc = channel_mode_from_lchan(&cm, lchan);
511 if (rc < 0)
512 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800513
Harald Welteed831842009-06-27 03:09:08 +0200514 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800515 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
516 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
517 dh->chan_nr = chan_nr;
518
519 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
520 (u_int8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900521
522 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
523 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
524 rc = build_encr_info(encr_info, lchan);
525 if (rc > 0)
526 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
527 }
528
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100529 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
530 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
531 (u_int8_t *) &lchan->mr_conf);
532 }
533
Harald Welted2dd9de2009-08-30 15:37:11 +0900534 msg->trx = lchan->ts->trx;
535
536 return abis_rsl_sendmsg(msg);
537}
538
539/* Chapter 8.4.6: Send the encryption command with given L3 info */
540int rsl_encryption_cmd(struct msgb *msg)
541{
542 struct abis_rsl_dchan_hdr *dh;
543 struct gsm_lchan *lchan = msg->lchan;
544 u_int8_t chan_nr = lchan2chan_nr(lchan);
545 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut01f1caf2009-09-27 11:13:18 +0200546 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900547 int rc;
548
549 /* First push the L3 IE tag and length */
550 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
551
552 /* then the link identifier (SAPI0, main sign link) */
553 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
554
555 /* then encryption information */
556 rc = build_encr_info(encr_info, lchan);
557 if (rc <= 0)
558 return rc;
559 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
560
561 /* and finally the DCHAN header */
562 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
563 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
564 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800565
566 msg->trx = lchan->ts->trx;
567
568 return abis_rsl_sendmsg(msg);
569}
570
Harald Welte85a163c2009-08-10 11:43:22 +0200571/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200572int rsl_deact_sacch(struct gsm_lchan *lchan)
573{
574 struct abis_rsl_dchan_hdr *dh;
575 struct msgb *msg = rsl_msgb_alloc();
576
577 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
578 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
579 dh->chan_nr = lchan2chan_nr(lchan);
580
581 msg->lchan = lchan;
582 msg->trx = lchan->ts->trx;
583
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100584 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200585
586 return abis_rsl_sendmsg(msg);
587}
588
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800589static void error_timeout_cb(void *data)
590{
591 struct gsm_lchan *lchan = data;
592 if (lchan->state != LCHAN_S_REL_ERR) {
593 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
594 gsm_lchan_name(lchan), lchan->state);
595 return;
596 }
597
598 /* go back to the none state */
599 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800600 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800601}
602
Harald Welte85a163c2009-08-10 11:43:22 +0200603/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800604static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800605{
606 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800607 struct msgb *msg;
Harald Welte59b04682009-06-10 05:40:52 +0800608
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800609 if (lchan->state == LCHAN_S_REL_ERR) {
610 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
611 gsm_lchan_name(lchan));
612 return -1;
613 }
614
615 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800616 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
617 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
618 dh->chan_nr = lchan2chan_nr(lchan);
619
620 msg->lchan = lchan;
621 msg->trx = lchan->ts->trx;
622
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800623 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
624
625 if (error) {
626 /*
627 * the nanoBTS sends RLL release indications after the channel release. This can
628 * be a problem when we have reassigned the channel to someone else and then can
629 * not figure out who used this channel.
630 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800631 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800632 lchan->error_timer.data = lchan;
633 lchan->error_timer.cb = error_timeout_cb;
634 bsc_schedule_timer(&lchan->error_timer,
635 msg->trx->bts->network->T3111 + 2, 0);
636 }
Harald Welte59b04682009-06-10 05:40:52 +0800637
Harald Welte85a163c2009-08-10 11:43:22 +0200638 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800639 return abis_rsl_sendmsg(msg);
640}
641
642int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
643 u_int8_t *ms_ident, u_int8_t chan_needed)
644{
645 struct abis_rsl_dchan_hdr *dh;
646 struct msgb *msg = rsl_msgb_alloc();
647
648 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
649 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
650 dh->chan_nr = RSL_CHAN_PCH_AGCH;
651
652 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
653 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
654 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
655
656 msg->trx = bts->c0;
657
658 return abis_rsl_sendmsg(msg);
659}
660
661int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
662 struct gsm_subscriber *subscr)
663{
664#if 0
665 u_int8_t mi[128];
666 unsigned int mi_len;
667 u_int8_t paging_group;
668#endif
669
670 return -1;
671}
672
673int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
674{
675 int i, len = strlen(str_in);
676
677 for (i = 0; i < len; i++) {
678 int num = str_in[i] - 0x30;
679 if (num < 0 || num > 9)
680 return -1;
681 if (i % 2 == 0)
682 bcd_out[i/2] = num;
683 else
684 bcd_out[i/2] |= (num << 4);
685 }
686
687 return 0;
688}
689
690/* Chapter 8.5.6 */
691int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
692{
693 struct msgb *msg = rsl_msgb_alloc();
694 struct abis_rsl_dchan_hdr *dh;
695 u_int8_t buf[MACBLOCK_SIZE];
696
697 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
698 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
699 dh->chan_nr = RSL_CHAN_PCH_AGCH;
700
701 switch (bts->type) {
702 case GSM_BTS_TYPE_BS11:
703 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
704 break;
705 default:
706 /* If phase 2, construct a FULL_IMM_ASS_INFO */
707 pad_macblock(buf, val, len);
708 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
709 break;
710 }
711
712 msg->trx = bts->c0;
713
714 return abis_rsl_sendmsg(msg);
715}
716
Harald Welte4684e632009-08-10 09:51:40 +0200717/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200718int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200719{
720 struct msgb *msg = rsl_msgb_alloc();
721 struct abis_rsl_dchan_hdr *dh;
722
723 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
724 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200725 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200726 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200727 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200728
Harald Weltede4477a2009-12-24 12:20:20 +0100729 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100730 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200731
732 msg->trx = lchan->ts->trx;
733
Harald Welte4684e632009-08-10 09:51:40 +0200734 return abis_rsl_sendmsg(msg);
735}
736
737
Harald Welte59b04682009-06-10 05:40:52 +0800738/* Send "DATA REQUEST" message with given L3 Info payload */
739/* Chapter 8.3.1 */
740int rsl_data_request(struct msgb *msg, u_int8_t link_id)
741{
Harald Welte59b04682009-06-10 05:40:52 +0800742 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100743 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800744 return -EINVAL;
745 }
746
Harald Weltea22d36b2010-03-04 10:33:10 +0100747 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
748 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800749
750 msg->trx = msg->lchan->ts->trx;
751
752 return abis_rsl_sendmsg(msg);
753}
754
Harald Welteed9a5ab2009-08-09 13:47:35 +0200755/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
756/* Chapter 8.3.1 */
757int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
758{
Harald Weltea22d36b2010-03-04 10:33:10 +0100759 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200760
Harald Weltea22d36b2010-03-04 10:33:10 +0100761 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
762 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200763 msg->trx = lchan->ts->trx;
764
765 return abis_rsl_sendmsg(msg);
766}
767
Harald Welte0f2e3c12009-08-08 13:15:07 +0200768/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
769 This is what higher layers should call. The BTS then responds with
770 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
771 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
772 lchan_free() */
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800773int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200774{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200775
Harald Weltea22d36b2010-03-04 10:33:10 +0100776 struct msgb *msg;
777
778 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
779 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800780 /* 0 is normal release, 1 is local end */
781 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200782
Harald Weltec88a4432009-12-29 10:44:17 +0100783 /* FIXME: start some timer in case we don't receive a REL ACK ? */
784
Harald Welte0f2e3c12009-08-08 13:15:07 +0200785 msg->trx = lchan->ts->trx;
786
787 return abis_rsl_sendmsg(msg);
788}
789
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200790int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
791{
792 lchan->state = state;
793 return 0;
794}
795
Harald Welte59b04682009-06-10 05:40:52 +0800796/* Chapter 8.4.2: Channel Activate Acknowledge */
797static int rsl_rx_chan_act_ack(struct msgb *msg)
798{
799 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
800
801 /* BTS has confirmed channel activation, we now need
802 * to assign the activated channel to the MS */
803 if (rslh->ie_chan != RSL_IE_CHAN_NR)
804 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100805
Harald Weltec88a4432009-12-29 10:44:17 +0100806 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100807 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
808 gsm_lchan_name(msg->lchan),
809 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200810 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100811
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800812 if (msg->lchan->rqd_ref) {
813 rsl_send_imm_assignment(msg->lchan);
814 talloc_free(msg->lchan->rqd_ref);
815 msg->lchan->rqd_ref = NULL;
816 msg->lchan->rqd_ta = 0;
817 }
818
Harald Welte6720a432009-11-29 22:45:52 +0100819 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
820
Harald Welte59b04682009-06-10 05:40:52 +0800821 return 0;
822}
823
824/* Chapter 8.4.3: Channel Activate NACK */
825static int rsl_rx_chan_act_nack(struct msgb *msg)
826{
827 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
828 struct tlv_parsed tp;
829
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100830 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100831 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100832
Harald Welte59b04682009-06-10 05:40:52 +0800833 /* BTS has rejected channel activation ?!? */
834 if (dh->ie_chan != RSL_IE_CHAN_NR)
835 return -EINVAL;
836
837 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100838 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
839 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
840 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200841 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100842 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200843 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100844 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200845 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200846
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100847 LOGPC(DRSL, LOGL_ERROR, "\n");
848
Harald Welte6720a432009-11-29 22:45:52 +0100849 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
850
Harald Weltecddb9802009-08-09 19:50:08 +0200851 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800852 return 0;
853}
854
855/* Chapter 8.4.4: Connection Failure Indication */
856static int rsl_rx_conn_fail(struct msgb *msg)
857{
858 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
859 struct tlv_parsed tp;
860
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100861 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100862 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100863 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800864
865 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
866
Harald Weltef1a168d2009-07-28 17:58:09 +0200867 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100868 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200869 TLVP_LEN(&tp, RSL_IE_CAUSE));
870
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100871 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800872 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +0200873 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800874 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800875}
876
Harald Weltec20bd1d2009-11-29 19:07:28 +0100877static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
878 const char *prefix)
879{
Harald Welte0e4fa782009-12-16 16:52:07 +0100880 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
881 prefix, rxlev2dbm(mru->full.rx_lev),
882 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100883 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
884 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
885}
886
887static void print_meas_rep(struct gsm_meas_rep *mr)
888{
Harald Welte0e4fa782009-12-16 16:52:07 +0100889 int i;
890
Harald Weltec20bd1d2009-11-29 19:07:28 +0100891 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
892
893 if (mr->flags & MEAS_REP_F_DL_DTX)
894 DEBUGPC(DMEAS, "DTXd ");
895
896 print_meas_rep_uni(&mr->ul, "ul");
897 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
898 if (mr->flags & MEAS_REP_F_MS_TO)
899 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
900
901 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100902 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100903 DEBUGPC(DMEAS, "L1_FPC=%u ",
904 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
905 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
906 }
907
908 if (mr->flags & MEAS_REP_F_UL_DTX)
909 DEBUGPC(DMEAS, "DTXu ");
910 if (mr->flags & MEAS_REP_F_BA1)
911 DEBUGPC(DMEAS, "BA1 ");
912 if (!(mr->flags & MEAS_REP_F_DL_VALID))
913 DEBUGPC(DMEAS, "NOT VALID ");
914 else
915 print_meas_rep_uni(&mr->dl, "dl");
916
917 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100918 if (mr->num_cell == 7)
919 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100920 for (i = 0; i < mr->num_cell; i++) {
921 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100922 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
923 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100924 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100925}
926
Harald Welte59b04682009-06-10 05:40:52 +0800927static int rsl_rx_meas_res(struct msgb *msg)
928{
929 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
930 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100931 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100932 u_int8_t len;
933 const u_int8_t *val;
934 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800935
Harald Welte4baa9c52009-12-21 13:27:11 +0100936 /* check if this channel is actually active */
937 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100938 if (msg->lchan->state != LCHAN_S_ACTIVE) {
939 LOGP(DRSL, LOGL_NOTICE, "%s: MEAS RES for inactive channel\n",
940 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100941 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100942 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100943
Harald Weltef9476812009-12-15 21:36:05 +0100944 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100945 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100946
Harald Welte59b04682009-06-10 05:40:52 +0800947 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
948
Harald Weltec20bd1d2009-11-29 19:07:28 +0100949 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
950 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
951 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
952 return -EIO;
953
954 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100955 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100956
957 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
958 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
959 if (len >= 3) {
960 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +0100961 mr->flags |= MEAS_REP_F_DL_DTX;
962 mr->ul.full.rx_lev = val[0] & 0x3f;
963 mr->ul.sub.rx_lev = val[1] & 0x3f;
964 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
965 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +0800966 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100967
Harald Weltef9476812009-12-15 21:36:05 +0100968 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100969
970 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800971 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +0100972 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +0100973 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
974
Harald Weltea1467eb2009-06-20 18:44:35 +0200975 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +0100976 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100977 mr->flags |= MEAS_REP_F_MS_L1;
978 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100979 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +0100980 mr->flags |= MEAS_REP_F_FPC;
981 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +0200982 }
Harald Welte59b04682009-06-10 05:40:52 +0800983 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +0200984 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100985 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100986 if (rc < 0)
987 return rc;
988 }
989
Harald Weltef9476812009-12-15 21:36:05 +0100990 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +0800991
Harald Weltef9476812009-12-15 21:36:05 +0100992 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +0100993
Harald Welte59b04682009-06-10 05:40:52 +0800994 return 0;
995}
996
Harald Welte6720a432009-11-29 22:45:52 +0100997/* Chapter 8.4.7 */
998static int rsl_rx_hando_det(struct msgb *msg)
999{
1000 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1001 struct tlv_parsed tp;
1002
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001003 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001004
1005 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1006
1007 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1008 DEBUGPC(DRSL, "access delay = %u\n",
1009 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1010 else
1011 DEBUGPC(DRSL, "\n");
1012
1013 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1014
1015 return 0;
1016}
1017
Harald Welte59b04682009-06-10 05:40:52 +08001018static int abis_rsl_rx_dchan(struct msgb *msg)
1019{
1020 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1021 int rc = 0;
1022 char *ts_name;
1023
1024 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001025 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001026
Harald Welte59b04682009-06-10 05:40:52 +08001027 switch (rslh->c.msg_type) {
1028 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001029 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001030 rc = rsl_rx_chan_act_ack(msg);
1031 break;
1032 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001033 rc = rsl_rx_chan_act_nack(msg);
1034 break;
1035 case RSL_MT_CONN_FAIL:
1036 rc = rsl_rx_conn_fail(msg);
1037 break;
1038 case RSL_MT_MEAS_RES:
1039 rc = rsl_rx_meas_res(msg);
1040 break;
Harald Welte6720a432009-11-29 22:45:52 +01001041 case RSL_MT_HANDO_DET:
1042 rc = rsl_rx_hando_det(msg);
1043 break;
Harald Welte59b04682009-06-10 05:40:52 +08001044 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001045 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001046 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welteab2534c2009-12-29 10:52:38 +01001047 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1048 gsm_lchan_name(msg->lchan),
1049 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001050 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001051 /* we have an error timer pending to release that */
1052 if (msg->lchan->state != LCHAN_S_REL_ERR)
1053 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte59b04682009-06-10 05:40:52 +08001054 lchan_free(msg->lchan);
1055 break;
1056 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001057 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001058 break;
1059 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001060 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001061 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001062 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001063 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001064 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001065 break;
1066 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001067 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001068 break;
1069 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001070 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001071 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001072 break;
1073 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001074 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001075 break;
Harald Welte59b04682009-06-10 05:40:52 +08001076 case RSL_MT_PHY_CONTEXT_CONF:
1077 case RSL_MT_PREPROC_MEAS_RES:
1078 case RSL_MT_TALKER_DET:
1079 case RSL_MT_LISTENER_DET:
1080 case RSL_MT_REMOTE_CODEC_CONF_REP:
1081 case RSL_MT_MR_CODEC_MOD_ACK:
1082 case RSL_MT_MR_CODEC_MOD_NACK:
1083 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001084 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1085 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001086 break;
1087 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001088 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1089 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001090 return -EINVAL;
1091 }
1092
1093 return rc;
1094}
1095
1096static int rsl_rx_error_rep(struct msgb *msg)
1097{
1098 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001099 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001100
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001101 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001102
1103 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1104
1105 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001106 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001107 TLVP_LEN(&tp, RSL_IE_CAUSE));
1108
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001109 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001110
1111 return 0;
1112}
1113
1114static int abis_rsl_rx_trx(struct msgb *msg)
1115{
1116 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1117 int rc = 0;
1118
1119 switch (rslh->msg_type) {
1120 case RSL_MT_ERROR_REPORT:
1121 rc = rsl_rx_error_rep(msg);
1122 break;
1123 case RSL_MT_RF_RES_IND:
1124 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001125 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001126 break;
1127 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001128 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001129 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1130 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001131 break;
1132 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001133 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1134 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001135 return -EINVAL;
1136 }
1137 return rc;
1138}
1139
Harald Welte427dbc42009-08-10 00:26:10 +02001140/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1141static void t3101_expired(void *data)
1142{
1143 struct gsm_lchan *lchan = data;
1144
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001145 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001146}
1147
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001148/* If T3111 expires, we will send the RF Channel Request */
1149static void t3111_expired(void *data)
1150{
1151 struct gsm_lchan *lchan = data;
1152
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001153 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001154}
1155
laforge50312e82010-06-21 12:08:52 +02001156#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1157
Harald Welte59b04682009-06-10 05:40:52 +08001158/* MS has requested a channel on the RACH */
1159static int rsl_rx_chan_rqd(struct msgb *msg)
1160{
1161 struct gsm_bts *bts = msg->trx->bts;
1162 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1163 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001164 enum gsm_chan_t lctype;
1165 enum gsm_chreq_reason_t chreq_reason;
1166 struct gsm_lchan *lchan;
1167 u_int8_t rqd_ta;
Harald Welte59b04682009-06-10 05:40:52 +08001168
1169 u_int16_t arfcn;
1170 u_int8_t ts_number, subch;
1171
1172 /* parse request reference to be used in immediate assign */
1173 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1174 return -EINVAL;
1175
1176 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1177
1178 /* parse access delay and use as TA */
1179 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1180 return -EINVAL;
1181 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1182
1183 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1184 * request reference RA */
Holger Hans Peter Freyther96c89822009-11-16 17:12:38 +01001185 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1186 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001187
Harald Weltebdbb7442009-12-22 19:07:32 +01001188 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001189
Harald Welte59b04682009-06-10 05:40:52 +08001190 /* check availability / allocate channel */
1191 lchan = lchan_alloc(bts, lctype);
1192 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001193 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001194 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001195 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte59b04682009-06-10 05:40:52 +08001196 /* FIXME: send some kind of reject ?!? */
1197 return -ENOMEM;
1198 }
1199
Harald Weltec88a4432009-12-29 10:44:17 +01001200 if (lchan->state != LCHAN_S_NONE)
1201 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001202 "in state %s\n", gsm_lchan_name(lchan),
1203 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001204 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001205
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001206 /* save the RACH data as we need it after the CHAN ACT ACK */
1207 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1208 if (!lchan->rqd_ref) {
1209 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1210 lchan_free(lchan);
1211 return -ENOMEM;
1212 }
1213
1214 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1215 lchan->rqd_ta = rqd_ta;
1216
Harald Welte59b04682009-06-10 05:40:52 +08001217 ts_number = lchan->ts->nr;
1218 arfcn = lchan->ts->trx->arfcn;
1219 subch = lchan->nr;
1220
Harald Welted2dd9de2009-08-30 15:37:11 +09001221 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001222 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001223 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001224 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001225 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001226
1227 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001228 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001229
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001230 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1231 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1232 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1233 rqd_ref->ra);
1234 return 0;
1235}
1236
1237static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1238{
1239 struct gsm_bts *bts = lchan->ts->trx->bts;
1240 u_int8_t buf[GSM_MACBLOCK_LEN];
1241 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1242
Harald Welte59b04682009-06-10 05:40:52 +08001243 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001244 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001245 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001246 ia->proto_discr = GSM48_PDISC_RR;
1247 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1248 ia->page_mode = GSM48_PM_SAME;
1249 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001250
Harald Welte59b04682009-06-10 05:40:52 +08001251 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001252 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1253 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001254 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001255 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001256 } else {
laforgee06d5982010-06-20 15:18:46 +02001257 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1258 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001259 }
Harald Welte07f32182010-06-28 18:41:27 +02001260 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1261 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001262
Harald Welte427dbc42009-08-10 00:26:10 +02001263 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1264 lchan->T3101.cb = t3101_expired;
1265 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001266 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001267
1268 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001269 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001270}
1271
1272/* MS has requested a channel on the RACH */
1273static int rsl_rx_ccch_load(struct msgb *msg)
1274{
1275 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1276 u_int16_t pg_buf_space;
1277 u_int16_t rach_slot_count = -1;
1278 u_int16_t rach_busy_count = -1;
1279 u_int16_t rach_access_count = -1;
1280
1281 switch (rslh->data[0]) {
1282 case RSL_IE_PAGING_LOAD:
1283 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001284 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1285 /* paging load below configured threshold, use 50 as default */
1286 pg_buf_space = 50;
1287 }
Harald Welte59b04682009-06-10 05:40:52 +08001288 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1289 break;
1290 case RSL_IE_RACH_LOAD:
1291 if (msg->data_len >= 7) {
1292 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1293 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1294 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1295 }
1296 break;
1297 default:
1298 break;
1299 }
1300
1301 return 0;
1302}
1303
1304static int abis_rsl_rx_cchan(struct msgb *msg)
1305{
1306 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1307 int rc = 0;
1308
1309 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1310
1311 switch (rslh->c.msg_type) {
1312 case RSL_MT_CHAN_RQD:
1313 /* MS has requested a channel on the RACH */
1314 rc = rsl_rx_chan_rqd(msg);
1315 break;
1316 case RSL_MT_CCCH_LOAD_IND:
1317 /* current load on the CCCH */
1318 rc = rsl_rx_ccch_load(msg);
1319 break;
1320 case RSL_MT_DELETE_IND:
1321 /* CCCH overloaded, IMM_ASSIGN was dropped */
1322 case RSL_MT_CBCH_LOAD_IND:
1323 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001324 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1325 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001326 break;
1327 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001328 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1329 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001330 return -EINVAL;
1331 }
1332
1333 return rc;
1334}
1335
1336static int rsl_rx_rll_err_ind(struct msgb *msg)
1337{
1338 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1339 u_int8_t *rlm_cause = rllh->data;
1340
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001341 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001342 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001343 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001344
1345 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001346
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001347 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1348 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001349 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001350 }
Harald Welte692f5852009-07-04 09:40:05 +02001351
Harald Welte59b04682009-06-10 05:40:52 +08001352 return 0;
1353}
1354
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001355static void rsl_handle_release(struct gsm_lchan *lchan)
1356{
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001357 struct gsm_bts *bts;
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001358 if (lchan->state != LCHAN_S_REL_REQ)
1359 LOGP(DRSL, LOGL_ERROR, "RF release on %s but state %s\n",
1360 gsm_lchan_name(lchan),
1361 gsm_lchans_name(lchan->state));
1362
1363
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001364 /* wait a bit to send the RF Channel Release */
1365 lchan->T3111.cb = t3111_expired;
1366 lchan->T3111.data = lchan;
1367 bts = lchan->ts->trx->bts;
1368 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001369}
1370
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001371/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001372 0x02, 0x06,
1373 0x01, 0x20,
1374 0x02, 0x00,
1375 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1376
1377static int abis_rsl_rx_rll(struct msgb *msg)
1378{
1379 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1380 int rc = 0;
1381 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001382 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001383
1384 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001385 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001386 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001387
1388 switch (rllh->c.msg_type) {
1389 case RSL_MT_DATA_IND:
1390 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001391 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001392 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1393 rllh->data[0] == RSL_IE_L3_INFO) {
1394 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001395 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001396 }
1397 break;
1398 case RSL_MT_EST_IND:
1399 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001400 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001401 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001402 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001403 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001404 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1405 rllh->data[0] == RSL_IE_L3_INFO) {
1406 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001407 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001408 }
1409 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001410 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001411 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001412 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001413 rll_indication(msg->lchan, rllh->link_id,
1414 BSC_RLLR_IND_EST_CONF);
1415 break;
Harald Welte59b04682009-06-10 05:40:52 +08001416 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001417 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001418 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001419 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001420 rll_indication(msg->lchan, rllh->link_id,
1421 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001422 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001423 break;
1424 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001425 /* BTS informs us of having received UA from MS,
1426 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001427 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001428 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001429 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001430 break;
1431 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001432 rc = rsl_rx_rll_err_ind(msg);
1433 break;
1434 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001435 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1436 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001437 break;
1438 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001439 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1440 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001441 }
Harald Welte59b04682009-06-10 05:40:52 +08001442 return rc;
1443}
1444
Harald Welteb284b472009-12-02 01:58:23 +05301445static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001446{
Harald Welteb284b472009-12-02 01:58:23 +05301447 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001448 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301449 switch (lchan->type) {
1450 case GSM_LCHAN_TCH_F:
1451 return 0x00;
1452 case GSM_LCHAN_TCH_H:
1453 return 0x03;
1454 default:
1455 break;
1456 }
Harald Welte98d79f92009-07-28 18:11:56 +02001457 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301458 switch (lchan->type) {
1459 case GSM_LCHAN_TCH_F:
1460 return 0x01;
1461 /* there's no half-rate EFR */
1462 default:
1463 break;
1464 }
Harald Welte98d79f92009-07-28 18:11:56 +02001465 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301466 switch (lchan->type) {
1467 case GSM_LCHAN_TCH_F:
1468 return 0x02;
1469 case GSM_LCHAN_TCH_H:
1470 return 0x05;
1471 default:
1472 break;
1473 }
1474 default:
1475 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001476 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001477 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301478 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001479 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001480}
1481
Sylvain Munaut1338a552009-12-20 22:06:40 +01001482static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1483{
1484 switch (lchan->tch_mode) {
1485 case GSM48_CMODE_SPEECH_V1:
1486 switch (lchan->type) {
1487 case GSM_LCHAN_TCH_F:
1488 return RTP_PT_GSM_FULL;
1489 case GSM_LCHAN_TCH_H:
1490 return RTP_PT_GSM_HALF;
1491 default:
1492 break;
1493 }
1494 case GSM48_CMODE_SPEECH_EFR:
1495 switch (lchan->type) {
1496 case GSM_LCHAN_TCH_F:
1497 return RTP_PT_GSM_EFR;
1498 /* there's no half-rate EFR */
1499 default:
1500 break;
1501 }
1502 case GSM48_CMODE_SPEECH_AMR:
1503 switch (lchan->type) {
1504 case GSM_LCHAN_TCH_F:
1505 return RTP_PT_AMR_FULL;
1506 case GSM_LCHAN_TCH_H:
1507 return RTP_PT_AMR_HALF;
1508 default:
1509 break;
1510 }
1511 default:
1512 break;
1513 }
1514 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1515 "tch_mode == 0x%02x\n & lchan_type == %d",
1516 lchan->tch_mode, lchan->type);
1517 return 0;
1518}
1519
Harald Welte59b04682009-06-10 05:40:52 +08001520/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001521static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1522{
1523 struct in_addr ip;
1524 u_int16_t port, conn_id;
1525
1526 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1527 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1528 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1529 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1530 }
1531
1532 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1533 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1534 port = ntohs(port);
1535 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1536 lchan->abis_ip.bound_port = port;
1537 }
1538
1539 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1540 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1541 conn_id = ntohs(conn_id);
1542 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1543 lchan->abis_ip.conn_id = conn_id;
1544 }
1545
1546 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1547 lchan->abis_ip.rtp_payload2 =
1548 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1549 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1550 lchan->abis_ip.rtp_payload2);
1551 }
1552
1553 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1554 lchan->abis_ip.speech_mode =
1555 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1556 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1557 lchan->abis_ip.speech_mode);
1558 }
1559
1560 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1561 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1562 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1563 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1564 }
1565
1566 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1567 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1568 port = ntohs(port);
1569 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1570 lchan->abis_ip.connect_port = port;
1571 }
1572}
1573
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001574int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001575{
1576 struct msgb *msg = rsl_msgb_alloc();
1577 struct abis_rsl_dchan_hdr *dh;
1578
1579 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001580 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001581 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1582 dh->chan_nr = lchan2chan_nr(lchan);
1583
Harald Welte98d79f92009-07-28 18:11:56 +02001584 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001585 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001586 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001587 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001588 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001589
Sylvain Munaut1338a552009-12-20 22:06:40 +01001590 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1591 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1592 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001593
Harald Welte59b04682009-06-10 05:40:52 +08001594 msg->trx = lchan->ts->trx;
1595
1596 return abis_rsl_sendmsg(msg);
1597}
1598
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001599int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001600 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001601{
1602 struct msgb *msg = rsl_msgb_alloc();
1603 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001604 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001605 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001606
1607 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001608 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001609 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1610 dh->chan_nr = lchan2chan_nr(lchan);
1611
Harald Weltebffa4992009-12-19 16:42:06 +01001612 /* we need to store these now as MDCX_ACK does not return them :( */
1613 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1614 lchan->abis_ip.connect_port = port;
1615 lchan->abis_ip.connect_ip = ip;
1616
Harald Weltefb4a9e92009-07-29 12:12:18 +02001617 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001618 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001619 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001620
Harald Welte98d79f92009-07-28 18:11:56 +02001621 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001622 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1623 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1624 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1625 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001626
Harald Weltebffa4992009-12-19 16:42:06 +01001627 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1628 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1629 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1630 *att_ip = ia.s_addr;
1631 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1632 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001633 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001634 if (rtp_payload2)
1635 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1636
Harald Welte59b04682009-06-10 05:40:52 +08001637 msg->trx = lchan->ts->trx;
1638
1639 return abis_rsl_sendmsg(msg);
1640}
1641
Harald Welte9947d9f2009-12-20 16:51:09 +01001642/* tell BTS to connect RTP stream to our local RTP socket */
1643int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1644{
1645 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1646 int rc;
1647
1648 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1649 ntohs(rs->rtp.sin_local.sin_port),
1650 /* FIXME: use RTP payload of bound socket, not BTS*/
1651 lchan->abis_ip.rtp_payload2);
1652
1653 return rc;
1654}
1655
Harald Welte2b361522010-03-28 14:42:09 +08001656int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001657{
1658 struct msgb *msg = rsl_msgb_alloc();
1659 struct abis_rsl_dchan_hdr *dh;
Harald Welte2b361522010-03-28 14:42:09 +08001660 u_int8_t msg_type;
1661
1662 if (act)
1663 msg_type = RSL_MT_IPAC_PDCH_ACT;
1664 else
1665 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001666
1667 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001668 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001669 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1670 dh->chan_nr = lchan2chan_nr(lchan);
1671
Harald Welte2b361522010-03-28 14:42:09 +08001672 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_lchan_name(lchan),
1673 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001674
1675 msg->trx = lchan->ts->trx;
1676
1677 return abis_rsl_sendmsg(msg);
1678}
1679
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001680static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001681{
1682 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1683 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301684 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001685
1686 /* the BTS has acknowledged a local bind, it now tells us the IP
1687 * address and port number to which it has bound the given logical
1688 * channel */
1689
1690 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1691 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1692 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001693 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001694 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001695 return -EINVAL;
1696 }
Harald Welte50517742009-12-20 15:42:44 +01001697
Harald Weltebffa4992009-12-19 16:42:06 +01001698 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001699
1700 /* in case we don't use direct BTS-to-BTS RTP */
1701 if (!ipacc_rtp_direct) {
1702 int rc;
1703 /* the BTS has successfully bound a TCH to a local ip/port,
1704 * which means we can connect our UDP socket to it */
1705 if (lchan->abis_ip.rtp_socket) {
1706 rtp_socket_free(lchan->abis_ip.rtp_socket);
1707 lchan->abis_ip.rtp_socket = NULL;
1708 }
1709
1710 lchan->abis_ip.rtp_socket = rtp_socket_create();
1711 if (!lchan->abis_ip.rtp_socket)
1712 goto out_err;
1713
1714 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1715 lchan->abis_ip.bound_ip,
1716 lchan->abis_ip.bound_port);
1717 if (rc < 0)
1718 goto out_err;
1719 }
1720
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001721 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001722
1723 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001724out_err:
1725 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001726}
1727
Harald Weltebffa4992009-12-19 16:42:06 +01001728static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1729{
1730 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1731 struct tlv_parsed tv;
1732 struct gsm_lchan *lchan = msg->lchan;
1733
1734 /* the BTS has acknowledged a remote connect request and
1735 * it now tells us the IP address and port number to which it has
1736 * connected the given logical channel */
1737
1738 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1739 ipac_parse_rtp(lchan, &tv);
1740 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1741
1742 return 0;
1743}
1744
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001745static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001746{
1747 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1748 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001749 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001750
1751 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001752
Harald Weltef1a168d2009-07-28 17:58:09 +02001753 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001754 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001755 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001756
Harald Welte50517742009-12-20 15:42:44 +01001757 /* the BTS tells us a RTP stream has been disconnected */
1758 if (lchan->abis_ip.rtp_socket) {
1759 rtp_socket_free(lchan->abis_ip.rtp_socket);
1760 lchan->abis_ip.rtp_socket = NULL;
1761 }
1762
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001763 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001764
Harald Welte59b04682009-06-10 05:40:52 +08001765 return 0;
1766}
1767
1768static int abis_rsl_rx_ipacc(struct msgb *msg)
1769{
1770 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001771 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001772 int rc = 0;
1773
1774 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001775 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001776
1777 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001778 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001779 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001780 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001781 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001782 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001783 /* somehow the BTS was unable to bind the lchan to its local
1784 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001785 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001786 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001787 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001788 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001789 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001790 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001791 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001792 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001793 /* somehow the BTS was unable to connect the lchan to a remote
1794 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001795 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001796 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001797 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001798 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001799 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001800 break;
1801 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001802 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001803 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001804 break;
1805 }
1806 DEBUGPC(DRSL, "\n");
1807
1808 return rc;
1809}
1810
1811
1812/* Entry-point where L2 RSL from BTS enters */
1813int abis_rsl_rcvmsg(struct msgb *msg)
1814{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001815 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001816 int rc = 0;
1817
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001818 if (!msg) {
1819 DEBUGP(DRSL, "Empty RSL msg?..\n");
1820 return -1;
1821 }
1822
1823 if (msgb_l2len(msg) < sizeof(*rslh)) {
1824 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1825 return -1;
1826 }
1827
1828 rslh = msgb_l2(msg);
1829
Harald Welte59b04682009-06-10 05:40:52 +08001830 switch (rslh->msg_discr & 0xfe) {
1831 case ABIS_RSL_MDISC_RLL:
1832 rc = abis_rsl_rx_rll(msg);
1833 break;
1834 case ABIS_RSL_MDISC_DED_CHAN:
1835 rc = abis_rsl_rx_dchan(msg);
1836 break;
1837 case ABIS_RSL_MDISC_COM_CHAN:
1838 rc = abis_rsl_rx_cchan(msg);
1839 break;
1840 case ABIS_RSL_MDISC_TRX:
1841 rc = abis_rsl_rx_trx(msg);
1842 break;
1843 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001844 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001845 rslh->msg_discr);
1846 break;
1847 case ABIS_RSL_MDISC_IPACCESS:
1848 rc = abis_rsl_rx_ipacc(msg);
1849 break;
1850 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001851 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1852 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001853 return -EINVAL;
1854 }
1855 msgb_free(msg);
1856 return rc;
1857}
1858
Harald Welte59b04682009-06-10 05:40:52 +08001859/* From Table 10.5.33 of GSM 04.08 */
1860int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1861{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301862 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1863 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1864 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001865 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301866 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1867 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001868 }
1869}