blob: 9a4dc5b4fa1fa9286d7a676297e8feb79ce40536 [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 Welte08011e22011-03-04 13:41:31 +0100639static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
640
Harald Welte85a163c2009-08-10 11:43:22 +0200641/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800642static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800643{
644 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800645 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100646 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800647
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800648 if (lchan->state == LCHAN_S_REL_ERR) {
649 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
650 gsm_lchan_name(lchan));
651 return -1;
652 }
653
654 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800655 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
656 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
657 dh->chan_nr = lchan2chan_nr(lchan);
658
659 msg->lchan = lchan;
660 msg->trx = lchan->ts->trx;
661
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800662 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
663
664 if (error) {
665 /*
666 * the nanoBTS sends RLL release indications after the channel release. This can
667 * be a problem when we have reassigned the channel to someone else and then can
668 * not figure out who used this channel.
669 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800670 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800671 lchan->error_timer.data = lchan;
672 lchan->error_timer.cb = error_timeout_cb;
673 bsc_schedule_timer(&lchan->error_timer,
674 msg->trx->bts->network->T3111 + 2, 0);
675 }
Harald Welte59b04682009-06-10 05:40:52 +0800676
Harald Welte08011e22011-03-04 13:41:31 +0100677 rc = abis_rsl_sendmsg(msg);
678
Harald Welte85a163c2009-08-10 11:43:22 +0200679 /* BTS will respond by RF CHAN REL ACK */
Harald Welte6bddd822011-01-14 23:18:59 +0100680#ifdef HSL_SR_1_0
Harald Welte08011e22011-03-04 13:41:31 +0100681 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
682 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
683 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte6bddd822011-01-14 23:18:59 +0100684#endif
Harald Welte08011e22011-03-04 13:41:31 +0100685
686 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800687}
688
Harald Welte9773f6c2011-01-14 14:16:16 +0100689static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
690{
691
692 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
693
694 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
695 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
696 gsm_lchan_name(lchan),
697 gsm_lchans_name(lchan->state));
698 bsc_del_timer(&lchan->T3111);
699 /* we have an error timer pending to release that */
700 if (lchan->state != LCHAN_S_REL_ERR)
701 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
702 lchan_free(lchan);
703
704 return 0;
705}
706
Harald Welte59b04682009-06-10 05:40:52 +0800707int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
708 u_int8_t *ms_ident, u_int8_t chan_needed)
709{
710 struct abis_rsl_dchan_hdr *dh;
711 struct msgb *msg = rsl_msgb_alloc();
712
713 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
714 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
715 dh->chan_nr = RSL_CHAN_PCH_AGCH;
716
717 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
718 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
719 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
720
721 msg->trx = bts->c0;
722
723 return abis_rsl_sendmsg(msg);
724}
725
Harald Welte59b04682009-06-10 05:40:52 +0800726int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
727{
728 int i, len = strlen(str_in);
729
730 for (i = 0; i < len; i++) {
731 int num = str_in[i] - 0x30;
732 if (num < 0 || num > 9)
733 return -1;
734 if (i % 2 == 0)
735 bcd_out[i/2] = num;
736 else
737 bcd_out[i/2] |= (num << 4);
738 }
739
740 return 0;
741}
742
743/* Chapter 8.5.6 */
744int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
745{
746 struct msgb *msg = rsl_msgb_alloc();
747 struct abis_rsl_dchan_hdr *dh;
748 u_int8_t buf[MACBLOCK_SIZE];
749
750 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
751 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
752 dh->chan_nr = RSL_CHAN_PCH_AGCH;
753
754 switch (bts->type) {
755 case GSM_BTS_TYPE_BS11:
756 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
757 break;
758 default:
759 /* If phase 2, construct a FULL_IMM_ASS_INFO */
760 pad_macblock(buf, val, len);
761 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
762 break;
763 }
764
765 msg->trx = bts->c0;
766
767 return abis_rsl_sendmsg(msg);
768}
769
Harald Welte4684e632009-08-10 09:51:40 +0200770/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200771int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200772{
773 struct msgb *msg = rsl_msgb_alloc();
774 struct abis_rsl_dchan_hdr *dh;
775
776 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
777 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200778 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200779 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200780 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200781
Harald Weltede4477a2009-12-24 12:20:20 +0100782 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100783 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200784
785 msg->trx = lchan->ts->trx;
786
Harald Welte4684e632009-08-10 09:51:40 +0200787 return abis_rsl_sendmsg(msg);
788}
789
790
Harald Welte59b04682009-06-10 05:40:52 +0800791/* Send "DATA REQUEST" message with given L3 Info payload */
792/* Chapter 8.3.1 */
793int rsl_data_request(struct msgb *msg, u_int8_t link_id)
794{
Harald Welte59b04682009-06-10 05:40:52 +0800795 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100796 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800797 return -EINVAL;
798 }
799
Harald Weltea22d36b2010-03-04 10:33:10 +0100800 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
801 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800802
803 msg->trx = msg->lchan->ts->trx;
804
805 return abis_rsl_sendmsg(msg);
806}
807
Harald Welteed9a5ab2009-08-09 13:47:35 +0200808/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
809/* Chapter 8.3.1 */
810int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
811{
Harald Weltea22d36b2010-03-04 10:33:10 +0100812 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200813
Harald Weltea22d36b2010-03-04 10:33:10 +0100814 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
815 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200816 msg->trx = lchan->ts->trx;
817
818 return abis_rsl_sendmsg(msg);
819}
820
Harald Welte0f2e3c12009-08-08 13:15:07 +0200821/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
822 This is what higher layers should call. The BTS then responds with
823 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
824 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
825 lchan_free() */
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800826int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200827{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200828
Harald Weltea22d36b2010-03-04 10:33:10 +0100829 struct msgb *msg;
830
831 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
832 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800833 /* 0 is normal release, 1 is local end */
834 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200835
Harald Weltec88a4432009-12-29 10:44:17 +0100836 /* FIXME: start some timer in case we don't receive a REL ACK ? */
837
Harald Welte0f2e3c12009-08-08 13:15:07 +0200838 msg->trx = lchan->ts->trx;
839
840 return abis_rsl_sendmsg(msg);
841}
842
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200843int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
844{
845 lchan->state = state;
846 return 0;
847}
848
Harald Welte59b04682009-06-10 05:40:52 +0800849/* Chapter 8.4.2: Channel Activate Acknowledge */
850static int rsl_rx_chan_act_ack(struct msgb *msg)
851{
852 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
853
854 /* BTS has confirmed channel activation, we now need
855 * to assign the activated channel to the MS */
856 if (rslh->ie_chan != RSL_IE_CHAN_NR)
857 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100858
Harald Weltec88a4432009-12-29 10:44:17 +0100859 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100860 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
861 gsm_lchan_name(msg->lchan),
862 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200863 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100864
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800865 if (msg->lchan->rqd_ref) {
866 rsl_send_imm_assignment(msg->lchan);
867 talloc_free(msg->lchan->rqd_ref);
868 msg->lchan->rqd_ref = NULL;
869 msg->lchan->rqd_ta = 0;
870 }
871
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100872 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100873
Harald Welte59b04682009-06-10 05:40:52 +0800874 return 0;
875}
876
877/* Chapter 8.4.3: Channel Activate NACK */
878static int rsl_rx_chan_act_nack(struct msgb *msg)
879{
880 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
881 struct tlv_parsed tp;
882
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100883 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100884 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100885
Harald Welte59b04682009-06-10 05:40:52 +0800886 /* BTS has rejected channel activation ?!? */
887 if (dh->ie_chan != RSL_IE_CHAN_NR)
888 return -EINVAL;
889
890 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100891 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
892 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
893 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200894 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100895 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200896 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100897 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200898 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200899
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100900 LOGPC(DRSL, LOGL_ERROR, "\n");
901
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100902 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100903
Harald Weltecddb9802009-08-09 19:50:08 +0200904 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800905 return 0;
906}
907
908/* Chapter 8.4.4: Connection Failure Indication */
909static int rsl_rx_conn_fail(struct msgb *msg)
910{
911 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
912 struct tlv_parsed tp;
913
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100914 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100915 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100916 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800917
918 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
919
Harald Weltef1a168d2009-07-28 17:58:09 +0200920 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100921 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200922 TLVP_LEN(&tp, RSL_IE_CAUSE));
923
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100924 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800925 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +0200926 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800927 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800928}
929
Harald Weltec20bd1d2009-11-29 19:07:28 +0100930static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
931 const char *prefix)
932{
Harald Welte0e4fa782009-12-16 16:52:07 +0100933 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
934 prefix, rxlev2dbm(mru->full.rx_lev),
935 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100936 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
937 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
938}
939
940static void print_meas_rep(struct gsm_meas_rep *mr)
941{
Harald Welte0e4fa782009-12-16 16:52:07 +0100942 int i;
943
Harald Weltec20bd1d2009-11-29 19:07:28 +0100944 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
945
946 if (mr->flags & MEAS_REP_F_DL_DTX)
947 DEBUGPC(DMEAS, "DTXd ");
948
949 print_meas_rep_uni(&mr->ul, "ul");
950 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
951 if (mr->flags & MEAS_REP_F_MS_TO)
952 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
953
954 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100955 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100956 DEBUGPC(DMEAS, "L1_FPC=%u ",
957 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
958 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
959 }
960
961 if (mr->flags & MEAS_REP_F_UL_DTX)
962 DEBUGPC(DMEAS, "DTXu ");
963 if (mr->flags & MEAS_REP_F_BA1)
964 DEBUGPC(DMEAS, "BA1 ");
965 if (!(mr->flags & MEAS_REP_F_DL_VALID))
966 DEBUGPC(DMEAS, "NOT VALID ");
967 else
968 print_meas_rep_uni(&mr->dl, "dl");
969
970 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100971 if (mr->num_cell == 7)
972 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100973 for (i = 0; i < mr->num_cell; i++) {
974 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100975 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
976 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100977 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100978}
979
Harald Welte59b04682009-06-10 05:40:52 +0800980static int rsl_rx_meas_res(struct msgb *msg)
981{
982 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
983 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100984 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100985 u_int8_t len;
986 const u_int8_t *val;
987 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800988
Harald Welte4baa9c52009-12-21 13:27:11 +0100989 /* check if this channel is actually active */
990 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100991 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800992 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100993 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100994 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100995 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100996
Harald Weltef9476812009-12-15 21:36:05 +0100997 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100998 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100999
Harald Welte59b04682009-06-10 05:40:52 +08001000 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1001
Harald Weltec20bd1d2009-11-29 19:07:28 +01001002 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1003 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1004 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1005 return -EIO;
1006
1007 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001008 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001009
1010 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1011 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1012 if (len >= 3) {
1013 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001014 mr->flags |= MEAS_REP_F_DL_DTX;
1015 mr->ul.full.rx_lev = val[0] & 0x3f;
1016 mr->ul.sub.rx_lev = val[1] & 0x3f;
1017 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1018 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001019 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001020
Harald Weltef9476812009-12-15 21:36:05 +01001021 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001022
1023 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001024 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001025 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001026 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1027
Harald Weltea1467eb2009-06-20 18:44:35 +02001028 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001029 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001030 mr->flags |= MEAS_REP_F_MS_L1;
1031 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001032 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001033 mr->flags |= MEAS_REP_F_FPC;
1034 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001035 }
Harald Welte59b04682009-06-10 05:40:52 +08001036 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001037 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001038 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001039 if (rc < 0)
1040 return rc;
1041 }
1042
Harald Weltef9476812009-12-15 21:36:05 +01001043 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001044
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001045 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001046
Harald Welte59b04682009-06-10 05:40:52 +08001047 return 0;
1048}
1049
Harald Welte6720a432009-11-29 22:45:52 +01001050/* Chapter 8.4.7 */
1051static int rsl_rx_hando_det(struct msgb *msg)
1052{
1053 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1054 struct tlv_parsed tp;
1055
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001056 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001057
1058 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1059
1060 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1061 DEBUGPC(DRSL, "access delay = %u\n",
1062 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1063 else
1064 DEBUGPC(DRSL, "\n");
1065
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001066 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001067
1068 return 0;
1069}
1070
Harald Welte59b04682009-06-10 05:40:52 +08001071static int abis_rsl_rx_dchan(struct msgb *msg)
1072{
1073 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1074 int rc = 0;
1075 char *ts_name;
1076
1077 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001078 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001079
Harald Welte59b04682009-06-10 05:40:52 +08001080 switch (rslh->c.msg_type) {
1081 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001082 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001083 rc = rsl_rx_chan_act_ack(msg);
1084 break;
1085 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001086 rc = rsl_rx_chan_act_nack(msg);
1087 break;
1088 case RSL_MT_CONN_FAIL:
1089 rc = rsl_rx_conn_fail(msg);
1090 break;
1091 case RSL_MT_MEAS_RES:
1092 rc = rsl_rx_meas_res(msg);
1093 break;
Harald Welte6720a432009-11-29 22:45:52 +01001094 case RSL_MT_HANDO_DET:
1095 rc = rsl_rx_hando_det(msg);
1096 break;
Harald Welte59b04682009-06-10 05:40:52 +08001097 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001098 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001099 break;
1100 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001101 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001102 break;
1103 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001104 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001105 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001106 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001107 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001108 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001109 break;
1110 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001111 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001112 break;
1113 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001114 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001115 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001116 break;
1117 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001118 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001119 break;
Harald Welte59b04682009-06-10 05:40:52 +08001120 case RSL_MT_PHY_CONTEXT_CONF:
1121 case RSL_MT_PREPROC_MEAS_RES:
1122 case RSL_MT_TALKER_DET:
1123 case RSL_MT_LISTENER_DET:
1124 case RSL_MT_REMOTE_CODEC_CONF_REP:
1125 case RSL_MT_MR_CODEC_MOD_ACK:
1126 case RSL_MT_MR_CODEC_MOD_NACK:
1127 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001128 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1129 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001130 break;
1131 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001132 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1133 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001134 return -EINVAL;
1135 }
1136
1137 return rc;
1138}
1139
1140static int rsl_rx_error_rep(struct msgb *msg)
1141{
1142 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001143 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001144
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001145 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001146
1147 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1148
1149 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001150 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001151 TLVP_LEN(&tp, RSL_IE_CAUSE));
1152
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001153 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001154
1155 return 0;
1156}
1157
1158static int abis_rsl_rx_trx(struct msgb *msg)
1159{
1160 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1161 int rc = 0;
1162
1163 switch (rslh->msg_type) {
1164 case RSL_MT_ERROR_REPORT:
1165 rc = rsl_rx_error_rep(msg);
1166 break;
1167 case RSL_MT_RF_RES_IND:
1168 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001169 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001170 break;
1171 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001172 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001173 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1174 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001175 break;
1176 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001177 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1178 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001179 return -EINVAL;
1180 }
1181 return rc;
1182}
1183
Harald Welte427dbc42009-08-10 00:26:10 +02001184/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1185static void t3101_expired(void *data)
1186{
1187 struct gsm_lchan *lchan = data;
1188
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001189 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001190}
1191
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001192/* If T3111 expires, we will send the RF Channel Request */
1193static void t3111_expired(void *data)
1194{
1195 struct gsm_lchan *lchan = data;
1196
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001197 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001198}
1199
laforge50312e82010-06-21 12:08:52 +02001200#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1201
Harald Weltea00fdd72010-12-23 14:39:29 +01001202/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1203static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1204 unsigned int num_req_refs,
1205 struct gsm48_req_ref *rqd_refs,
1206 uint8_t wait_ind)
1207{
1208 uint8_t buf[GSM_MACBLOCK_LEN];
1209 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1210
1211 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1212 memset(iar, 0, sizeof(*iar));
1213 iar->proto_discr = GSM48_PDISC_RR;
1214 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1215 iar->page_mode = GSM48_PM_SAME;
1216
1217 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1218 iar->wait_ind1 = wait_ind;
1219
1220 if (num_req_refs >= 2)
1221 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1222 else
1223 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1224 iar->wait_ind2 = wait_ind;
1225
1226 if (num_req_refs >= 3)
1227 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1228 else
1229 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1230 iar->wait_ind3 = wait_ind;
1231
1232 if (num_req_refs >= 4)
1233 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1234 else
1235 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1236 iar->wait_ind4 = wait_ind;
1237
1238 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1239}
1240
Harald Welte59b04682009-06-10 05:40:52 +08001241/* MS has requested a channel on the RACH */
1242static int rsl_rx_chan_rqd(struct msgb *msg)
1243{
1244 struct gsm_bts *bts = msg->trx->bts;
1245 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1246 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001247 enum gsm_chan_t lctype;
1248 enum gsm_chreq_reason_t chreq_reason;
1249 struct gsm_lchan *lchan;
1250 u_int8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001251 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001252
1253 u_int16_t arfcn;
1254 u_int8_t ts_number, subch;
1255
1256 /* parse request reference to be used in immediate assign */
1257 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1258 return -EINVAL;
1259
1260 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1261
1262 /* parse access delay and use as TA */
1263 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1264 return -EINVAL;
1265 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1266
1267 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1268 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001269 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1270 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001271
Harald Weltebdbb7442009-12-22 19:07:32 +01001272 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001273
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001274 /*
1275 * We want LOCATION UPDATES to succeed and will assign a TCH
1276 * if we have no SDCCH available.
1277 */
1278 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1279
Harald Welte59b04682009-06-10 05:40:52 +08001280 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001281 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001282 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001283 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001284 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001285 counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001286 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1287 if (bts->network->T3122)
1288 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001289 return -ENOMEM;
1290 }
1291
Harald Weltec88a4432009-12-29 10:44:17 +01001292 if (lchan->state != LCHAN_S_NONE)
1293 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001294 "in state %s\n", gsm_lchan_name(lchan),
1295 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001296 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001297
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001298 /* save the RACH data as we need it after the CHAN ACT ACK */
1299 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1300 if (!lchan->rqd_ref) {
1301 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1302 lchan_free(lchan);
1303 return -ENOMEM;
1304 }
1305
1306 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1307 lchan->rqd_ta = rqd_ta;
1308
Harald Welte59b04682009-06-10 05:40:52 +08001309 ts_number = lchan->ts->nr;
1310 arfcn = lchan->ts->trx->arfcn;
1311 subch = lchan->nr;
1312
Harald Welted2dd9de2009-08-30 15:37:11 +09001313 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001314 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001315 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001316 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001317 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001318
1319 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001320 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001321
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001322 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1323 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1324 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1325 rqd_ref->ra);
1326 return 0;
1327}
1328
1329static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1330{
1331 struct gsm_bts *bts = lchan->ts->trx->bts;
1332 u_int8_t buf[GSM_MACBLOCK_LEN];
1333 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1334
Harald Welte59b04682009-06-10 05:40:52 +08001335 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001336 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001337 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001338 ia->proto_discr = GSM48_PDISC_RR;
1339 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1340 ia->page_mode = GSM48_PM_SAME;
1341 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001342
Harald Welte59b04682009-06-10 05:40:52 +08001343 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001344 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1345 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001346 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001347 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001348 } else {
laforgee06d5982010-06-20 15:18:46 +02001349 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1350 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001351 }
Harald Welte07f32182010-06-28 18:41:27 +02001352 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1353 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001354
Harald Welte427dbc42009-08-10 00:26:10 +02001355 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1356 lchan->T3101.cb = t3101_expired;
1357 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001358 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001359
1360 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001361 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001362}
1363
1364/* MS has requested a channel on the RACH */
1365static int rsl_rx_ccch_load(struct msgb *msg)
1366{
1367 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1368 u_int16_t pg_buf_space;
1369 u_int16_t rach_slot_count = -1;
1370 u_int16_t rach_busy_count = -1;
1371 u_int16_t rach_access_count = -1;
1372
1373 switch (rslh->data[0]) {
1374 case RSL_IE_PAGING_LOAD:
1375 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001376 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1377 /* paging load below configured threshold, use 50 as default */
1378 pg_buf_space = 50;
1379 }
Harald Welte59b04682009-06-10 05:40:52 +08001380 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1381 break;
1382 case RSL_IE_RACH_LOAD:
1383 if (msg->data_len >= 7) {
1384 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1385 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1386 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1387 }
1388 break;
1389 default:
1390 break;
1391 }
1392
1393 return 0;
1394}
1395
1396static int abis_rsl_rx_cchan(struct msgb *msg)
1397{
1398 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1399 int rc = 0;
1400
1401 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1402
1403 switch (rslh->c.msg_type) {
1404 case RSL_MT_CHAN_RQD:
1405 /* MS has requested a channel on the RACH */
1406 rc = rsl_rx_chan_rqd(msg);
1407 break;
1408 case RSL_MT_CCCH_LOAD_IND:
1409 /* current load on the CCCH */
1410 rc = rsl_rx_ccch_load(msg);
1411 break;
1412 case RSL_MT_DELETE_IND:
1413 /* CCCH overloaded, IMM_ASSIGN was dropped */
1414 case RSL_MT_CBCH_LOAD_IND:
1415 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001416 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1417 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001418 break;
1419 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001420 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1421 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001422 return -EINVAL;
1423 }
1424
1425 return rc;
1426}
1427
1428static int rsl_rx_rll_err_ind(struct msgb *msg)
1429{
1430 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1431 u_int8_t *rlm_cause = rllh->data;
1432
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001433 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001434 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001435 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001436
1437 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001438
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001439 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1440 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001441 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001442 }
Harald Welte692f5852009-07-04 09:40:05 +02001443
Harald Welte59b04682009-06-10 05:40:52 +08001444 return 0;
1445}
1446
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001447static void rsl_handle_release(struct gsm_lchan *lchan)
1448{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001449 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001450 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001451
1452 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001453 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001454 return;
1455
1456 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1457 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1458 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001459 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001460 gsm_lchan_name(lchan), sapi);
1461 return;
1462 }
1463
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001464
1465
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001466 /* wait a bit to send the RF Channel Release */
1467 lchan->T3111.cb = t3111_expired;
1468 lchan->T3111.data = lchan;
1469 bts = lchan->ts->trx->bts;
1470 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001471}
1472
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001473/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001474 0x02, 0x06,
1475 0x01, 0x20,
1476 0x02, 0x00,
1477 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1478
1479static int abis_rsl_rx_rll(struct msgb *msg)
1480{
1481 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1482 int rc = 0;
1483 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001484 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001485
1486 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001487 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001488 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001489
1490 switch (rllh->c.msg_type) {
1491 case RSL_MT_DATA_IND:
1492 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001493 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001494 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1495 rllh->data[0] == RSL_IE_L3_INFO) {
1496 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001497 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001498 }
1499 break;
1500 case RSL_MT_EST_IND:
1501 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001502 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001503 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001504 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001505 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001506 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1507 rllh->data[0] == RSL_IE_L3_INFO) {
1508 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001509 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001510 }
1511 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001512 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001513 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001514 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001515 rll_indication(msg->lchan, rllh->link_id,
1516 BSC_RLLR_IND_EST_CONF);
1517 break;
Harald Welte59b04682009-06-10 05:40:52 +08001518 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001519 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001520 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001521 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001522 rll_indication(msg->lchan, rllh->link_id,
1523 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001524 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001525 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001526 break;
1527 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001528 /* BTS informs us of having received UA from MS,
1529 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001530 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001531 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001532 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001533 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001534 break;
1535 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001536 rc = rsl_rx_rll_err_ind(msg);
1537 break;
1538 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001539 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1540 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001541 break;
1542 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001543 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1544 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001545 }
Harald Welte59b04682009-06-10 05:40:52 +08001546 return rc;
1547}
1548
Harald Welteb284b472009-12-02 01:58:23 +05301549static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001550{
Harald Welteb284b472009-12-02 01:58:23 +05301551 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001552 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301553 switch (lchan->type) {
1554 case GSM_LCHAN_TCH_F:
1555 return 0x00;
1556 case GSM_LCHAN_TCH_H:
1557 return 0x03;
1558 default:
1559 break;
1560 }
Harald Welte98d79f92009-07-28 18:11:56 +02001561 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301562 switch (lchan->type) {
1563 case GSM_LCHAN_TCH_F:
1564 return 0x01;
1565 /* there's no half-rate EFR */
1566 default:
1567 break;
1568 }
Harald Welte98d79f92009-07-28 18:11:56 +02001569 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301570 switch (lchan->type) {
1571 case GSM_LCHAN_TCH_F:
1572 return 0x02;
1573 case GSM_LCHAN_TCH_H:
1574 return 0x05;
1575 default:
1576 break;
1577 }
1578 default:
1579 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001580 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001581 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301582 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001583 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001584}
1585
Sylvain Munaut1338a552009-12-20 22:06:40 +01001586static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1587{
Holger Hans Peter Freyther6651b692010-11-14 21:09:08 +01001588 struct gsm_network *net = lchan->ts->trx->bts->network;
1589
1590 /* allow to hardcode the rtp payload */
1591 if (net->hardcoded_rtp_payload != 0)
1592 return net->hardcoded_rtp_payload;
1593
Sylvain Munaut1338a552009-12-20 22:06:40 +01001594 switch (lchan->tch_mode) {
1595 case GSM48_CMODE_SPEECH_V1:
1596 switch (lchan->type) {
1597 case GSM_LCHAN_TCH_F:
1598 return RTP_PT_GSM_FULL;
1599 case GSM_LCHAN_TCH_H:
1600 return RTP_PT_GSM_HALF;
1601 default:
1602 break;
1603 }
1604 case GSM48_CMODE_SPEECH_EFR:
1605 switch (lchan->type) {
1606 case GSM_LCHAN_TCH_F:
1607 return RTP_PT_GSM_EFR;
1608 /* there's no half-rate EFR */
1609 default:
1610 break;
1611 }
1612 case GSM48_CMODE_SPEECH_AMR:
1613 switch (lchan->type) {
1614 case GSM_LCHAN_TCH_F:
1615 return RTP_PT_AMR_FULL;
1616 case GSM_LCHAN_TCH_H:
1617 return RTP_PT_AMR_HALF;
1618 default:
1619 break;
1620 }
1621 default:
1622 break;
1623 }
1624 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1625 "tch_mode == 0x%02x\n & lchan_type == %d",
1626 lchan->tch_mode, lchan->type);
1627 return 0;
1628}
1629
Harald Welte59b04682009-06-10 05:40:52 +08001630/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001631static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1632{
1633 struct in_addr ip;
1634 u_int16_t port, conn_id;
1635
1636 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1637 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1638 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1639 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1640 }
1641
1642 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1643 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1644 port = ntohs(port);
1645 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1646 lchan->abis_ip.bound_port = port;
1647 }
1648
1649 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1650 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1651 conn_id = ntohs(conn_id);
1652 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1653 lchan->abis_ip.conn_id = conn_id;
1654 }
1655
1656 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1657 lchan->abis_ip.rtp_payload2 =
1658 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1659 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1660 lchan->abis_ip.rtp_payload2);
1661 }
1662
1663 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1664 lchan->abis_ip.speech_mode =
1665 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1666 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1667 lchan->abis_ip.speech_mode);
1668 }
1669
1670 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1671 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1672 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1673 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1674 }
1675
1676 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1677 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1678 port = ntohs(port);
1679 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1680 lchan->abis_ip.connect_port = port;
1681 }
1682}
1683
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001684int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001685{
1686 struct msgb *msg = rsl_msgb_alloc();
1687 struct abis_rsl_dchan_hdr *dh;
1688
1689 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001690 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001691 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1692 dh->chan_nr = lchan2chan_nr(lchan);
1693
Harald Welte98d79f92009-07-28 18:11:56 +02001694 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001695 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001696 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001697 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001698 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001699
Sylvain Munaut1338a552009-12-20 22:06:40 +01001700 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1701 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1702 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001703
Harald Welte59b04682009-06-10 05:40:52 +08001704 msg->trx = lchan->ts->trx;
1705
1706 return abis_rsl_sendmsg(msg);
1707}
1708
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001709int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001710 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001711{
1712 struct msgb *msg = rsl_msgb_alloc();
1713 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001714 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001715 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001716
1717 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001718 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001719 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1720 dh->chan_nr = lchan2chan_nr(lchan);
1721
Harald Weltebffa4992009-12-19 16:42:06 +01001722 /* we need to store these now as MDCX_ACK does not return them :( */
1723 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1724 lchan->abis_ip.connect_port = port;
1725 lchan->abis_ip.connect_ip = ip;
1726
Harald Weltefb4a9e92009-07-29 12:12:18 +02001727 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001728 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001729 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001730
Harald Welte98d79f92009-07-28 18:11:56 +02001731 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001732 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1733 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1734 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1735 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001736
Harald Weltebffa4992009-12-19 16:42:06 +01001737 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1738 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1739 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1740 *att_ip = ia.s_addr;
1741 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1742 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001743 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001744 if (rtp_payload2)
1745 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1746
Harald Welte59b04682009-06-10 05:40:52 +08001747 msg->trx = lchan->ts->trx;
1748
1749 return abis_rsl_sendmsg(msg);
1750}
1751
Harald Welte9947d9f2009-12-20 16:51:09 +01001752/* tell BTS to connect RTP stream to our local RTP socket */
1753int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1754{
1755 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1756 int rc;
1757
1758 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1759 ntohs(rs->rtp.sin_local.sin_port),
1760 /* FIXME: use RTP payload of bound socket, not BTS*/
1761 lchan->abis_ip.rtp_payload2);
1762
1763 return rc;
1764}
1765
Harald Welte6f40df02010-12-23 12:59:52 +01001766int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001767{
1768 struct msgb *msg = rsl_msgb_alloc();
1769 struct abis_rsl_dchan_hdr *dh;
Harald Welte2b361522010-03-28 14:42:09 +08001770 u_int8_t msg_type;
1771
1772 if (act)
1773 msg_type = RSL_MT_IPAC_PDCH_ACT;
1774 else
1775 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001776
1777 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001778 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001779 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte6f40df02010-12-23 12:59:52 +01001780 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001781
Harald Welte6f40df02010-12-23 12:59:52 +01001782 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001783 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001784
Harald Welte6f40df02010-12-23 12:59:52 +01001785 msg->trx = ts->trx;
Harald Welteaed946e2009-10-24 10:29:22 +02001786
1787 return abis_rsl_sendmsg(msg);
1788}
1789
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001790static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001791{
1792 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1793 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301794 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001795
1796 /* the BTS has acknowledged a local bind, it now tells us the IP
1797 * address and port number to which it has bound the given logical
1798 * channel */
1799
1800 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1801 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1802 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001803 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001804 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001805 return -EINVAL;
1806 }
Harald Welte50517742009-12-20 15:42:44 +01001807
Harald Weltebffa4992009-12-19 16:42:06 +01001808 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001809
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001810 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001811
1812 return 0;
1813}
1814
Harald Weltebffa4992009-12-19 16:42:06 +01001815static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1816{
1817 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1818 struct tlv_parsed tv;
1819 struct gsm_lchan *lchan = msg->lchan;
1820
1821 /* the BTS has acknowledged a remote connect request and
1822 * it now tells us the IP address and port number to which it has
1823 * connected the given logical channel */
1824
1825 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1826 ipac_parse_rtp(lchan, &tv);
1827 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1828
1829 return 0;
1830}
1831
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001832static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001833{
1834 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1835 struct tlv_parsed tv;
1836
1837 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001838
Harald Weltef1a168d2009-07-28 17:58:09 +02001839 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001840 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001841 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001842
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001843 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001844
Harald Welte59b04682009-06-10 05:40:52 +08001845 return 0;
1846}
1847
1848static int abis_rsl_rx_ipacc(struct msgb *msg)
1849{
1850 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001851 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001852 int rc = 0;
1853
1854 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001855 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001856
1857 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001858 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001859 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001860 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001861 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001862 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001863 /* somehow the BTS was unable to bind the lchan to its local
1864 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001865 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001866 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001867 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001868 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001869 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001870 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001871 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001872 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001873 /* somehow the BTS was unable to connect the lchan to a remote
1874 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001875 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001876 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001877 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001878 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001879 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001880 break;
1881 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001882 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001883 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001884 break;
1885 }
1886 DEBUGPC(DRSL, "\n");
1887
1888 return rc;
1889}
1890
1891
1892/* Entry-point where L2 RSL from BTS enters */
1893int abis_rsl_rcvmsg(struct msgb *msg)
1894{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001895 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001896 int rc = 0;
1897
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001898 if (!msg) {
1899 DEBUGP(DRSL, "Empty RSL msg?..\n");
1900 return -1;
1901 }
1902
1903 if (msgb_l2len(msg) < sizeof(*rslh)) {
1904 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1905 return -1;
1906 }
1907
1908 rslh = msgb_l2(msg);
1909
Harald Welte59b04682009-06-10 05:40:52 +08001910 switch (rslh->msg_discr & 0xfe) {
1911 case ABIS_RSL_MDISC_RLL:
1912 rc = abis_rsl_rx_rll(msg);
1913 break;
1914 case ABIS_RSL_MDISC_DED_CHAN:
1915 rc = abis_rsl_rx_dchan(msg);
1916 break;
1917 case ABIS_RSL_MDISC_COM_CHAN:
1918 rc = abis_rsl_rx_cchan(msg);
1919 break;
1920 case ABIS_RSL_MDISC_TRX:
1921 rc = abis_rsl_rx_trx(msg);
1922 break;
1923 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001924 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001925 rslh->msg_discr);
1926 break;
1927 case ABIS_RSL_MDISC_IPACCESS:
1928 rc = abis_rsl_rx_ipacc(msg);
1929 break;
1930 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001931 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1932 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001933 return -EINVAL;
1934 }
1935 msgb_free(msg);
1936 return rc;
1937}
1938
Harald Welte59b04682009-06-10 05:40:52 +08001939/* From Table 10.5.33 of GSM 04.08 */
1940int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1941{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301942 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1943 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1944 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001945 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301946 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1947 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001948 }
1949}
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08001950
1951int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1952 uint8_t cb_command, const uint8_t *data, int len)
1953{
1954 struct abis_rsl_dchan_hdr *dh;
1955 struct msgb *cb_cmd;
1956
1957 cb_cmd = rsl_msgb_alloc();
1958 if (!cb_cmd)
1959 return -1;
1960
1961 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1962 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1963 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1964
1965 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1966 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1967
1968 cb_cmd->trx = bts->c0;
1969
1970 return abis_rsl_sendmsg(cb_cmd);
1971}