blob: cba4f672d9120006fa701cecbea39e00e72a4e37 [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 Welte59b04682009-06-10 05:40:52 +0800430
431 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800432 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200433 struct gsm48_chan_desc cd;
434 uint8_t *msgb_cd;
Harald Welte59b04682009-06-10 05:40:52 +0800435
Harald Welte39274f42009-07-29 15:41:29 +0200436 rc = channel_mode_from_lchan(&cm, lchan);
437 if (rc < 0)
438 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800439
laforgef723cf02010-06-20 21:38:19 +0200440 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800441
Harald Welteed831842009-06-27 03:09:08 +0200442 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800443 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
444 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
445 dh->chan_nr = chan_nr;
446
447 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800448 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
449 (u_int8_t *) &cm);
Harald Welteb90d7bd2009-12-17 00:31:10 +0100450 /* For compatibility with Phase 1 */
laforgef723cf02010-06-20 21:38:19 +0200451 /* RSL IE TAG */
452 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
453 /* RSL IE LEN: 04.08_cd_tag + CD + 04.08_ma_tag + 04.08_ma_len + ma_len */
454 msgb_v_put(msg, 1 + sizeof(struct gsm48_chan_desc) + 2 + lchan->ts->hopping.ma_len);
455 /* GSM 04.08 Chan Desc 2 (TAG + fixed 3 byte length V) */
456 msgb_v_put(msg, GSM48_IE_CHANDESC_2);
457 msgb_cd = msgb_put(msg, sizeof(cd));
458 memcpy(msgb_cd, &cd, sizeof(cd));
459 /* GSM 04.08 Mobile Allocation: TLV */
460 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
461 lchan->ts->hopping.ma_data);
462
Harald Welted2dd9de2009-08-30 15:37:11 +0900463 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
464 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
465 rc = build_encr_info(encr_info, lchan);
466 if (rc > 0)
467 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
468 }
469
Harald Welteb90d7bd2009-12-17 00:31:10 +0100470 switch (act_type) {
471 case RSL_ACT_INTER_ASYNC:
472 case RSL_ACT_INTER_SYNC:
473 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
474 break;
475 default:
476 break;
477 }
478
Harald Welte59b04682009-06-10 05:40:52 +0800479 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
480 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
481 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
482
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100483 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
484 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
485 (u_int8_t *) &lchan->mr_conf);
486
Harald Welte59b04682009-06-10 05:40:52 +0800487 msg->trx = lchan->ts->trx;
488
489 return abis_rsl_sendmsg(msg);
490}
491
Harald Welte8e770492009-07-29 11:38:15 +0200492/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800493int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
494{
495 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200496 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200497 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800498
499 u_int8_t chan_nr = lchan2chan_nr(lchan);
500 struct rsl_ie_chan_mode cm;
501
Harald Welte39274f42009-07-29 15:41:29 +0200502 rc = channel_mode_from_lchan(&cm, lchan);
503 if (rc < 0)
504 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800505
Harald Welteed831842009-06-27 03:09:08 +0200506 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800507 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
508 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
509 dh->chan_nr = chan_nr;
510
511 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
512 (u_int8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900513
514 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
515 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
516 rc = build_encr_info(encr_info, lchan);
517 if (rc > 0)
518 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
519 }
520
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100521 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
522 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
523 (u_int8_t *) &lchan->mr_conf);
524 }
525
Harald Welted2dd9de2009-08-30 15:37:11 +0900526 msg->trx = lchan->ts->trx;
527
528 return abis_rsl_sendmsg(msg);
529}
530
531/* Chapter 8.4.6: Send the encryption command with given L3 info */
532int rsl_encryption_cmd(struct msgb *msg)
533{
534 struct abis_rsl_dchan_hdr *dh;
535 struct gsm_lchan *lchan = msg->lchan;
536 u_int8_t chan_nr = lchan2chan_nr(lchan);
537 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut01f1caf2009-09-27 11:13:18 +0200538 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900539 int rc;
540
541 /* First push the L3 IE tag and length */
542 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
543
544 /* then the link identifier (SAPI0, main sign link) */
545 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
546
547 /* then encryption information */
548 rc = build_encr_info(encr_info, lchan);
549 if (rc <= 0)
550 return rc;
551 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
552
553 /* and finally the DCHAN header */
554 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
555 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
556 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800557
558 msg->trx = lchan->ts->trx;
559
560 return abis_rsl_sendmsg(msg);
561}
562
Harald Welte85a163c2009-08-10 11:43:22 +0200563/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200564int rsl_deact_sacch(struct gsm_lchan *lchan)
565{
566 struct abis_rsl_dchan_hdr *dh;
567 struct msgb *msg = rsl_msgb_alloc();
568
569 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
570 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
571 dh->chan_nr = lchan2chan_nr(lchan);
572
573 msg->lchan = lchan;
574 msg->trx = lchan->ts->trx;
575
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100576 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200577
578 return abis_rsl_sendmsg(msg);
579}
580
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800581static void error_timeout_cb(void *data)
582{
583 struct gsm_lchan *lchan = data;
584 if (lchan->state != LCHAN_S_REL_ERR) {
585 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
586 gsm_lchan_name(lchan), lchan->state);
587 return;
588 }
589
590 /* go back to the none state */
591 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800592 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800593}
594
Harald Welte85a163c2009-08-10 11:43:22 +0200595/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800596static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800597{
598 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800599 struct msgb *msg;
Harald Welte59b04682009-06-10 05:40:52 +0800600
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800601 if (lchan->state == LCHAN_S_REL_ERR) {
602 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
603 gsm_lchan_name(lchan));
604 return -1;
605 }
606
607 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800608 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
609 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
610 dh->chan_nr = lchan2chan_nr(lchan);
611
612 msg->lchan = lchan;
613 msg->trx = lchan->ts->trx;
614
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800615 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
616
617 if (error) {
618 /*
619 * the nanoBTS sends RLL release indications after the channel release. This can
620 * be a problem when we have reassigned the channel to someone else and then can
621 * not figure out who used this channel.
622 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800623 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800624 lchan->error_timer.data = lchan;
625 lchan->error_timer.cb = error_timeout_cb;
626 bsc_schedule_timer(&lchan->error_timer,
627 msg->trx->bts->network->T3111 + 2, 0);
628 }
Harald Welte59b04682009-06-10 05:40:52 +0800629
Harald Welte85a163c2009-08-10 11:43:22 +0200630 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800631 return abis_rsl_sendmsg(msg);
632}
633
634int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
635 u_int8_t *ms_ident, u_int8_t chan_needed)
636{
637 struct abis_rsl_dchan_hdr *dh;
638 struct msgb *msg = rsl_msgb_alloc();
639
640 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
641 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
642 dh->chan_nr = RSL_CHAN_PCH_AGCH;
643
644 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
645 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
646 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
647
648 msg->trx = bts->c0;
649
650 return abis_rsl_sendmsg(msg);
651}
652
653int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
654 struct gsm_subscriber *subscr)
655{
656#if 0
657 u_int8_t mi[128];
658 unsigned int mi_len;
659 u_int8_t paging_group;
660#endif
661
662 return -1;
663}
664
665int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
666{
667 int i, len = strlen(str_in);
668
669 for (i = 0; i < len; i++) {
670 int num = str_in[i] - 0x30;
671 if (num < 0 || num > 9)
672 return -1;
673 if (i % 2 == 0)
674 bcd_out[i/2] = num;
675 else
676 bcd_out[i/2] |= (num << 4);
677 }
678
679 return 0;
680}
681
682/* Chapter 8.5.6 */
683int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
684{
685 struct msgb *msg = rsl_msgb_alloc();
686 struct abis_rsl_dchan_hdr *dh;
687 u_int8_t buf[MACBLOCK_SIZE];
688
689 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
690 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
691 dh->chan_nr = RSL_CHAN_PCH_AGCH;
692
693 switch (bts->type) {
694 case GSM_BTS_TYPE_BS11:
695 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
696 break;
697 default:
698 /* If phase 2, construct a FULL_IMM_ASS_INFO */
699 pad_macblock(buf, val, len);
700 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
701 break;
702 }
703
704 msg->trx = bts->c0;
705
706 return abis_rsl_sendmsg(msg);
707}
708
Harald Welte4684e632009-08-10 09:51:40 +0200709/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200710int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200711{
712 struct msgb *msg = rsl_msgb_alloc();
713 struct abis_rsl_dchan_hdr *dh;
714
715 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
716 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200717 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200718 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200719 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200720
Harald Weltede4477a2009-12-24 12:20:20 +0100721 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100722 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200723
724 msg->trx = lchan->ts->trx;
725
Harald Welte4684e632009-08-10 09:51:40 +0200726 return abis_rsl_sendmsg(msg);
727}
728
729
Harald Welte59b04682009-06-10 05:40:52 +0800730/* Send "DATA REQUEST" message with given L3 Info payload */
731/* Chapter 8.3.1 */
732int rsl_data_request(struct msgb *msg, u_int8_t link_id)
733{
Harald Welte59b04682009-06-10 05:40:52 +0800734 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100735 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800736 return -EINVAL;
737 }
738
Harald Weltea22d36b2010-03-04 10:33:10 +0100739 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
740 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800741
742 msg->trx = msg->lchan->ts->trx;
743
744 return abis_rsl_sendmsg(msg);
745}
746
Harald Welteed9a5ab2009-08-09 13:47:35 +0200747/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
748/* Chapter 8.3.1 */
749int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
750{
Harald Weltea22d36b2010-03-04 10:33:10 +0100751 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200752
Harald Weltea22d36b2010-03-04 10:33:10 +0100753 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
754 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200755 msg->trx = lchan->ts->trx;
756
757 return abis_rsl_sendmsg(msg);
758}
759
Harald Welte0f2e3c12009-08-08 13:15:07 +0200760/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
761 This is what higher layers should call. The BTS then responds with
762 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
763 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
764 lchan_free() */
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800765int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200766{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200767
Harald Weltea22d36b2010-03-04 10:33:10 +0100768 struct msgb *msg;
769
770 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
771 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800772 /* 0 is normal release, 1 is local end */
773 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200774
Harald Weltec88a4432009-12-29 10:44:17 +0100775 /* FIXME: start some timer in case we don't receive a REL ACK ? */
776
Harald Welte0f2e3c12009-08-08 13:15:07 +0200777 msg->trx = lchan->ts->trx;
778
779 return abis_rsl_sendmsg(msg);
780}
781
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200782int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
783{
784 lchan->state = state;
785 return 0;
786}
787
Harald Welte59b04682009-06-10 05:40:52 +0800788/* Chapter 8.4.2: Channel Activate Acknowledge */
789static int rsl_rx_chan_act_ack(struct msgb *msg)
790{
791 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
792
793 /* BTS has confirmed channel activation, we now need
794 * to assign the activated channel to the MS */
795 if (rslh->ie_chan != RSL_IE_CHAN_NR)
796 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100797
Harald Weltec88a4432009-12-29 10:44:17 +0100798 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100799 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
800 gsm_lchan_name(msg->lchan),
801 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200802 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100803
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800804 if (msg->lchan->rqd_ref) {
805 rsl_send_imm_assignment(msg->lchan);
806 talloc_free(msg->lchan->rqd_ref);
807 msg->lchan->rqd_ref = NULL;
808 msg->lchan->rqd_ta = 0;
809 }
810
Harald Welte6720a432009-11-29 22:45:52 +0100811 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
812
Harald Welte59b04682009-06-10 05:40:52 +0800813 return 0;
814}
815
816/* Chapter 8.4.3: Channel Activate NACK */
817static int rsl_rx_chan_act_nack(struct msgb *msg)
818{
819 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
820 struct tlv_parsed tp;
821
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100822 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100823 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100824
Harald Welte59b04682009-06-10 05:40:52 +0800825 /* BTS has rejected channel activation ?!? */
826 if (dh->ie_chan != RSL_IE_CHAN_NR)
827 return -EINVAL;
828
829 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100830 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
831 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
832 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200833 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100834 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200835 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100836 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200837 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200838
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100839 LOGPC(DRSL, LOGL_ERROR, "\n");
840
Harald Welte6720a432009-11-29 22:45:52 +0100841 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
842
Harald Weltecddb9802009-08-09 19:50:08 +0200843 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800844 return 0;
845}
846
847/* Chapter 8.4.4: Connection Failure Indication */
848static int rsl_rx_conn_fail(struct msgb *msg)
849{
850 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
851 struct tlv_parsed tp;
852
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100853 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100854 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100855 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800856
857 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
858
Harald Weltef1a168d2009-07-28 17:58:09 +0200859 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100860 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200861 TLVP_LEN(&tp, RSL_IE_CAUSE));
862
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100863 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800864 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +0200865 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800866 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800867}
868
Harald Weltec20bd1d2009-11-29 19:07:28 +0100869static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
870 const char *prefix)
871{
Harald Welte0e4fa782009-12-16 16:52:07 +0100872 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
873 prefix, rxlev2dbm(mru->full.rx_lev),
874 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100875 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
876 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
877}
878
879static void print_meas_rep(struct gsm_meas_rep *mr)
880{
Harald Welte0e4fa782009-12-16 16:52:07 +0100881 int i;
882
Harald Weltec20bd1d2009-11-29 19:07:28 +0100883 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
884
885 if (mr->flags & MEAS_REP_F_DL_DTX)
886 DEBUGPC(DMEAS, "DTXd ");
887
888 print_meas_rep_uni(&mr->ul, "ul");
889 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
890 if (mr->flags & MEAS_REP_F_MS_TO)
891 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
892
893 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100894 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100895 DEBUGPC(DMEAS, "L1_FPC=%u ",
896 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
897 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
898 }
899
900 if (mr->flags & MEAS_REP_F_UL_DTX)
901 DEBUGPC(DMEAS, "DTXu ");
902 if (mr->flags & MEAS_REP_F_BA1)
903 DEBUGPC(DMEAS, "BA1 ");
904 if (!(mr->flags & MEAS_REP_F_DL_VALID))
905 DEBUGPC(DMEAS, "NOT VALID ");
906 else
907 print_meas_rep_uni(&mr->dl, "dl");
908
909 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100910 if (mr->num_cell == 7)
911 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100912 for (i = 0; i < mr->num_cell; i++) {
913 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100914 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
915 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100916 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100917}
918
Harald Welte59b04682009-06-10 05:40:52 +0800919static int rsl_rx_meas_res(struct msgb *msg)
920{
921 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
922 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100923 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100924 u_int8_t len;
925 const u_int8_t *val;
926 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800927
Harald Welte4baa9c52009-12-21 13:27:11 +0100928 /* check if this channel is actually active */
929 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100930 if (msg->lchan->state != LCHAN_S_ACTIVE) {
931 LOGP(DRSL, LOGL_NOTICE, "%s: MEAS RES for inactive channel\n",
932 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100933 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100934 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100935
Harald Weltef9476812009-12-15 21:36:05 +0100936 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100937 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100938
Harald Welte59b04682009-06-10 05:40:52 +0800939 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
940
Harald Weltec20bd1d2009-11-29 19:07:28 +0100941 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
942 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
943 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
944 return -EIO;
945
946 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100947 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100948
949 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
950 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
951 if (len >= 3) {
952 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +0100953 mr->flags |= MEAS_REP_F_DL_DTX;
954 mr->ul.full.rx_lev = val[0] & 0x3f;
955 mr->ul.sub.rx_lev = val[1] & 0x3f;
956 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
957 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +0800958 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100959
Harald Weltef9476812009-12-15 21:36:05 +0100960 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100961
962 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800963 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +0100964 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +0100965 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
966
Harald Weltea1467eb2009-06-20 18:44:35 +0200967 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +0100968 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100969 mr->flags |= MEAS_REP_F_MS_L1;
970 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100971 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +0100972 mr->flags |= MEAS_REP_F_FPC;
973 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +0200974 }
Harald Welte59b04682009-06-10 05:40:52 +0800975 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +0200976 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100977 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100978 if (rc < 0)
979 return rc;
980 }
981
Harald Weltef9476812009-12-15 21:36:05 +0100982 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +0800983
Harald Weltef9476812009-12-15 21:36:05 +0100984 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +0100985
Harald Welte59b04682009-06-10 05:40:52 +0800986 return 0;
987}
988
Harald Welte6720a432009-11-29 22:45:52 +0100989/* Chapter 8.4.7 */
990static int rsl_rx_hando_det(struct msgb *msg)
991{
992 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
993 struct tlv_parsed tp;
994
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100995 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +0100996
997 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
998
999 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1000 DEBUGPC(DRSL, "access delay = %u\n",
1001 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1002 else
1003 DEBUGPC(DRSL, "\n");
1004
1005 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1006
1007 return 0;
1008}
1009
Harald Welte59b04682009-06-10 05:40:52 +08001010static int abis_rsl_rx_dchan(struct msgb *msg)
1011{
1012 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1013 int rc = 0;
1014 char *ts_name;
1015
1016 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001017 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001018
Harald Welte59b04682009-06-10 05:40:52 +08001019 switch (rslh->c.msg_type) {
1020 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001021 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001022 rc = rsl_rx_chan_act_ack(msg);
1023 break;
1024 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001025 rc = rsl_rx_chan_act_nack(msg);
1026 break;
1027 case RSL_MT_CONN_FAIL:
1028 rc = rsl_rx_conn_fail(msg);
1029 break;
1030 case RSL_MT_MEAS_RES:
1031 rc = rsl_rx_meas_res(msg);
1032 break;
Harald Welte6720a432009-11-29 22:45:52 +01001033 case RSL_MT_HANDO_DET:
1034 rc = rsl_rx_hando_det(msg);
1035 break;
Harald Welte59b04682009-06-10 05:40:52 +08001036 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001037 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001038 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welteab2534c2009-12-29 10:52:38 +01001039 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1040 gsm_lchan_name(msg->lchan),
1041 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001042 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001043 /* we have an error timer pending to release that */
1044 if (msg->lchan->state != LCHAN_S_REL_ERR)
1045 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte59b04682009-06-10 05:40:52 +08001046 lchan_free(msg->lchan);
1047 break;
1048 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001049 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001050 break;
1051 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001052 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001053 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001054 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001055 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001056 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001057 break;
1058 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001059 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001060 break;
1061 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001062 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001063 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001064 break;
1065 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001066 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001067 break;
Harald Welte59b04682009-06-10 05:40:52 +08001068 case RSL_MT_PHY_CONTEXT_CONF:
1069 case RSL_MT_PREPROC_MEAS_RES:
1070 case RSL_MT_TALKER_DET:
1071 case RSL_MT_LISTENER_DET:
1072 case RSL_MT_REMOTE_CODEC_CONF_REP:
1073 case RSL_MT_MR_CODEC_MOD_ACK:
1074 case RSL_MT_MR_CODEC_MOD_NACK:
1075 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001076 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1077 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001078 break;
1079 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001080 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1081 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001082 return -EINVAL;
1083 }
1084
1085 return rc;
1086}
1087
1088static int rsl_rx_error_rep(struct msgb *msg)
1089{
1090 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001091 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001092
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001093 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001094
1095 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1096
1097 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001098 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001099 TLVP_LEN(&tp, RSL_IE_CAUSE));
1100
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001101 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001102
1103 return 0;
1104}
1105
1106static int abis_rsl_rx_trx(struct msgb *msg)
1107{
1108 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1109 int rc = 0;
1110
1111 switch (rslh->msg_type) {
1112 case RSL_MT_ERROR_REPORT:
1113 rc = rsl_rx_error_rep(msg);
1114 break;
1115 case RSL_MT_RF_RES_IND:
1116 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001117 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001118 break;
1119 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001120 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001121 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1122 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001123 break;
1124 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001125 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1126 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001127 return -EINVAL;
1128 }
1129 return rc;
1130}
1131
Harald Welte427dbc42009-08-10 00:26:10 +02001132/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1133static void t3101_expired(void *data)
1134{
1135 struct gsm_lchan *lchan = data;
1136
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001137 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001138}
1139
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001140/* If T3111 expires, we will send the RF Channel Request */
1141static void t3111_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, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001146}
1147
laforge50312e82010-06-21 12:08:52 +02001148#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1149
Harald Welte59b04682009-06-10 05:40:52 +08001150/* MS has requested a channel on the RACH */
1151static int rsl_rx_chan_rqd(struct msgb *msg)
1152{
1153 struct gsm_bts *bts = msg->trx->bts;
1154 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1155 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001156 enum gsm_chan_t lctype;
1157 enum gsm_chreq_reason_t chreq_reason;
1158 struct gsm_lchan *lchan;
1159 u_int8_t rqd_ta;
Harald Welte59b04682009-06-10 05:40:52 +08001160
1161 u_int16_t arfcn;
1162 u_int8_t ts_number, subch;
1163
1164 /* parse request reference to be used in immediate assign */
1165 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1166 return -EINVAL;
1167
1168 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1169
1170 /* parse access delay and use as TA */
1171 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1172 return -EINVAL;
1173 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1174
1175 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1176 * request reference RA */
Holger Hans Peter Freyther96c89822009-11-16 17:12:38 +01001177 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1178 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001179
Harald Weltebdbb7442009-12-22 19:07:32 +01001180 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001181
Harald Welte59b04682009-06-10 05:40:52 +08001182 /* check availability / allocate channel */
1183 lchan = lchan_alloc(bts, lctype);
1184 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001185 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001186 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001187 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte59b04682009-06-10 05:40:52 +08001188 /* FIXME: send some kind of reject ?!? */
1189 return -ENOMEM;
1190 }
1191
Harald Weltec88a4432009-12-29 10:44:17 +01001192 if (lchan->state != LCHAN_S_NONE)
1193 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001194 "in state %s\n", gsm_lchan_name(lchan),
1195 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001196 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001197
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001198 /* save the RACH data as we need it after the CHAN ACT ACK */
1199 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1200 if (!lchan->rqd_ref) {
1201 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1202 lchan_free(lchan);
1203 return -ENOMEM;
1204 }
1205
1206 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1207 lchan->rqd_ta = rqd_ta;
1208
Harald Welte59b04682009-06-10 05:40:52 +08001209 ts_number = lchan->ts->nr;
1210 arfcn = lchan->ts->trx->arfcn;
1211 subch = lchan->nr;
1212
Harald Welted2dd9de2009-08-30 15:37:11 +09001213 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001214 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001215 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001216 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001217 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001218
1219 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001220 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001221
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001222 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1223 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1224 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1225 rqd_ref->ra);
1226 return 0;
1227}
1228
1229static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1230{
1231 struct gsm_bts *bts = lchan->ts->trx->bts;
1232 u_int8_t buf[GSM_MACBLOCK_LEN];
1233 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1234
Harald Welte59b04682009-06-10 05:40:52 +08001235 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001236 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001237 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001238 ia->proto_discr = GSM48_PDISC_RR;
1239 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1240 ia->page_mode = GSM48_PM_SAME;
1241 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001242
Harald Welte59b04682009-06-10 05:40:52 +08001243 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001244 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1245 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001246 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001247 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001248 } else {
laforgee06d5982010-06-20 15:18:46 +02001249 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1250 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001251 }
Harald Welte07f32182010-06-28 18:41:27 +02001252 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1253 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001254
Harald Welte427dbc42009-08-10 00:26:10 +02001255 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1256 lchan->T3101.cb = t3101_expired;
1257 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001258 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001259
1260 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001261 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001262}
1263
1264/* MS has requested a channel on the RACH */
1265static int rsl_rx_ccch_load(struct msgb *msg)
1266{
1267 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1268 u_int16_t pg_buf_space;
1269 u_int16_t rach_slot_count = -1;
1270 u_int16_t rach_busy_count = -1;
1271 u_int16_t rach_access_count = -1;
1272
1273 switch (rslh->data[0]) {
1274 case RSL_IE_PAGING_LOAD:
1275 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001276 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1277 /* paging load below configured threshold, use 50 as default */
1278 pg_buf_space = 50;
1279 }
Harald Welte59b04682009-06-10 05:40:52 +08001280 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1281 break;
1282 case RSL_IE_RACH_LOAD:
1283 if (msg->data_len >= 7) {
1284 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1285 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1286 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1287 }
1288 break;
1289 default:
1290 break;
1291 }
1292
1293 return 0;
1294}
1295
1296static int abis_rsl_rx_cchan(struct msgb *msg)
1297{
1298 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1299 int rc = 0;
1300
1301 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1302
1303 switch (rslh->c.msg_type) {
1304 case RSL_MT_CHAN_RQD:
1305 /* MS has requested a channel on the RACH */
1306 rc = rsl_rx_chan_rqd(msg);
1307 break;
1308 case RSL_MT_CCCH_LOAD_IND:
1309 /* current load on the CCCH */
1310 rc = rsl_rx_ccch_load(msg);
1311 break;
1312 case RSL_MT_DELETE_IND:
1313 /* CCCH overloaded, IMM_ASSIGN was dropped */
1314 case RSL_MT_CBCH_LOAD_IND:
1315 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001316 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1317 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001318 break;
1319 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001320 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1321 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001322 return -EINVAL;
1323 }
1324
1325 return rc;
1326}
1327
1328static int rsl_rx_rll_err_ind(struct msgb *msg)
1329{
1330 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1331 u_int8_t *rlm_cause = rllh->data;
1332
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001333 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001334 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001335 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001336
1337 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001338
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001339 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1340 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001341 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001342 }
Harald Welte692f5852009-07-04 09:40:05 +02001343
Harald Welte59b04682009-06-10 05:40:52 +08001344 return 0;
1345}
1346
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001347static void rsl_handle_release(struct gsm_lchan *lchan)
1348{
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001349 struct gsm_bts *bts;
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001350 if (lchan->state != LCHAN_S_REL_REQ)
1351 LOGP(DRSL, LOGL_ERROR, "RF release on %s but state %s\n",
1352 gsm_lchan_name(lchan),
1353 gsm_lchans_name(lchan->state));
1354
1355
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001356 /* wait a bit to send the RF Channel Release */
1357 lchan->T3111.cb = t3111_expired;
1358 lchan->T3111.data = lchan;
1359 bts = lchan->ts->trx->bts;
1360 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001361}
1362
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001363/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001364 0x02, 0x06,
1365 0x01, 0x20,
1366 0x02, 0x00,
1367 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1368
1369static int abis_rsl_rx_rll(struct msgb *msg)
1370{
1371 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1372 int rc = 0;
1373 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001374 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001375
1376 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001377 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001378 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001379
1380 switch (rllh->c.msg_type) {
1381 case RSL_MT_DATA_IND:
1382 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001383 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001384 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1385 rllh->data[0] == RSL_IE_L3_INFO) {
1386 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001387 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001388 }
1389 break;
1390 case RSL_MT_EST_IND:
1391 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001392 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001393 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001394 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001395 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001396 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1397 rllh->data[0] == RSL_IE_L3_INFO) {
1398 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001399 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001400 }
1401 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001402 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001403 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001404 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001405 rll_indication(msg->lchan, rllh->link_id,
1406 BSC_RLLR_IND_EST_CONF);
1407 break;
Harald Welte59b04682009-06-10 05:40:52 +08001408 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001409 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001410 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001411 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001412 rll_indication(msg->lchan, rllh->link_id,
1413 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001414 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001415 break;
1416 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001417 /* BTS informs us of having received UA from MS,
1418 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001419 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001420 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001421 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001422 break;
1423 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001424 rc = rsl_rx_rll_err_ind(msg);
1425 break;
1426 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001427 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1428 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001429 break;
1430 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001431 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1432 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001433 }
Harald Welte59b04682009-06-10 05:40:52 +08001434 return rc;
1435}
1436
Harald Welteb284b472009-12-02 01:58:23 +05301437static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001438{
Harald Welteb284b472009-12-02 01:58:23 +05301439 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001440 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301441 switch (lchan->type) {
1442 case GSM_LCHAN_TCH_F:
1443 return 0x00;
1444 case GSM_LCHAN_TCH_H:
1445 return 0x03;
1446 default:
1447 break;
1448 }
Harald Welte98d79f92009-07-28 18:11:56 +02001449 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301450 switch (lchan->type) {
1451 case GSM_LCHAN_TCH_F:
1452 return 0x01;
1453 /* there's no half-rate EFR */
1454 default:
1455 break;
1456 }
Harald Welte98d79f92009-07-28 18:11:56 +02001457 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301458 switch (lchan->type) {
1459 case GSM_LCHAN_TCH_F:
1460 return 0x02;
1461 case GSM_LCHAN_TCH_H:
1462 return 0x05;
1463 default:
1464 break;
1465 }
1466 default:
1467 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001468 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001469 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301470 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001471 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001472}
1473
Sylvain Munaut1338a552009-12-20 22:06:40 +01001474static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1475{
1476 switch (lchan->tch_mode) {
1477 case GSM48_CMODE_SPEECH_V1:
1478 switch (lchan->type) {
1479 case GSM_LCHAN_TCH_F:
1480 return RTP_PT_GSM_FULL;
1481 case GSM_LCHAN_TCH_H:
1482 return RTP_PT_GSM_HALF;
1483 default:
1484 break;
1485 }
1486 case GSM48_CMODE_SPEECH_EFR:
1487 switch (lchan->type) {
1488 case GSM_LCHAN_TCH_F:
1489 return RTP_PT_GSM_EFR;
1490 /* there's no half-rate EFR */
1491 default:
1492 break;
1493 }
1494 case GSM48_CMODE_SPEECH_AMR:
1495 switch (lchan->type) {
1496 case GSM_LCHAN_TCH_F:
1497 return RTP_PT_AMR_FULL;
1498 case GSM_LCHAN_TCH_H:
1499 return RTP_PT_AMR_HALF;
1500 default:
1501 break;
1502 }
1503 default:
1504 break;
1505 }
1506 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1507 "tch_mode == 0x%02x\n & lchan_type == %d",
1508 lchan->tch_mode, lchan->type);
1509 return 0;
1510}
1511
Harald Welte59b04682009-06-10 05:40:52 +08001512/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001513static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1514{
1515 struct in_addr ip;
1516 u_int16_t port, conn_id;
1517
1518 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1519 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1520 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1521 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1522 }
1523
1524 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1525 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1526 port = ntohs(port);
1527 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1528 lchan->abis_ip.bound_port = port;
1529 }
1530
1531 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1532 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1533 conn_id = ntohs(conn_id);
1534 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1535 lchan->abis_ip.conn_id = conn_id;
1536 }
1537
1538 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1539 lchan->abis_ip.rtp_payload2 =
1540 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1541 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1542 lchan->abis_ip.rtp_payload2);
1543 }
1544
1545 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1546 lchan->abis_ip.speech_mode =
1547 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1548 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1549 lchan->abis_ip.speech_mode);
1550 }
1551
1552 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1553 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1554 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1555 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1556 }
1557
1558 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1559 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1560 port = ntohs(port);
1561 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1562 lchan->abis_ip.connect_port = port;
1563 }
1564}
1565
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001566int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001567{
1568 struct msgb *msg = rsl_msgb_alloc();
1569 struct abis_rsl_dchan_hdr *dh;
1570
1571 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001572 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001573 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1574 dh->chan_nr = lchan2chan_nr(lchan);
1575
Harald Welte98d79f92009-07-28 18:11:56 +02001576 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001577 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001578 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001579 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001580 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001581
Sylvain Munaut1338a552009-12-20 22:06:40 +01001582 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1583 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1584 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001585
Harald Welte59b04682009-06-10 05:40:52 +08001586 msg->trx = lchan->ts->trx;
1587
1588 return abis_rsl_sendmsg(msg);
1589}
1590
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001591int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001592 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001593{
1594 struct msgb *msg = rsl_msgb_alloc();
1595 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001596 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001597 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001598
1599 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001600 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001601 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1602 dh->chan_nr = lchan2chan_nr(lchan);
1603
Harald Weltebffa4992009-12-19 16:42:06 +01001604 /* we need to store these now as MDCX_ACK does not return them :( */
1605 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1606 lchan->abis_ip.connect_port = port;
1607 lchan->abis_ip.connect_ip = ip;
1608
Harald Weltefb4a9e92009-07-29 12:12:18 +02001609 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001610 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001611 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001612
Harald Welte98d79f92009-07-28 18:11:56 +02001613 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001614 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1615 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1616 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1617 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001618
Harald Weltebffa4992009-12-19 16:42:06 +01001619 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1620 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1621 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1622 *att_ip = ia.s_addr;
1623 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1624 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001625 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001626 if (rtp_payload2)
1627 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1628
Harald Welte59b04682009-06-10 05:40:52 +08001629 msg->trx = lchan->ts->trx;
1630
1631 return abis_rsl_sendmsg(msg);
1632}
1633
Harald Welte9947d9f2009-12-20 16:51:09 +01001634/* tell BTS to connect RTP stream to our local RTP socket */
1635int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1636{
1637 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1638 int rc;
1639
1640 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1641 ntohs(rs->rtp.sin_local.sin_port),
1642 /* FIXME: use RTP payload of bound socket, not BTS*/
1643 lchan->abis_ip.rtp_payload2);
1644
1645 return rc;
1646}
1647
Harald Welte2b361522010-03-28 14:42:09 +08001648int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001649{
1650 struct msgb *msg = rsl_msgb_alloc();
1651 struct abis_rsl_dchan_hdr *dh;
Harald Welte2b361522010-03-28 14:42:09 +08001652 u_int8_t msg_type;
1653
1654 if (act)
1655 msg_type = RSL_MT_IPAC_PDCH_ACT;
1656 else
1657 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001658
1659 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001660 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001661 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1662 dh->chan_nr = lchan2chan_nr(lchan);
1663
Harald Welte2b361522010-03-28 14:42:09 +08001664 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_lchan_name(lchan),
1665 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001666
1667 msg->trx = lchan->ts->trx;
1668
1669 return abis_rsl_sendmsg(msg);
1670}
1671
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001672static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001673{
1674 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1675 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301676 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001677
1678 /* the BTS has acknowledged a local bind, it now tells us the IP
1679 * address and port number to which it has bound the given logical
1680 * channel */
1681
1682 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1683 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1684 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001685 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001686 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001687 return -EINVAL;
1688 }
Harald Welte50517742009-12-20 15:42:44 +01001689
Harald Weltebffa4992009-12-19 16:42:06 +01001690 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001691
1692 /* in case we don't use direct BTS-to-BTS RTP */
1693 if (!ipacc_rtp_direct) {
1694 int rc;
1695 /* the BTS has successfully bound a TCH to a local ip/port,
1696 * which means we can connect our UDP socket to it */
1697 if (lchan->abis_ip.rtp_socket) {
1698 rtp_socket_free(lchan->abis_ip.rtp_socket);
1699 lchan->abis_ip.rtp_socket = NULL;
1700 }
1701
1702 lchan->abis_ip.rtp_socket = rtp_socket_create();
1703 if (!lchan->abis_ip.rtp_socket)
1704 goto out_err;
1705
1706 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1707 lchan->abis_ip.bound_ip,
1708 lchan->abis_ip.bound_port);
1709 if (rc < 0)
1710 goto out_err;
1711 }
1712
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001713 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001714
1715 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001716out_err:
1717 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001718}
1719
Harald Weltebffa4992009-12-19 16:42:06 +01001720static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1721{
1722 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1723 struct tlv_parsed tv;
1724 struct gsm_lchan *lchan = msg->lchan;
1725
1726 /* the BTS has acknowledged a remote connect request and
1727 * it now tells us the IP address and port number to which it has
1728 * connected the given logical channel */
1729
1730 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1731 ipac_parse_rtp(lchan, &tv);
1732 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1733
1734 return 0;
1735}
1736
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001737static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001738{
1739 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1740 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001741 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001742
1743 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001744
Harald Weltef1a168d2009-07-28 17:58:09 +02001745 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001746 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001747 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001748
Harald Welte50517742009-12-20 15:42:44 +01001749 /* the BTS tells us a RTP stream has been disconnected */
1750 if (lchan->abis_ip.rtp_socket) {
1751 rtp_socket_free(lchan->abis_ip.rtp_socket);
1752 lchan->abis_ip.rtp_socket = NULL;
1753 }
1754
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001755 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001756
Harald Welte59b04682009-06-10 05:40:52 +08001757 return 0;
1758}
1759
1760static int abis_rsl_rx_ipacc(struct msgb *msg)
1761{
1762 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001763 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001764 int rc = 0;
1765
1766 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001767 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001768
1769 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001770 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001771 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001772 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001773 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001774 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001775 /* somehow the BTS was unable to bind the lchan to its local
1776 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001777 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001778 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001779 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001780 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001781 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001782 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001783 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001784 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001785 /* somehow the BTS was unable to connect the lchan to a remote
1786 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001787 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001788 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001789 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001790 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001791 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001792 break;
1793 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001794 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001795 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001796 break;
1797 }
1798 DEBUGPC(DRSL, "\n");
1799
1800 return rc;
1801}
1802
1803
1804/* Entry-point where L2 RSL from BTS enters */
1805int abis_rsl_rcvmsg(struct msgb *msg)
1806{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001807 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001808 int rc = 0;
1809
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001810 if (!msg) {
1811 DEBUGP(DRSL, "Empty RSL msg?..\n");
1812 return -1;
1813 }
1814
1815 if (msgb_l2len(msg) < sizeof(*rslh)) {
1816 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1817 return -1;
1818 }
1819
1820 rslh = msgb_l2(msg);
1821
Harald Welte59b04682009-06-10 05:40:52 +08001822 switch (rslh->msg_discr & 0xfe) {
1823 case ABIS_RSL_MDISC_RLL:
1824 rc = abis_rsl_rx_rll(msg);
1825 break;
1826 case ABIS_RSL_MDISC_DED_CHAN:
1827 rc = abis_rsl_rx_dchan(msg);
1828 break;
1829 case ABIS_RSL_MDISC_COM_CHAN:
1830 rc = abis_rsl_rx_cchan(msg);
1831 break;
1832 case ABIS_RSL_MDISC_TRX:
1833 rc = abis_rsl_rx_trx(msg);
1834 break;
1835 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001836 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001837 rslh->msg_discr);
1838 break;
1839 case ABIS_RSL_MDISC_IPACCESS:
1840 rc = abis_rsl_rx_ipacc(msg);
1841 break;
1842 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001843 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1844 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001845 return -EINVAL;
1846 }
1847 msgb_free(msg);
1848 return rc;
1849}
1850
Harald Welte59b04682009-06-10 05:40:52 +08001851/* From Table 10.5.33 of GSM 04.08 */
1852int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1853{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301854 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1855 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1856 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001857 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301858 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1859 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001860 }
1861}