blob: 07a7dc68c1099a8c694c02d5a0b70ad919858300 [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
Harald Welte0e3e88e2011-01-01 15:25:50 +01009 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
Harald Welte59b04682009-06-10 05:40:52 +080011 * (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
Harald Welte0e3e88e2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte59b04682009-06-10 05:40:52 +080017 *
Harald Welte0e3e88e2011-01-01 15:25:50 +010018 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte59b04682009-06-10 05:40:52 +080020 *
21 */
22
23#include <stdio.h>
24#include <stdlib.h>
25#include <errno.h>
26#include <sys/types.h>
27#include <netinet/in.h>
28#include <arpa/inet.h>
29
30#include <openbsc/gsm_data.h>
31#include <openbsc/gsm_04_08.h>
Harald Weltef4625b12010-02-20 16:24:02 +010032#include <osmocore/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080033#include <openbsc/abis_rsl.h>
34#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020035#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080036#include <openbsc/debug.h>
Harald Weltef4625b12010-02-20 16:24:02 +010037#include <osmocore/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080038#include <openbsc/paging.h>
39#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010040#include <openbsc/meas_rep.h>
Harald Welte50517742009-12-20 15:42:44 +010041#include <openbsc/rtp_proxy.h>
Harald Welte1fa8bac2010-03-01 21:59:06 +010042#include <osmocore/rsl.h>
Harald Welte59b04682009-06-10 05:40:52 +080043
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080044#include <osmocore/talloc.h>
45
Harald Welte59b04682009-06-10 05:40:52 +080046#define RSL_ALLOC_SIZE 1024
47#define RSL_ALLOC_HEADROOM 128
48
49#define MAX(a, b) (a) >= (b) ? (a) : (b)
50
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080051static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
52
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010053static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
54 struct gsm_meas_rep *resp)
55{
56 struct lchan_signal_data sig;
57 sig.lchan = lchan;
58 sig.mr = resp;
59 dispatch_signal(SS_LCHAN, sig_no, &sig);
60}
61
Harald Welte59b04682009-06-10 05:40:52 +080062static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
63{
64 /* mask off the transparent bit ? */
65 msg_type &= 0xfe;
66
67 if ((msg_type & 0xf0) == 0x00)
68 return ABIS_RSL_MDISC_RLL;
69 if ((msg_type & 0xf0) == 0x10) {
70 if (msg_type >= 0x19 && msg_type <= 0x22)
71 return ABIS_RSL_MDISC_TRX;
72 else
73 return ABIS_RSL_MDISC_COM_CHAN;
74 }
75 if ((msg_type & 0xe0) == 0x20)
76 return ABIS_RSL_MDISC_DED_CHAN;
77
78 return ABIS_RSL_MDISC_LOC;
79}
80
81static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
82 u_int8_t msg_type)
83{
84 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
85 dh->c.msg_type = msg_type;
86 dh->ie_chan = RSL_IE_CHAN_NR;
87}
88
Harald Welte59b04682009-06-10 05:40:52 +080089/* determine logical channel based on TRX and channel number IE */
90struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
91{
92 struct gsm_lchan *lchan;
93 u_int8_t ts_nr = chan_nr & 0x07;
94 u_int8_t cbits = chan_nr >> 3;
95 u_int8_t lch_idx;
96 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
97
98 if (cbits == 0x01) {
99 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +0200100 if (ts->pchan != GSM_PCHAN_TCH_F &&
101 ts->pchan != GSM_PCHAN_PDCH &&
102 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100103 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800104 chan_nr, ts->pchan);
105 } else if ((cbits & 0x1e) == 0x02) {
106 lch_idx = cbits & 0x1; /* TCH/H */
107 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100108 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800109 chan_nr, ts->pchan);
110 } else if ((cbits & 0x1c) == 0x04) {
111 lch_idx = cbits & 0x3; /* SDCCH/4 */
112 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100113 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800114 chan_nr, ts->pchan);
115 } else if ((cbits & 0x18) == 0x08) {
116 lch_idx = cbits & 0x7; /* SDCCH/8 */
117 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100118 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800119 chan_nr, ts->pchan);
120 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
121 lch_idx = 0;
122 if (ts->pchan != GSM_PCHAN_CCCH &&
123 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100124 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800125 chan_nr, ts->pchan);
126 /* FIXME: we should not return first sdcch4 !!! */
127 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100128 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800129 return NULL;
130 }
131
132 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800133 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800134 if (lchan->conn)
135 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800136
137 return lchan;
138}
139
Holger Hans Peter Freyther942ff172009-10-22 11:47:45 +0200140/* See Table 10.5.25 of GSM04.08 */
Harald Welte6f40df02010-12-23 12:59:52 +0100141static u_int8_t ts2chan_nr(const struct gsm_bts_trx_ts *ts, uint8_t lchan_nr)
Harald Welte59b04682009-06-10 05:40:52 +0800142{
Harald Welte59b04682009-06-10 05:40:52 +0800143 u_int8_t cbits, chan_nr;
144
145 switch (ts->pchan) {
146 case GSM_PCHAN_TCH_F:
Harald Welte37884ed2009-10-24 10:25:50 +0200147 case GSM_PCHAN_PDCH:
148 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte59b04682009-06-10 05:40:52 +0800149 cbits = 0x01;
150 break;
151 case GSM_PCHAN_TCH_H:
152 cbits = 0x02;
Harald Welte6f40df02010-12-23 12:59:52 +0100153 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800154 break;
155 case GSM_PCHAN_CCCH_SDCCH4:
156 cbits = 0x04;
Harald Welte6f40df02010-12-23 12:59:52 +0100157 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800158 break;
159 case GSM_PCHAN_SDCCH8_SACCH8C:
160 cbits = 0x08;
Harald Welte6f40df02010-12-23 12:59:52 +0100161 cbits += lchan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800162 break;
163 default:
164 case GSM_PCHAN_CCCH:
165 cbits = 0x10;
166 break;
167 }
168
169 chan_nr = (cbits << 3) | (ts->nr & 0x7);
170
171 return chan_nr;
172}
173
Harald Welte6f40df02010-12-23 12:59:52 +0100174u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
175{
176 return ts2chan_nr(lchan->ts, lchan->nr);
177}
178
Harald Welte59b04682009-06-10 05:40:52 +0800179/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
180u_int64_t str_to_imsi(const char *imsi_str)
181{
182 u_int64_t ret;
183
184 ret = strtoull(imsi_str, NULL, 10);
185
186 return ret;
187}
188
189/* Table 5 Clause 7 TS 05.02 */
190unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
191{
192 if (!bs_ccch_sdcch_comb)
193 return 9 - bs_ag_blks_res;
194 else
195 return 3 - bs_ag_blks_res;
196}
197
198/* Chapter 6.5.2 of TS 05.02 */
199unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
200 unsigned int n_pag_blocks)
201{
202 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
203}
204
205/* Chapter 6.5.2 of TS 05.02 */
206unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
207 int n_pag_blocks)
208{
209 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
210}
211
212static struct msgb *rsl_msgb_alloc(void)
213{
Harald Welte9cfc9352009-06-26 19:39:35 +0200214 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
215 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800216}
217
218#define MACBLOCK_SIZE 23
219static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
220{
221 memcpy(out, in, len);
222
223 if (len < MACBLOCK_SIZE)
224 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
225}
226
Harald Welted2dd9de2009-08-30 15:37:11 +0900227/* Chapter 9.3.7: Encryption Information */
228static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
229{
230 *out++ = lchan->encr.alg_id & 0xff;
231 if (lchan->encr.key_len)
232 memcpy(out, lchan->encr.key, lchan->encr.key_len);
233 return lchan->encr.key_len + 1;
234}
235
Harald Weltede4477a2009-12-24 12:20:20 +0100236static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200237{
Harald Welte59b04682009-06-10 05:40:52 +0800238 int i;
239
Harald Weltede4477a2009-12-24 12:20:20 +0100240 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200241 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200242 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100243 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800244}
245
246/* Send a BCCH_INFO message as per Chapter 8.5.1 */
247int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
248 const u_int8_t *data, int len)
249{
250 struct abis_rsl_dchan_hdr *dh;
251 struct msgb *msg = rsl_msgb_alloc();
252
253 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
254 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
255 dh->chan_nr = RSL_CHAN_BCCH;
256
257 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
258 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
259
260 msg->trx = trx;
261
262 return abis_rsl_sendmsg(msg);
263}
264
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200265int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte59b04682009-06-10 05:40:52 +0800266 const u_int8_t *data, int len)
267{
268 struct abis_rsl_common_hdr *ch;
269 struct msgb *msg = rsl_msgb_alloc();
270
271 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
272 ch->msg_discr = ABIS_RSL_MDISC_TRX;
273 ch->msg_type = RSL_MT_SACCH_FILL;
274
275 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
276 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
277
278 msg->trx = trx;
279
280 return abis_rsl_sendmsg(msg);
281}
282
Harald Welte10b7d8f2011-01-13 23:16:03 +0100283int rsl_sacch_info_modify(struct gsm_lchan *lchan, u_int8_t type,
284 const u_int8_t *data, int len)
285{
286 struct abis_rsl_dchan_hdr *dh;
287 struct msgb *msg = rsl_msgb_alloc();
288 u_int8_t chan_nr = lchan2chan_nr(lchan);
289
290 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
291 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
292 dh->chan_nr = chan_nr;
293
294 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
295 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
296
297 msg->trx = lchan->ts->trx;
298
299 return abis_rsl_sendmsg(msg);
300}
301
Harald Welte91afe4c2009-06-20 18:15:19 +0200302int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
303{
304 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200305 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200306 u_int8_t chan_nr = lchan2chan_nr(lchan);
307
308 db = abs(db);
309 if (db > 30)
310 return -EINVAL;
311
Harald Welteed831842009-06-27 03:09:08 +0200312 msg = rsl_msgb_alloc();
313
Harald Welte91afe4c2009-06-20 18:15:19 +0200314 lchan->bs_power = db/2;
315 if (fpc)
316 lchan->bs_power |= 0x10;
317
318 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
319 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
320 dh->chan_nr = chan_nr;
321
322 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
323
324 msg->trx = lchan->ts->trx;
325
326 return abis_rsl_sendmsg(msg);
327}
328
Harald Welte91afe4c2009-06-20 18:15:19 +0200329int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
330{
331 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200332 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200333 u_int8_t chan_nr = lchan2chan_nr(lchan);
334 int ctl_lvl;
335
Harald Weltec4dcda02009-08-09 14:45:18 +0200336 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200337 if (ctl_lvl < 0)
338 return ctl_lvl;
339
Harald Welteed831842009-06-27 03:09:08 +0200340 msg = rsl_msgb_alloc();
341
Harald Welte91afe4c2009-06-20 18:15:19 +0200342 lchan->ms_power = ctl_lvl;
343
344 if (fpc)
345 lchan->ms_power |= 0x20;
346
347 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
348 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
349 dh->chan_nr = chan_nr;
350
351 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
352
353 msg->trx = lchan->ts->trx;
354
355 return abis_rsl_sendmsg(msg);
356}
357
Harald Welte39274f42009-07-29 15:41:29 +0200358static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
359 struct gsm_lchan *lchan)
360{
361 memset(cm, 0, sizeof(cm));
362
363 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800364 if (lchan->ts->trx->bts->network->dtx_enabled)
365 cm->dtx_dtu = 0x03;
366 else
367 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200368
369 /* set TCH Speech/Data */
370 cm->spd_ind = lchan->rsl_cmode;
371
Harald Welte951e3512009-11-27 08:55:16 +0100372 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
373 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100374 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100375 "but tch_mode != signalling\n");
376
Harald Welte39274f42009-07-29 15:41:29 +0200377 switch (lchan->type) {
378 case GSM_LCHAN_SDCCH:
379 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
380 break;
381 case GSM_LCHAN_TCH_F:
382 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
383 break;
384 case GSM_LCHAN_TCH_H:
385 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
386 break;
387 case GSM_LCHAN_NONE:
388 case GSM_LCHAN_UNKNOWN:
389 default:
390 return -EINVAL;
391 }
392
393 switch (lchan->tch_mode) {
394 case GSM48_CMODE_SIGN:
395 cm->chan_rate = 0;
396 break;
397 case GSM48_CMODE_SPEECH_V1:
398 cm->chan_rate = RSL_CMOD_SP_GSM1;
399 break;
400 case GSM48_CMODE_SPEECH_EFR:
401 cm->chan_rate = RSL_CMOD_SP_GSM2;
402 break;
403 case GSM48_CMODE_SPEECH_AMR:
404 cm->chan_rate = RSL_CMOD_SP_GSM3;
405 break;
406 case GSM48_CMODE_DATA_14k5:
407 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
408 break;
409 case GSM48_CMODE_DATA_12k0:
410 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
411 break;
412 case GSM48_CMODE_DATA_6k0:
413 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
414 break;
415 default:
416 return -EINVAL;
417 }
418
419 return 0;
420}
421
Harald Welte59b04682009-06-10 05:40:52 +0800422/* Chapter 8.4.1 */
423#if 0
424int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
425 u_int8_t act_type,
426 struct rsl_ie_chan_mode *chan_mode,
427 struct rsl_ie_chan_ident *chan_ident,
428 u_int8_t bs_power, u_int8_t ms_power,
429 u_int8_t ta)
430{
431 struct abis_rsl_dchan_hdr *dh;
432 struct msgb *msg = rsl_msgb_alloc();
433
434 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
435 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
436 dh->chan_nr = chan_nr;
437
438 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
439 /* For compatibility with Phase 1 */
440 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
441 (u_int8_t *) chan_mode);
442 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
443 (u_int8_t *) chan_ident);
444#if 0
445 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
446 (u_int8_t *) &encr_info);
447#endif
448 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
449 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
450 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
451
452 msg->trx = trx;
453
454 return abis_rsl_sendmsg(msg);
455}
456#endif
457
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200458int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welteb90d7bd2009-12-17 00:31:10 +0100459 u_int8_t ta, u_int8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800460{
461 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200462 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200463 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200464 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800465
466 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800467 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200468 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800469
Harald Welte39274f42009-07-29 15:41:29 +0200470 rc = channel_mode_from_lchan(&cm, lchan);
471 if (rc < 0)
472 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800473
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800474 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200475 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800476
Harald Welteed831842009-06-27 03:09:08 +0200477 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800478 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
479 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
480 dh->chan_nr = chan_nr;
481
482 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800483 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
484 (u_int8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800485
486 /*
487 * The Channel Identification is needed for Phase1 phones
488 * and it contains the GSM48 Channel Description and the
489 * Mobile Allocation. The GSM 08.58 asks for the Mobile
490 * Allocation to have a length of zero. We are using the
491 * msgb_l3len to calculate the length of both messages.
492 */
laforgef723cf02010-06-20 21:38:19 +0200493 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200494 len = msgb_put(msg, 1);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800495 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800496
497 if (lchan->ts->hopping.enabled)
498 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
499 lchan->ts->hopping.ma_data);
500 else
501 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800502
503 /* update the calculated size */
504 msg->l3h = len + 1;
505 *len = msgb_l3len(msg);
506
Harald Welted2dd9de2009-08-30 15:37:11 +0900507 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
508 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
509 rc = build_encr_info(encr_info, lchan);
510 if (rc > 0)
511 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
512 }
513
Harald Welteb90d7bd2009-12-17 00:31:10 +0100514 switch (act_type) {
515 case RSL_ACT_INTER_ASYNC:
516 case RSL_ACT_INTER_SYNC:
517 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
518 break;
519 default:
520 break;
521 }
522
Harald Welte59b04682009-06-10 05:40:52 +0800523 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
524 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
525 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
526
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100527 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
528 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
529 (u_int8_t *) &lchan->mr_conf);
530
Harald Welte59b04682009-06-10 05:40:52 +0800531 msg->trx = lchan->ts->trx;
532
533 return abis_rsl_sendmsg(msg);
534}
535
Harald Welte8e770492009-07-29 11:38:15 +0200536/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800537int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
538{
539 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200540 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200541 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800542
543 u_int8_t chan_nr = lchan2chan_nr(lchan);
544 struct rsl_ie_chan_mode cm;
545
Harald Welte39274f42009-07-29 15:41:29 +0200546 rc = channel_mode_from_lchan(&cm, lchan);
547 if (rc < 0)
548 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800549
Harald Welteed831842009-06-27 03:09:08 +0200550 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800551 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
552 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
553 dh->chan_nr = chan_nr;
554
555 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
556 (u_int8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900557
558 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
559 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
560 rc = build_encr_info(encr_info, lchan);
561 if (rc > 0)
562 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
563 }
564
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100565 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
566 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
567 (u_int8_t *) &lchan->mr_conf);
568 }
569
Harald Welted2dd9de2009-08-30 15:37:11 +0900570 msg->trx = lchan->ts->trx;
571
572 return abis_rsl_sendmsg(msg);
573}
574
575/* Chapter 8.4.6: Send the encryption command with given L3 info */
576int rsl_encryption_cmd(struct msgb *msg)
577{
578 struct abis_rsl_dchan_hdr *dh;
579 struct gsm_lchan *lchan = msg->lchan;
580 u_int8_t chan_nr = lchan2chan_nr(lchan);
581 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut01f1caf2009-09-27 11:13:18 +0200582 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900583 int rc;
584
585 /* First push the L3 IE tag and length */
586 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
587
588 /* then the link identifier (SAPI0, main sign link) */
589 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
590
591 /* then encryption information */
592 rc = build_encr_info(encr_info, lchan);
593 if (rc <= 0)
594 return rc;
595 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
596
597 /* and finally the DCHAN header */
598 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
599 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
600 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800601
602 msg->trx = lchan->ts->trx;
603
604 return abis_rsl_sendmsg(msg);
605}
606
Harald Welte85a163c2009-08-10 11:43:22 +0200607/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200608int rsl_deact_sacch(struct gsm_lchan *lchan)
609{
610 struct abis_rsl_dchan_hdr *dh;
611 struct msgb *msg = rsl_msgb_alloc();
612
613 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
614 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
615 dh->chan_nr = lchan2chan_nr(lchan);
616
617 msg->lchan = lchan;
618 msg->trx = lchan->ts->trx;
619
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100620 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200621
622 return abis_rsl_sendmsg(msg);
623}
624
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800625static void error_timeout_cb(void *data)
626{
627 struct gsm_lchan *lchan = data;
628 if (lchan->state != LCHAN_S_REL_ERR) {
629 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
630 gsm_lchan_name(lchan), lchan->state);
631 return;
632 }
633
634 /* go back to the none state */
635 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800636 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800637}
638
Harald Welte85a163c2009-08-10 11:43:22 +0200639/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800640static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800641{
642 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800643 struct msgb *msg;
Harald Welte59b04682009-06-10 05:40:52 +0800644
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800645 if (lchan->state == LCHAN_S_REL_ERR) {
646 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
647 gsm_lchan_name(lchan));
648 return -1;
649 }
650
651 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800652 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
653 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
654 dh->chan_nr = lchan2chan_nr(lchan);
655
656 msg->lchan = lchan;
657 msg->trx = lchan->ts->trx;
658
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800659 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
660
661 if (error) {
662 /*
663 * the nanoBTS sends RLL release indications after the channel release. This can
664 * be a problem when we have reassigned the channel to someone else and then can
665 * not figure out who used this channel.
666 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800667 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800668 lchan->error_timer.data = lchan;
669 lchan->error_timer.cb = error_timeout_cb;
670 bsc_schedule_timer(&lchan->error_timer,
671 msg->trx->bts->network->T3111 + 2, 0);
672 }
Harald Welte59b04682009-06-10 05:40:52 +0800673
Harald Welte85a163c2009-08-10 11:43:22 +0200674 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800675 return abis_rsl_sendmsg(msg);
676}
677
Harald Welte9773f6c2011-01-14 14:16:16 +0100678static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
679{
680
681 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
682
683 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
684 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
685 gsm_lchan_name(lchan),
686 gsm_lchans_name(lchan->state));
687 bsc_del_timer(&lchan->T3111);
688 /* we have an error timer pending to release that */
689 if (lchan->state != LCHAN_S_REL_ERR)
690 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
691 lchan_free(lchan);
692
693 return 0;
694}
695
Harald Welte59b04682009-06-10 05:40:52 +0800696int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
697 u_int8_t *ms_ident, u_int8_t chan_needed)
698{
699 struct abis_rsl_dchan_hdr *dh;
700 struct msgb *msg = rsl_msgb_alloc();
701
702 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
703 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
704 dh->chan_nr = RSL_CHAN_PCH_AGCH;
705
706 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
707 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
708 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
709
710 msg->trx = bts->c0;
711
712 return abis_rsl_sendmsg(msg);
713}
714
Harald Welte59b04682009-06-10 05:40:52 +0800715int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
716{
717 int i, len = strlen(str_in);
718
719 for (i = 0; i < len; i++) {
720 int num = str_in[i] - 0x30;
721 if (num < 0 || num > 9)
722 return -1;
723 if (i % 2 == 0)
724 bcd_out[i/2] = num;
725 else
726 bcd_out[i/2] |= (num << 4);
727 }
728
729 return 0;
730}
731
732/* Chapter 8.5.6 */
733int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
734{
735 struct msgb *msg = rsl_msgb_alloc();
736 struct abis_rsl_dchan_hdr *dh;
737 u_int8_t buf[MACBLOCK_SIZE];
738
739 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
740 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
741 dh->chan_nr = RSL_CHAN_PCH_AGCH;
742
743 switch (bts->type) {
744 case GSM_BTS_TYPE_BS11:
745 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
746 break;
747 default:
748 /* If phase 2, construct a FULL_IMM_ASS_INFO */
749 pad_macblock(buf, val, len);
750 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
751 break;
752 }
753
754 msg->trx = bts->c0;
755
756 return abis_rsl_sendmsg(msg);
757}
758
Harald Welte4684e632009-08-10 09:51:40 +0200759/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200760int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200761{
762 struct msgb *msg = rsl_msgb_alloc();
763 struct abis_rsl_dchan_hdr *dh;
764
765 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
766 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200767 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200768 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200769 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200770
Harald Weltede4477a2009-12-24 12:20:20 +0100771 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100772 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200773
774 msg->trx = lchan->ts->trx;
775
Harald Welte4684e632009-08-10 09:51:40 +0200776 return abis_rsl_sendmsg(msg);
777}
778
779
Harald Welte59b04682009-06-10 05:40:52 +0800780/* Send "DATA REQUEST" message with given L3 Info payload */
781/* Chapter 8.3.1 */
782int rsl_data_request(struct msgb *msg, u_int8_t link_id)
783{
Harald Welte59b04682009-06-10 05:40:52 +0800784 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100785 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800786 return -EINVAL;
787 }
788
Harald Weltea22d36b2010-03-04 10:33:10 +0100789 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
790 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800791
792 msg->trx = msg->lchan->ts->trx;
793
794 return abis_rsl_sendmsg(msg);
795}
796
Harald Welteed9a5ab2009-08-09 13:47:35 +0200797/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
798/* Chapter 8.3.1 */
799int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
800{
Harald Weltea22d36b2010-03-04 10:33:10 +0100801 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200802
Harald Weltea22d36b2010-03-04 10:33:10 +0100803 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
804 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200805 msg->trx = lchan->ts->trx;
806
807 return abis_rsl_sendmsg(msg);
808}
809
Harald Welte0f2e3c12009-08-08 13:15:07 +0200810/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
811 This is what higher layers should call. The BTS then responds with
812 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
813 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
814 lchan_free() */
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800815int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200816{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200817
Harald Weltea22d36b2010-03-04 10:33:10 +0100818 struct msgb *msg;
819
820 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
821 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800822 /* 0 is normal release, 1 is local end */
823 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200824
Harald Weltec88a4432009-12-29 10:44:17 +0100825 /* FIXME: start some timer in case we don't receive a REL ACK ? */
826
Harald Welte0f2e3c12009-08-08 13:15:07 +0200827 msg->trx = lchan->ts->trx;
828
829 return abis_rsl_sendmsg(msg);
830}
831
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200832int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
833{
834 lchan->state = state;
835 return 0;
836}
837
Harald Welte59b04682009-06-10 05:40:52 +0800838/* Chapter 8.4.2: Channel Activate Acknowledge */
839static int rsl_rx_chan_act_ack(struct msgb *msg)
840{
841 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
842
843 /* BTS has confirmed channel activation, we now need
844 * to assign the activated channel to the MS */
845 if (rslh->ie_chan != RSL_IE_CHAN_NR)
846 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100847
Harald Weltec88a4432009-12-29 10:44:17 +0100848 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100849 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
850 gsm_lchan_name(msg->lchan),
851 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200852 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100853
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800854 if (msg->lchan->rqd_ref) {
855 rsl_send_imm_assignment(msg->lchan);
856 talloc_free(msg->lchan->rqd_ref);
857 msg->lchan->rqd_ref = NULL;
858 msg->lchan->rqd_ta = 0;
859 }
860
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100861 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100862
Harald Welte59b04682009-06-10 05:40:52 +0800863 return 0;
864}
865
866/* Chapter 8.4.3: Channel Activate NACK */
867static int rsl_rx_chan_act_nack(struct msgb *msg)
868{
869 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
870 struct tlv_parsed tp;
871
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100872 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100873 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100874
Harald Welte59b04682009-06-10 05:40:52 +0800875 /* BTS has rejected channel activation ?!? */
876 if (dh->ie_chan != RSL_IE_CHAN_NR)
877 return -EINVAL;
878
879 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100880 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
881 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
882 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200883 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100884 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200885 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100886 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200887 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200888
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100889 LOGPC(DRSL, LOGL_ERROR, "\n");
890
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100891 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100892
Harald Weltecddb9802009-08-09 19:50:08 +0200893 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800894 return 0;
895}
896
897/* Chapter 8.4.4: Connection Failure Indication */
898static int rsl_rx_conn_fail(struct msgb *msg)
899{
900 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
901 struct tlv_parsed tp;
902
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100903 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100904 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100905 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800906
907 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
908
Harald Weltef1a168d2009-07-28 17:58:09 +0200909 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100910 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200911 TLVP_LEN(&tp, RSL_IE_CAUSE));
912
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100913 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800914 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +0200915 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800916 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800917}
918
Harald Weltec20bd1d2009-11-29 19:07:28 +0100919static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
920 const char *prefix)
921{
Harald Welte0e4fa782009-12-16 16:52:07 +0100922 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
923 prefix, rxlev2dbm(mru->full.rx_lev),
924 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100925 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
926 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
927}
928
929static void print_meas_rep(struct gsm_meas_rep *mr)
930{
Harald Welte0e4fa782009-12-16 16:52:07 +0100931 int i;
932
Harald Weltec20bd1d2009-11-29 19:07:28 +0100933 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
934
935 if (mr->flags & MEAS_REP_F_DL_DTX)
936 DEBUGPC(DMEAS, "DTXd ");
937
938 print_meas_rep_uni(&mr->ul, "ul");
939 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
940 if (mr->flags & MEAS_REP_F_MS_TO)
941 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
942
943 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100944 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100945 DEBUGPC(DMEAS, "L1_FPC=%u ",
946 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
947 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
948 }
949
950 if (mr->flags & MEAS_REP_F_UL_DTX)
951 DEBUGPC(DMEAS, "DTXu ");
952 if (mr->flags & MEAS_REP_F_BA1)
953 DEBUGPC(DMEAS, "BA1 ");
954 if (!(mr->flags & MEAS_REP_F_DL_VALID))
955 DEBUGPC(DMEAS, "NOT VALID ");
956 else
957 print_meas_rep_uni(&mr->dl, "dl");
958
959 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100960 if (mr->num_cell == 7)
961 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100962 for (i = 0; i < mr->num_cell; i++) {
963 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100964 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
965 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100966 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100967}
968
Harald Welte59b04682009-06-10 05:40:52 +0800969static int rsl_rx_meas_res(struct msgb *msg)
970{
971 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
972 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100973 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100974 u_int8_t len;
975 const u_int8_t *val;
976 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800977
Harald Welte4baa9c52009-12-21 13:27:11 +0100978 /* check if this channel is actually active */
979 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100980 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800981 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100982 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100983 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100984 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100985
Harald Weltef9476812009-12-15 21:36:05 +0100986 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100987 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100988
Harald Welte59b04682009-06-10 05:40:52 +0800989 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
990
Harald Weltec20bd1d2009-11-29 19:07:28 +0100991 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
992 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
993 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
994 return -EIO;
995
996 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100997 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100998
999 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1000 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1001 if (len >= 3) {
1002 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001003 mr->flags |= MEAS_REP_F_DL_DTX;
1004 mr->ul.full.rx_lev = val[0] & 0x3f;
1005 mr->ul.sub.rx_lev = val[1] & 0x3f;
1006 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1007 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001008 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001009
Harald Weltef9476812009-12-15 21:36:05 +01001010 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001011
1012 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001013 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001014 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001015 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1016
Harald Weltea1467eb2009-06-20 18:44:35 +02001017 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001018 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001019 mr->flags |= MEAS_REP_F_MS_L1;
1020 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001021 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001022 mr->flags |= MEAS_REP_F_FPC;
1023 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001024 }
Harald Welte59b04682009-06-10 05:40:52 +08001025 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001026 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001027 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001028 if (rc < 0)
1029 return rc;
1030 }
1031
Harald Weltef9476812009-12-15 21:36:05 +01001032 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001033
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001034 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001035
Harald Welte59b04682009-06-10 05:40:52 +08001036 return 0;
1037}
1038
Harald Welte6720a432009-11-29 22:45:52 +01001039/* Chapter 8.4.7 */
1040static int rsl_rx_hando_det(struct msgb *msg)
1041{
1042 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1043 struct tlv_parsed tp;
1044
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001045 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001046
1047 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1048
1049 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1050 DEBUGPC(DRSL, "access delay = %u\n",
1051 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1052 else
1053 DEBUGPC(DRSL, "\n");
1054
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001055 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001056
1057 return 0;
1058}
1059
Harald Welte59b04682009-06-10 05:40:52 +08001060static int abis_rsl_rx_dchan(struct msgb *msg)
1061{
1062 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1063 int rc = 0;
1064 char *ts_name;
1065
1066 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001067 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001068
Harald Welte59b04682009-06-10 05:40:52 +08001069 switch (rslh->c.msg_type) {
1070 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001071 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001072 rc = rsl_rx_chan_act_ack(msg);
1073 break;
1074 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001075 rc = rsl_rx_chan_act_nack(msg);
1076 break;
1077 case RSL_MT_CONN_FAIL:
1078 rc = rsl_rx_conn_fail(msg);
1079 break;
1080 case RSL_MT_MEAS_RES:
1081 rc = rsl_rx_meas_res(msg);
1082 break;
Harald Welte6720a432009-11-29 22:45:52 +01001083 case RSL_MT_HANDO_DET:
1084 rc = rsl_rx_hando_det(msg);
1085 break;
Harald Welte59b04682009-06-10 05:40:52 +08001086 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001087 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001088 break;
1089 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001090 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001091 break;
1092 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001093 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001094 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001095 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001096 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001097 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001098 break;
1099 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001100 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001101 break;
1102 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001103 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001104 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001105 break;
1106 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001107 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001108 break;
Harald Welte59b04682009-06-10 05:40:52 +08001109 case RSL_MT_PHY_CONTEXT_CONF:
1110 case RSL_MT_PREPROC_MEAS_RES:
1111 case RSL_MT_TALKER_DET:
1112 case RSL_MT_LISTENER_DET:
1113 case RSL_MT_REMOTE_CODEC_CONF_REP:
1114 case RSL_MT_MR_CODEC_MOD_ACK:
1115 case RSL_MT_MR_CODEC_MOD_NACK:
1116 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001117 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1118 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001119 break;
1120 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001121 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1122 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001123 return -EINVAL;
1124 }
1125
1126 return rc;
1127}
1128
1129static int rsl_rx_error_rep(struct msgb *msg)
1130{
1131 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001132 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001133
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001134 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001135
1136 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1137
1138 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001139 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001140 TLVP_LEN(&tp, RSL_IE_CAUSE));
1141
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001142 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001143
1144 return 0;
1145}
1146
1147static int abis_rsl_rx_trx(struct msgb *msg)
1148{
1149 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1150 int rc = 0;
1151
1152 switch (rslh->msg_type) {
1153 case RSL_MT_ERROR_REPORT:
1154 rc = rsl_rx_error_rep(msg);
1155 break;
1156 case RSL_MT_RF_RES_IND:
1157 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001158 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001159 break;
1160 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001161 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001162 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1163 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001164 break;
1165 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001166 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1167 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001168 return -EINVAL;
1169 }
1170 return rc;
1171}
1172
Harald Welte427dbc42009-08-10 00:26:10 +02001173/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1174static void t3101_expired(void *data)
1175{
1176 struct gsm_lchan *lchan = data;
1177
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001178 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001179}
1180
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001181/* If T3111 expires, we will send the RF Channel Request */
1182static void t3111_expired(void *data)
1183{
1184 struct gsm_lchan *lchan = data;
1185
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001186 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001187}
1188
laforge50312e82010-06-21 12:08:52 +02001189#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1190
Harald Weltea00fdd72010-12-23 14:39:29 +01001191/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1192static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1193 unsigned int num_req_refs,
1194 struct gsm48_req_ref *rqd_refs,
1195 uint8_t wait_ind)
1196{
1197 uint8_t buf[GSM_MACBLOCK_LEN];
1198 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1199
1200 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1201 memset(iar, 0, sizeof(*iar));
1202 iar->proto_discr = GSM48_PDISC_RR;
1203 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1204 iar->page_mode = GSM48_PM_SAME;
1205
1206 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1207 iar->wait_ind1 = wait_ind;
1208
1209 if (num_req_refs >= 2)
1210 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1211 else
1212 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1213 iar->wait_ind2 = wait_ind;
1214
1215 if (num_req_refs >= 3)
1216 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1217 else
1218 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1219 iar->wait_ind3 = wait_ind;
1220
1221 if (num_req_refs >= 4)
1222 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1223 else
1224 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1225 iar->wait_ind4 = wait_ind;
1226
1227 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1228}
1229
Harald Welte59b04682009-06-10 05:40:52 +08001230/* MS has requested a channel on the RACH */
1231static int rsl_rx_chan_rqd(struct msgb *msg)
1232{
1233 struct gsm_bts *bts = msg->trx->bts;
1234 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1235 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001236 enum gsm_chan_t lctype;
1237 enum gsm_chreq_reason_t chreq_reason;
1238 struct gsm_lchan *lchan;
1239 u_int8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001240 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001241
1242 u_int16_t arfcn;
1243 u_int8_t ts_number, subch;
1244
1245 /* parse request reference to be used in immediate assign */
1246 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1247 return -EINVAL;
1248
1249 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1250
1251 /* parse access delay and use as TA */
1252 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1253 return -EINVAL;
1254 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1255
1256 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1257 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001258 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1259 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001260
Harald Weltebdbb7442009-12-22 19:07:32 +01001261 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001262
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001263 /*
1264 * We want LOCATION UPDATES to succeed and will assign a TCH
1265 * if we have no SDCCH available.
1266 */
1267 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1268
Harald Welte59b04682009-06-10 05:40:52 +08001269 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001270 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001271 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001272 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001273 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001274 counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001275 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1276 if (bts->network->T3122)
1277 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001278 return -ENOMEM;
1279 }
1280
Harald Weltec88a4432009-12-29 10:44:17 +01001281 if (lchan->state != LCHAN_S_NONE)
1282 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001283 "in state %s\n", gsm_lchan_name(lchan),
1284 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001285 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001286
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001287 /* save the RACH data as we need it after the CHAN ACT ACK */
1288 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1289 if (!lchan->rqd_ref) {
1290 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1291 lchan_free(lchan);
1292 return -ENOMEM;
1293 }
1294
1295 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1296 lchan->rqd_ta = rqd_ta;
1297
Harald Welte59b04682009-06-10 05:40:52 +08001298 ts_number = lchan->ts->nr;
1299 arfcn = lchan->ts->trx->arfcn;
1300 subch = lchan->nr;
1301
Harald Welted2dd9de2009-08-30 15:37:11 +09001302 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001303 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001304 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001305 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001306 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001307
1308 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001309 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001310
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001311 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1312 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1313 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1314 rqd_ref->ra);
1315 return 0;
1316}
1317
1318static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1319{
1320 struct gsm_bts *bts = lchan->ts->trx->bts;
1321 u_int8_t buf[GSM_MACBLOCK_LEN];
1322 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1323
Harald Welte59b04682009-06-10 05:40:52 +08001324 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001325 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001326 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001327 ia->proto_discr = GSM48_PDISC_RR;
1328 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1329 ia->page_mode = GSM48_PM_SAME;
1330 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001331
Harald Welte59b04682009-06-10 05:40:52 +08001332 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001333 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1334 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001335 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001336 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001337 } else {
laforgee06d5982010-06-20 15:18:46 +02001338 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1339 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001340 }
Harald Welte07f32182010-06-28 18:41:27 +02001341 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1342 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001343
Harald Welte427dbc42009-08-10 00:26:10 +02001344 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1345 lchan->T3101.cb = t3101_expired;
1346 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001347 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001348
1349 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001350 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001351}
1352
1353/* MS has requested a channel on the RACH */
1354static int rsl_rx_ccch_load(struct msgb *msg)
1355{
1356 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1357 u_int16_t pg_buf_space;
1358 u_int16_t rach_slot_count = -1;
1359 u_int16_t rach_busy_count = -1;
1360 u_int16_t rach_access_count = -1;
1361
1362 switch (rslh->data[0]) {
1363 case RSL_IE_PAGING_LOAD:
1364 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001365 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1366 /* paging load below configured threshold, use 50 as default */
1367 pg_buf_space = 50;
1368 }
Harald Welte59b04682009-06-10 05:40:52 +08001369 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1370 break;
1371 case RSL_IE_RACH_LOAD:
1372 if (msg->data_len >= 7) {
1373 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1374 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1375 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1376 }
1377 break;
1378 default:
1379 break;
1380 }
1381
1382 return 0;
1383}
1384
1385static int abis_rsl_rx_cchan(struct msgb *msg)
1386{
1387 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1388 int rc = 0;
1389
1390 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1391
1392 switch (rslh->c.msg_type) {
1393 case RSL_MT_CHAN_RQD:
1394 /* MS has requested a channel on the RACH */
1395 rc = rsl_rx_chan_rqd(msg);
1396 break;
1397 case RSL_MT_CCCH_LOAD_IND:
1398 /* current load on the CCCH */
1399 rc = rsl_rx_ccch_load(msg);
1400 break;
1401 case RSL_MT_DELETE_IND:
1402 /* CCCH overloaded, IMM_ASSIGN was dropped */
1403 case RSL_MT_CBCH_LOAD_IND:
1404 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001405 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1406 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001407 break;
1408 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001409 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1410 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001411 return -EINVAL;
1412 }
1413
1414 return rc;
1415}
1416
1417static int rsl_rx_rll_err_ind(struct msgb *msg)
1418{
1419 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1420 u_int8_t *rlm_cause = rllh->data;
1421
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001422 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001423 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001424 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001425
1426 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001427
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001428 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1429 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001430 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001431 }
Harald Welte692f5852009-07-04 09:40:05 +02001432
Harald Welte59b04682009-06-10 05:40:52 +08001433 return 0;
1434}
1435
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001436static void rsl_handle_release(struct gsm_lchan *lchan)
1437{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001438 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001439 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001440
1441 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001442 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001443 return;
1444
1445 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1446 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1447 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001448 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001449 gsm_lchan_name(lchan), sapi);
1450 return;
1451 }
1452
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001453
1454
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001455 /* wait a bit to send the RF Channel Release */
1456 lchan->T3111.cb = t3111_expired;
1457 lchan->T3111.data = lchan;
1458 bts = lchan->ts->trx->bts;
1459 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001460}
1461
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001462/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001463 0x02, 0x06,
1464 0x01, 0x20,
1465 0x02, 0x00,
1466 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1467
1468static int abis_rsl_rx_rll(struct msgb *msg)
1469{
1470 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1471 int rc = 0;
1472 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001473 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001474
1475 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001476 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001477 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001478
1479 switch (rllh->c.msg_type) {
1480 case RSL_MT_DATA_IND:
1481 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001482 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001483 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1484 rllh->data[0] == RSL_IE_L3_INFO) {
1485 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001486 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001487 }
1488 break;
1489 case RSL_MT_EST_IND:
1490 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001491 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001492 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001493 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001494 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001495 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1496 rllh->data[0] == RSL_IE_L3_INFO) {
1497 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001498 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001499 }
1500 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001501 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001502 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001503 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001504 rll_indication(msg->lchan, rllh->link_id,
1505 BSC_RLLR_IND_EST_CONF);
1506 break;
Harald Welte59b04682009-06-10 05:40:52 +08001507 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001508 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001509 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001510 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001511 rll_indication(msg->lchan, rllh->link_id,
1512 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001513 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001514 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001515 break;
1516 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001517 /* BTS informs us of having received UA from MS,
1518 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001519 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001520 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001521 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001522 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001523 break;
1524 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001525 rc = rsl_rx_rll_err_ind(msg);
1526 break;
1527 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001528 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1529 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001530 break;
1531 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001532 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1533 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001534 }
Harald Welte59b04682009-06-10 05:40:52 +08001535 return rc;
1536}
1537
Harald Welteb284b472009-12-02 01:58:23 +05301538static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001539{
Harald Welteb284b472009-12-02 01:58:23 +05301540 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001541 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301542 switch (lchan->type) {
1543 case GSM_LCHAN_TCH_F:
1544 return 0x00;
1545 case GSM_LCHAN_TCH_H:
1546 return 0x03;
1547 default:
1548 break;
1549 }
Harald Welte98d79f92009-07-28 18:11:56 +02001550 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301551 switch (lchan->type) {
1552 case GSM_LCHAN_TCH_F:
1553 return 0x01;
1554 /* there's no half-rate EFR */
1555 default:
1556 break;
1557 }
Harald Welte98d79f92009-07-28 18:11:56 +02001558 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301559 switch (lchan->type) {
1560 case GSM_LCHAN_TCH_F:
1561 return 0x02;
1562 case GSM_LCHAN_TCH_H:
1563 return 0x05;
1564 default:
1565 break;
1566 }
1567 default:
1568 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001569 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001570 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301571 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001572 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001573}
1574
Sylvain Munaut1338a552009-12-20 22:06:40 +01001575static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1576{
Holger Hans Peter Freyther6651b692010-11-14 21:09:08 +01001577 struct gsm_network *net = lchan->ts->trx->bts->network;
1578
1579 /* allow to hardcode the rtp payload */
1580 if (net->hardcoded_rtp_payload != 0)
1581 return net->hardcoded_rtp_payload;
1582
Sylvain Munaut1338a552009-12-20 22:06:40 +01001583 switch (lchan->tch_mode) {
1584 case GSM48_CMODE_SPEECH_V1:
1585 switch (lchan->type) {
1586 case GSM_LCHAN_TCH_F:
1587 return RTP_PT_GSM_FULL;
1588 case GSM_LCHAN_TCH_H:
1589 return RTP_PT_GSM_HALF;
1590 default:
1591 break;
1592 }
1593 case GSM48_CMODE_SPEECH_EFR:
1594 switch (lchan->type) {
1595 case GSM_LCHAN_TCH_F:
1596 return RTP_PT_GSM_EFR;
1597 /* there's no half-rate EFR */
1598 default:
1599 break;
1600 }
1601 case GSM48_CMODE_SPEECH_AMR:
1602 switch (lchan->type) {
1603 case GSM_LCHAN_TCH_F:
1604 return RTP_PT_AMR_FULL;
1605 case GSM_LCHAN_TCH_H:
1606 return RTP_PT_AMR_HALF;
1607 default:
1608 break;
1609 }
1610 default:
1611 break;
1612 }
1613 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1614 "tch_mode == 0x%02x\n & lchan_type == %d",
1615 lchan->tch_mode, lchan->type);
1616 return 0;
1617}
1618
Harald Welte59b04682009-06-10 05:40:52 +08001619/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001620static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1621{
1622 struct in_addr ip;
1623 u_int16_t port, conn_id;
1624
1625 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1626 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1627 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1628 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1629 }
1630
1631 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1632 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1633 port = ntohs(port);
1634 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1635 lchan->abis_ip.bound_port = port;
1636 }
1637
1638 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1639 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1640 conn_id = ntohs(conn_id);
1641 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1642 lchan->abis_ip.conn_id = conn_id;
1643 }
1644
1645 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1646 lchan->abis_ip.rtp_payload2 =
1647 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1648 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1649 lchan->abis_ip.rtp_payload2);
1650 }
1651
1652 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1653 lchan->abis_ip.speech_mode =
1654 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1655 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1656 lchan->abis_ip.speech_mode);
1657 }
1658
1659 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1660 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1661 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1662 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1663 }
1664
1665 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1666 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1667 port = ntohs(port);
1668 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1669 lchan->abis_ip.connect_port = port;
1670 }
1671}
1672
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001673int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001674{
1675 struct msgb *msg = rsl_msgb_alloc();
1676 struct abis_rsl_dchan_hdr *dh;
1677
1678 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001679 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001680 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1681 dh->chan_nr = lchan2chan_nr(lchan);
1682
Harald Welte98d79f92009-07-28 18:11:56 +02001683 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001684 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001685 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001686 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001687 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001688
Sylvain Munaut1338a552009-12-20 22:06:40 +01001689 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1690 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1691 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001692
Harald Welte59b04682009-06-10 05:40:52 +08001693 msg->trx = lchan->ts->trx;
1694
1695 return abis_rsl_sendmsg(msg);
1696}
1697
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001698int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001699 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001700{
1701 struct msgb *msg = rsl_msgb_alloc();
1702 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001703 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001704 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001705
1706 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001707 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001708 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1709 dh->chan_nr = lchan2chan_nr(lchan);
1710
Harald Weltebffa4992009-12-19 16:42:06 +01001711 /* we need to store these now as MDCX_ACK does not return them :( */
1712 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1713 lchan->abis_ip.connect_port = port;
1714 lchan->abis_ip.connect_ip = ip;
1715
Harald Weltefb4a9e92009-07-29 12:12:18 +02001716 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001717 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001718 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001719
Harald Welte98d79f92009-07-28 18:11:56 +02001720 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001721 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1722 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1723 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1724 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001725
Harald Weltebffa4992009-12-19 16:42:06 +01001726 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1727 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1728 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1729 *att_ip = ia.s_addr;
1730 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1731 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001732 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001733 if (rtp_payload2)
1734 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1735
Harald Welte59b04682009-06-10 05:40:52 +08001736 msg->trx = lchan->ts->trx;
1737
1738 return abis_rsl_sendmsg(msg);
1739}
1740
Harald Welte9947d9f2009-12-20 16:51:09 +01001741/* tell BTS to connect RTP stream to our local RTP socket */
1742int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1743{
1744 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1745 int rc;
1746
1747 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1748 ntohs(rs->rtp.sin_local.sin_port),
1749 /* FIXME: use RTP payload of bound socket, not BTS*/
1750 lchan->abis_ip.rtp_payload2);
1751
1752 return rc;
1753}
1754
Harald Welte6f40df02010-12-23 12:59:52 +01001755int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001756{
1757 struct msgb *msg = rsl_msgb_alloc();
1758 struct abis_rsl_dchan_hdr *dh;
Harald Welte2b361522010-03-28 14:42:09 +08001759 u_int8_t msg_type;
1760
1761 if (act)
1762 msg_type = RSL_MT_IPAC_PDCH_ACT;
1763 else
1764 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001765
1766 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001767 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001768 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte6f40df02010-12-23 12:59:52 +01001769 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001770
Harald Welte6f40df02010-12-23 12:59:52 +01001771 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001772 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001773
Harald Welte6f40df02010-12-23 12:59:52 +01001774 msg->trx = ts->trx;
Harald Welteaed946e2009-10-24 10:29:22 +02001775
1776 return abis_rsl_sendmsg(msg);
1777}
1778
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001779static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001780{
1781 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1782 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301783 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001784
1785 /* the BTS has acknowledged a local bind, it now tells us the IP
1786 * address and port number to which it has bound the given logical
1787 * channel */
1788
1789 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1790 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1791 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001792 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001793 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001794 return -EINVAL;
1795 }
Harald Welte50517742009-12-20 15:42:44 +01001796
Harald Weltebffa4992009-12-19 16:42:06 +01001797 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001798
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001799 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001800
1801 return 0;
1802}
1803
Harald Weltebffa4992009-12-19 16:42:06 +01001804static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1805{
1806 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1807 struct tlv_parsed tv;
1808 struct gsm_lchan *lchan = msg->lchan;
1809
1810 /* the BTS has acknowledged a remote connect request and
1811 * it now tells us the IP address and port number to which it has
1812 * connected the given logical channel */
1813
1814 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1815 ipac_parse_rtp(lchan, &tv);
1816 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1817
1818 return 0;
1819}
1820
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001821static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001822{
1823 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1824 struct tlv_parsed tv;
1825
1826 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001827
Harald Weltef1a168d2009-07-28 17:58:09 +02001828 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001829 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001830 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001831
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001832 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001833
Harald Welte59b04682009-06-10 05:40:52 +08001834 return 0;
1835}
1836
1837static int abis_rsl_rx_ipacc(struct msgb *msg)
1838{
1839 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001840 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001841 int rc = 0;
1842
1843 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001844 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001845
1846 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001847 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001848 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001849 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001850 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001851 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001852 /* somehow the BTS was unable to bind the lchan to its local
1853 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001854 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001855 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001856 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001857 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001858 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001859 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001860 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001861 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001862 /* somehow the BTS was unable to connect the lchan to a remote
1863 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001864 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001865 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001866 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001867 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001868 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001869 break;
1870 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001871 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001872 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001873 break;
1874 }
1875 DEBUGPC(DRSL, "\n");
1876
1877 return rc;
1878}
1879
1880
1881/* Entry-point where L2 RSL from BTS enters */
1882int abis_rsl_rcvmsg(struct msgb *msg)
1883{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001884 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001885 int rc = 0;
1886
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001887 if (!msg) {
1888 DEBUGP(DRSL, "Empty RSL msg?..\n");
1889 return -1;
1890 }
1891
1892 if (msgb_l2len(msg) < sizeof(*rslh)) {
1893 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1894 return -1;
1895 }
1896
1897 rslh = msgb_l2(msg);
1898
Harald Welte59b04682009-06-10 05:40:52 +08001899 switch (rslh->msg_discr & 0xfe) {
1900 case ABIS_RSL_MDISC_RLL:
1901 rc = abis_rsl_rx_rll(msg);
1902 break;
1903 case ABIS_RSL_MDISC_DED_CHAN:
1904 rc = abis_rsl_rx_dchan(msg);
1905 break;
1906 case ABIS_RSL_MDISC_COM_CHAN:
1907 rc = abis_rsl_rx_cchan(msg);
1908 break;
1909 case ABIS_RSL_MDISC_TRX:
1910 rc = abis_rsl_rx_trx(msg);
1911 break;
1912 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001913 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001914 rslh->msg_discr);
1915 break;
1916 case ABIS_RSL_MDISC_IPACCESS:
1917 rc = abis_rsl_rx_ipacc(msg);
1918 break;
1919 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001920 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1921 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001922 return -EINVAL;
1923 }
1924 msgb_free(msg);
1925 return rc;
1926}
1927
Harald Welte59b04682009-06-10 05:40:52 +08001928/* From Table 10.5.33 of GSM 04.08 */
1929int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1930{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301931 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1932 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1933 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001934 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301935 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1936 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001937 }
1938}
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08001939
1940int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1941 uint8_t cb_command, const uint8_t *data, int len)
1942{
1943 struct abis_rsl_dchan_hdr *dh;
1944 struct msgb *cb_cmd;
1945
1946 cb_cmd = rsl_msgb_alloc();
1947 if (!cb_cmd)
1948 return -1;
1949
1950 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1951 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1952 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1953
1954 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1955 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1956
1957 cb_cmd->trx = bts->c0;
1958
1959 return abis_rsl_sendmsg(cb_cmd);
1960}