blob: e47900d4ba5eb08e5a68c7b9910c8d76a6122511 [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Welte3c9c5f92010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte8470bf22008-12-25 23:28:35 +00005 *
Harald Welte52b1f982008-12-23 20:25:15 +00006 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
21 *
22 */
23
24#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000025#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000026#include <errno.h>
27#include <sys/types.h>
Harald Welte75099262009-02-16 21:12:08 +000028#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000029#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000030
Harald Welte8470bf22008-12-25 23:28:35 +000031#include <openbsc/gsm_data.h>
32#include <openbsc/gsm_04_08.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010033#include <osmocore/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000034#include <openbsc/abis_rsl.h>
35#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020036#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000037#include <openbsc/debug.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010038#include <osmocore/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000039#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000040#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010041#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010042#include <openbsc/rtp_proxy.h>
Harald Welte2e411c72010-03-01 21:59:06 +010043#include <osmocore/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000044
Harald Welte8470bf22008-12-25 23:28:35 +000045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000047
Holger Freyther3b72a892009-02-04 00:31:39 +000048#define MAX(a, b) (a) >= (b) ? (a) : (b)
49
Harald Welte52b1f982008-12-23 20:25:15 +000050static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
51{
52 /* mask off the transparent bit ? */
53 msg_type &= 0xfe;
54
Harald Welte8470bf22008-12-25 23:28:35 +000055 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000056 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000057 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000058 if (msg_type >= 0x19 && msg_type <= 0x22)
59 return ABIS_RSL_MDISC_TRX;
60 else
61 return ABIS_RSL_MDISC_COM_CHAN;
62 }
Harald Welte2d5b6382008-12-27 19:46:06 +000063 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000064 return ABIS_RSL_MDISC_DED_CHAN;
65
66 return ABIS_RSL_MDISC_LOC;
67}
68
69static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
70 u_int8_t msg_type)
71{
72 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
73 dh->c.msg_type = msg_type;
74 dh->ie_chan = RSL_IE_CHAN_NR;
75}
76
Harald Welte8470bf22008-12-25 23:28:35 +000077/* determine logical channel based on TRX and channel number IE */
78struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
79{
80 struct gsm_lchan *lchan;
81 u_int8_t ts_nr = chan_nr & 0x07;
82 u_int8_t cbits = chan_nr >> 3;
83 u_int8_t lch_idx;
84 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
85
86 if (cbits == 0x01) {
87 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020088 if (ts->pchan != GSM_PCHAN_TCH_F &&
89 ts->pchan != GSM_PCHAN_PDCH &&
90 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +010091 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +000092 chan_nr, ts->pchan);
93 } else if ((cbits & 0x1e) == 0x02) {
94 lch_idx = cbits & 0x1; /* TCH/H */
95 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +010096 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +000097 chan_nr, ts->pchan);
98 } else if ((cbits & 0x1c) == 0x04) {
99 lch_idx = cbits & 0x3; /* SDCCH/4 */
100 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100101 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000102 chan_nr, ts->pchan);
103 } else if ((cbits & 0x18) == 0x08) {
104 lch_idx = cbits & 0x7; /* SDCCH/8 */
105 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100106 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000107 chan_nr, ts->pchan);
108 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
109 lch_idx = 0;
110 if (ts->pchan != GSM_PCHAN_CCCH &&
111 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100112 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000113 chan_nr, ts->pchan);
114 /* FIXME: we should not return first sdcch4 !!! */
115 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100116 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000117 return NULL;
118 }
119
120 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800121 log_set_context(BSC_CTX_LCHAN, lchan);
122 log_set_context(BSC_CTX_SUBSCR, lchan->conn.subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000123
124 return lchan;
125}
126
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200127/* See Table 10.5.25 of GSM04.08 */
Harald Welte24766092009-12-09 19:18:32 +0100128u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte8470bf22008-12-25 23:28:35 +0000129{
130 struct gsm_bts_trx_ts *ts = lchan->ts;
131 u_int8_t cbits, chan_nr;
132
133 switch (ts->pchan) {
134 case GSM_PCHAN_TCH_F:
Harald Weltea1499d02009-10-24 10:25:50 +0200135 case GSM_PCHAN_PDCH:
136 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000137 cbits = 0x01;
138 break;
139 case GSM_PCHAN_TCH_H:
140 cbits = 0x02;
141 cbits += lchan->nr;
142 break;
143 case GSM_PCHAN_CCCH_SDCCH4:
144 cbits = 0x04;
145 cbits += lchan->nr;
146 break;
147 case GSM_PCHAN_SDCCH8_SACCH8C:
148 cbits = 0x08;
149 cbits += lchan->nr;
150 break;
151 default:
152 case GSM_PCHAN_CCCH:
153 cbits = 0x10;
154 break;
155 }
156
157 chan_nr = (cbits << 3) | (ts->nr & 0x7);
158
159 return chan_nr;
160}
161
Harald Welte52b1f982008-12-23 20:25:15 +0000162/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
163u_int64_t str_to_imsi(const char *imsi_str)
164{
165 u_int64_t ret;
166
167 ret = strtoull(imsi_str, NULL, 10);
168
169 return ret;
170}
171
172/* Table 5 Clause 7 TS 05.02 */
173unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
174{
175 if (!bs_ccch_sdcch_comb)
176 return 9 - bs_ag_blks_res;
177 else
178 return 3 - bs_ag_blks_res;
179}
180
181/* Chapter 6.5.2 of TS 05.02 */
182unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
183 unsigned int n_pag_blocks)
184{
185 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
186}
187
188/* Chapter 6.5.2 of TS 05.02 */
189unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
190 int n_pag_blocks)
191{
192 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
193}
194
Harald Welte8470bf22008-12-25 23:28:35 +0000195static struct msgb *rsl_msgb_alloc(void)
196{
Harald Welte966636f2009-06-26 19:39:35 +0200197 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
198 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000199}
200
Harald Welte362322e2009-02-15 14:36:38 +0000201#define MACBLOCK_SIZE 23
202static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
203{
204 memcpy(out, in, len);
205
206 if (len < MACBLOCK_SIZE)
207 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
208}
209
Harald Welte08d91a52009-08-30 15:37:11 +0900210/* Chapter 9.3.7: Encryption Information */
211static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
212{
213 *out++ = lchan->encr.alg_id & 0xff;
214 if (lchan->encr.key_len)
215 memcpy(out, lchan->encr.key, lchan->encr.key_len);
216 return lchan->encr.key_len + 1;
217}
218
Harald Welte5b8ed432009-12-24 12:20:20 +0100219static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200220{
Harald Welte7f93cea2009-02-23 00:02:59 +0000221 int i;
222
Harald Welte5b8ed432009-12-24 12:20:20 +0100223 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200224 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200225 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100226 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000227}
228
Harald Welte52b1f982008-12-23 20:25:15 +0000229/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000230int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000231 const u_int8_t *data, int len)
232{
233 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000234 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000235
236 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
237 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
238 dh->chan_nr = RSL_CHAN_BCCH;
239
240 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
241 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
242
Harald Weltee79769b2009-02-07 00:48:17 +0000243 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000244
245 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000246}
247
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200248int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000249 const u_int8_t *data, int len)
250{
251 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000252 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000253
254 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
255 ch->msg_discr = ABIS_RSL_MDISC_TRX;
256 ch->msg_type = RSL_MT_SACCH_FILL;
257
258 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000259 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000260
Harald Weltee79769b2009-02-07 00:48:17 +0000261 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000262
263 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000264}
265
Harald Weltefcd24452009-06-20 18:15:19 +0200266int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
267{
268 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200269 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200270 u_int8_t chan_nr = lchan2chan_nr(lchan);
271
272 db = abs(db);
273 if (db > 30)
274 return -EINVAL;
275
Harald Welteeab33352009-06-27 03:09:08 +0200276 msg = rsl_msgb_alloc();
277
Harald Weltefcd24452009-06-20 18:15:19 +0200278 lchan->bs_power = db/2;
279 if (fpc)
280 lchan->bs_power |= 0x10;
281
282 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
283 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
284 dh->chan_nr = chan_nr;
285
286 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
287
288 msg->trx = lchan->ts->trx;
289
290 return abis_rsl_sendmsg(msg);
291}
292
Harald Weltefcd24452009-06-20 18:15:19 +0200293int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
294{
295 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200296 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200297 u_int8_t chan_nr = lchan2chan_nr(lchan);
298 int ctl_lvl;
299
Harald Welte66b6a8d2009-08-09 14:45:18 +0200300 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200301 if (ctl_lvl < 0)
302 return ctl_lvl;
303
Harald Welteeab33352009-06-27 03:09:08 +0200304 msg = rsl_msgb_alloc();
305
Harald Weltefcd24452009-06-20 18:15:19 +0200306 lchan->ms_power = ctl_lvl;
307
308 if (fpc)
309 lchan->ms_power |= 0x20;
310
311 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
312 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
313 dh->chan_nr = chan_nr;
314
315 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
316
317 msg->trx = lchan->ts->trx;
318
319 return abis_rsl_sendmsg(msg);
320}
321
Harald Welte9943c5b2009-07-29 15:41:29 +0200322static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
323 struct gsm_lchan *lchan)
324{
325 memset(cm, 0, sizeof(cm));
326
327 /* FIXME: what to do with data calls ? */
328 cm->dtx_dtu = 0x00;
329
330 /* set TCH Speech/Data */
331 cm->spd_ind = lchan->rsl_cmode;
332
Harald Welte1a79d362009-11-27 08:55:16 +0100333 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
334 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100335 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100336 "but tch_mode != signalling\n");
337
Harald Welte9943c5b2009-07-29 15:41:29 +0200338 switch (lchan->type) {
339 case GSM_LCHAN_SDCCH:
340 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
341 break;
342 case GSM_LCHAN_TCH_F:
343 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
344 break;
345 case GSM_LCHAN_TCH_H:
346 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
347 break;
348 case GSM_LCHAN_NONE:
349 case GSM_LCHAN_UNKNOWN:
350 default:
351 return -EINVAL;
352 }
353
354 switch (lchan->tch_mode) {
355 case GSM48_CMODE_SIGN:
356 cm->chan_rate = 0;
357 break;
358 case GSM48_CMODE_SPEECH_V1:
359 cm->chan_rate = RSL_CMOD_SP_GSM1;
360 break;
361 case GSM48_CMODE_SPEECH_EFR:
362 cm->chan_rate = RSL_CMOD_SP_GSM2;
363 break;
364 case GSM48_CMODE_SPEECH_AMR:
365 cm->chan_rate = RSL_CMOD_SP_GSM3;
366 break;
367 case GSM48_CMODE_DATA_14k5:
368 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
369 break;
370 case GSM48_CMODE_DATA_12k0:
371 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
372 break;
373 case GSM48_CMODE_DATA_6k0:
374 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
375 break;
376 default:
377 return -EINVAL;
378 }
379
380 return 0;
381}
382
Harald Welte52b1f982008-12-23 20:25:15 +0000383/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000384#if 0
Harald Weltee79769b2009-02-07 00:48:17 +0000385int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000386 u_int8_t act_type,
387 struct rsl_ie_chan_mode *chan_mode,
388 struct rsl_ie_chan_ident *chan_ident,
389 u_int8_t bs_power, u_int8_t ms_power,
390 u_int8_t ta)
391{
392 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000393 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000394
395 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
396 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
397 dh->chan_nr = chan_nr;
398
399 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
400 /* For compatibility with Phase 1 */
401 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
402 (u_int8_t *) chan_mode);
403 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Harald Welte702d8702008-12-26 20:25:35 +0000404 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000405#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000406 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
407 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000408#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000409 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000410 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
411 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
412
Harald Weltee79769b2009-02-07 00:48:17 +0000413 msg->trx = trx;
414
Harald Welte8470bf22008-12-25 23:28:35 +0000415 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000416}
Harald Welteddab3c72009-02-28 13:19:15 +0000417#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000418
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200419int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte8d77b952009-12-17 00:31:10 +0100420 u_int8_t ta, u_int8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000421{
422 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200423 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200424 int rc;
Harald Welte4b634542008-12-27 01:55:51 +0000425
426 u_int8_t chan_nr = lchan2chan_nr(lchan);
427 u_int16_t arfcn = lchan->ts->trx->arfcn;
428 struct rsl_ie_chan_mode cm;
429 struct rsl_ie_chan_ident ci;
430
Harald Welte9943c5b2009-07-29 15:41:29 +0200431 rc = channel_mode_from_lchan(&cm, lchan);
432 if (rc < 0)
433 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000434
Harald Welte02b0e092009-02-28 13:11:07 +0000435 memset(&ci, 0, sizeof(ci));
Harald Welte4b634542008-12-27 01:55:51 +0000436 ci.chan_desc.iei = 0x64;
437 ci.chan_desc.chan_nr = chan_nr;
Harald Welte02b0e092009-02-28 13:11:07 +0000438 ci.chan_desc.oct3 = (lchan->ts->trx->bts->tsc << 5) | ((arfcn & 0x3ff) >> 8);
Harald Welte4b634542008-12-27 01:55:51 +0000439 ci.chan_desc.oct4 = arfcn & 0xff;
440
Harald Welteeab33352009-06-27 03:09:08 +0200441 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000442 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
443 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
444 dh->chan_nr = chan_nr;
445
446 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000447 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
448 (u_int8_t *) &cm);
Harald Welte8d77b952009-12-17 00:31:10 +0100449 /* For compatibility with Phase 1 */
Harald Welte4b634542008-12-27 01:55:51 +0000450 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
451 (u_int8_t *) &ci);
Harald Welte08d91a52009-08-30 15:37:11 +0900452
453 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
454 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
455 rc = build_encr_info(encr_info, lchan);
456 if (rc > 0)
457 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
458 }
459
Harald Welte8d77b952009-12-17 00:31:10 +0100460 switch (act_type) {
461 case RSL_ACT_INTER_ASYNC:
462 case RSL_ACT_INTER_SYNC:
463 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
464 break;
465 default:
466 break;
467 }
468
Harald Welted4c9bf32009-02-15 16:56:18 +0000469 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
470 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000471 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
472
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100473 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
474 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
475 (u_int8_t *) &lchan->mr_conf);
476
Harald Weltee79769b2009-02-07 00:48:17 +0000477 msg->trx = lchan->ts->trx;
478
Harald Welte4b634542008-12-27 01:55:51 +0000479 return abis_rsl_sendmsg(msg);
480}
481
Harald Welte470abb72009-07-29 11:38:15 +0200482/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000483int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
484{
485 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200486 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200487 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000488
489 u_int8_t chan_nr = lchan2chan_nr(lchan);
490 struct rsl_ie_chan_mode cm;
491
Harald Welte9943c5b2009-07-29 15:41:29 +0200492 rc = channel_mode_from_lchan(&cm, lchan);
493 if (rc < 0)
494 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000495
Harald Welteeab33352009-06-27 03:09:08 +0200496 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000497 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
498 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
499 dh->chan_nr = chan_nr;
500
501 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
502 (u_int8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900503
504 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
505 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
506 rc = build_encr_info(encr_info, lchan);
507 if (rc > 0)
508 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
509 }
510
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100511 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
512 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
513 (u_int8_t *) &lchan->mr_conf);
514 }
515
Harald Welte08d91a52009-08-30 15:37:11 +0900516 msg->trx = lchan->ts->trx;
517
518 return abis_rsl_sendmsg(msg);
519}
520
521/* Chapter 8.4.6: Send the encryption command with given L3 info */
522int rsl_encryption_cmd(struct msgb *msg)
523{
524 struct abis_rsl_dchan_hdr *dh;
525 struct gsm_lchan *lchan = msg->lchan;
526 u_int8_t chan_nr = lchan2chan_nr(lchan);
527 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut82aa6842009-09-27 11:13:18 +0200528 u_int8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900529 int rc;
530
531 /* First push the L3 IE tag and length */
532 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
533
534 /* then the link identifier (SAPI0, main sign link) */
535 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
536
537 /* then encryption information */
538 rc = build_encr_info(encr_info, lchan);
539 if (rc <= 0)
540 return rc;
541 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
542
543 /* and finally the DCHAN header */
544 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
545 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
546 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000547
548 msg->trx = lchan->ts->trx;
549
550 return abis_rsl_sendmsg(msg);
551}
552
Harald Welte115d1032009-08-10 11:43:22 +0200553/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200554int rsl_deact_sacch(struct gsm_lchan *lchan)
555{
556 struct abis_rsl_dchan_hdr *dh;
557 struct msgb *msg = rsl_msgb_alloc();
558
559 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
560 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
561 dh->chan_nr = lchan2chan_nr(lchan);
562
563 msg->lchan = lchan;
564 msg->trx = lchan->ts->trx;
565
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100566 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200567
568 return abis_rsl_sendmsg(msg);
569}
570
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800571static void error_timeout_cb(void *data)
572{
573 struct gsm_lchan *lchan = data;
574 if (lchan->state != LCHAN_S_REL_ERR) {
575 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
576 gsm_lchan_name(lchan), lchan->state);
577 return;
578 }
579
580 /* go back to the none state */
581 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800582 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800583}
584
Harald Welte115d1032009-08-10 11:43:22 +0200585/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800586static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000587{
588 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800589 struct msgb *msg;
Harald Welte52b1f982008-12-23 20:25:15 +0000590
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800591 if (lchan->state == LCHAN_S_REL_ERR) {
592 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
593 gsm_lchan_name(lchan));
594 return -1;
595 }
596
597 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000598 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
599 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000600 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000601
Harald Welte8470bf22008-12-25 23:28:35 +0000602 msg->lchan = lchan;
603 msg->trx = lchan->ts->trx;
604
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800605 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
606
607 if (error) {
608 /*
609 * the nanoBTS sends RLL release indications after the channel release. This can
610 * be a problem when we have reassigned the channel to someone else and then can
611 * not figure out who used this channel.
612 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800613 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800614 lchan->error_timer.data = lchan;
615 lchan->error_timer.cb = error_timeout_cb;
616 bsc_schedule_timer(&lchan->error_timer,
617 msg->trx->bts->network->T3111 + 2, 0);
618 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000619
Harald Welte115d1032009-08-10 11:43:22 +0200620 /* BTS will respond by RF CHAN REL ACK */
Harald Welte8470bf22008-12-25 23:28:35 +0000621 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000622}
623
624int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
625 u_int8_t *ms_ident, u_int8_t chan_needed)
626{
627 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000628 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000629
630 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
631 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
632 dh->chan_nr = RSL_CHAN_PCH_AGCH;
633
634 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000635 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000636 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
637
Harald Welte8470bf22008-12-25 23:28:35 +0000638 msg->trx = bts->c0;
639
640 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000641}
642
Holger Freyther7448a532009-01-04 20:18:23 +0000643int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
644 struct gsm_subscriber *subscr)
645{
Holger Freytherca362a62009-01-04 21:05:01 +0000646#if 0
Holger Freyther7448a532009-01-04 20:18:23 +0000647 u_int8_t mi[128];
648 unsigned int mi_len;
649 u_int8_t paging_group;
Holger Freytherca362a62009-01-04 21:05:01 +0000650#endif
Holger Freyther7448a532009-01-04 20:18:23 +0000651
652 return -1;
653}
654
Harald Welte52b1f982008-12-23 20:25:15 +0000655int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
656{
657 int i, len = strlen(str_in);
658
659 for (i = 0; i < len; i++) {
660 int num = str_in[i] - 0x30;
661 if (num < 0 || num > 9)
662 return -1;
663 if (i % 2 == 0)
664 bcd_out[i/2] = num;
665 else
666 bcd_out[i/2] |= (num << 4);
667 }
668
669 return 0;
670}
671
Harald Welte702d8702008-12-26 20:25:35 +0000672/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000673int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
674{
Harald Welte8470bf22008-12-25 23:28:35 +0000675 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000676 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000677 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000678
679 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
680 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
681 dh->chan_nr = RSL_CHAN_PCH_AGCH;
682
Harald Welte362322e2009-02-15 14:36:38 +0000683 switch (bts->type) {
684 case GSM_BTS_TYPE_BS11:
685 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
686 break;
687 default:
688 /* If phase 2, construct a FULL_IMM_ASS_INFO */
689 pad_macblock(buf, val, len);
690 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
691 break;
692 }
Harald Welte52b1f982008-12-23 20:25:15 +0000693
Harald Welte8470bf22008-12-25 23:28:35 +0000694 msg->trx = bts->c0;
695
696 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000697}
698
Harald Welte67fa91b2009-08-10 09:51:40 +0200699/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200700int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200701{
702 struct msgb *msg = rsl_msgb_alloc();
703 struct abis_rsl_dchan_hdr *dh;
704
705 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
706 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200707 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200708 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte31c48932009-08-10 10:07:33 +0200709 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200710
Harald Welte5b8ed432009-12-24 12:20:20 +0100711 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100712 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200713
714 msg->trx = lchan->ts->trx;
715
Harald Welte67fa91b2009-08-10 09:51:40 +0200716 return abis_rsl_sendmsg(msg);
717}
718
719
Harald Welte8470bf22008-12-25 23:28:35 +0000720/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000721/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000722int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000723{
Harald Welte8470bf22008-12-25 23:28:35 +0000724 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100725 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000726 return -EINVAL;
727 }
Harald Welte52b1f982008-12-23 20:25:15 +0000728
Harald Welte3c9c5f92010-03-04 10:33:10 +0100729 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
730 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000731
Harald Welte8470bf22008-12-25 23:28:35 +0000732 msg->trx = msg->lchan->ts->trx;
733
734 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000735}
736
Harald Welteedcc5272009-08-09 13:47:35 +0200737/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
738/* Chapter 8.3.1 */
739int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
740{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100741 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200742
Harald Welte3c9c5f92010-03-04 10:33:10 +0100743 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
744 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200745 msg->trx = lchan->ts->trx;
746
747 return abis_rsl_sendmsg(msg);
748}
749
Harald Welted2dc1de2009-08-08 13:15:07 +0200750/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
751 This is what higher layers should call. The BTS then responds with
752 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
753 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
754 lchan_free() */
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800755int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200756{
Harald Welted2dc1de2009-08-08 13:15:07 +0200757
Harald Welte3c9c5f92010-03-04 10:33:10 +0100758 struct msgb *msg;
759
760 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
761 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800762 /* 0 is normal release, 1 is local end */
763 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200764
Harald Welte8e93b792009-12-29 10:44:17 +0100765 /* FIXME: start some timer in case we don't receive a REL ACK ? */
766
Harald Welted2dc1de2009-08-08 13:15:07 +0200767 msg->trx = lchan->ts->trx;
768
769 return abis_rsl_sendmsg(msg);
770}
771
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200772int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
773{
774 lchan->state = state;
775 return 0;
776}
777
Harald Welte702d8702008-12-26 20:25:35 +0000778/* Chapter 8.4.2: Channel Activate Acknowledge */
779static int rsl_rx_chan_act_ack(struct msgb *msg)
780{
781 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
782
783 /* BTS has confirmed channel activation, we now need
784 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000785 if (rslh->ie_chan != RSL_IE_CHAN_NR)
786 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100787
Harald Welte8e93b792009-12-29 10:44:17 +0100788 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100789 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
790 gsm_lchan_name(msg->lchan),
791 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200792 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100793
Harald Welted011e8b2009-11-29 22:45:52 +0100794 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
795
Harald Welte4b634542008-12-27 01:55:51 +0000796 return 0;
797}
Harald Welte702d8702008-12-26 20:25:35 +0000798
Harald Welte4b634542008-12-27 01:55:51 +0000799/* Chapter 8.4.3: Channel Activate NACK */
800static int rsl_rx_chan_act_nack(struct msgb *msg)
801{
Harald Welte6dab0552009-05-01 17:21:37 +0000802 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
803 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000804
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100805 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100806 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100807
Harald Welte6dab0552009-05-01 17:21:37 +0000808 /* BTS has rejected channel activation ?!? */
809 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000810 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000811
812 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100813 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
814 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
815 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200816 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100817 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200818 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100819 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200820 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200821
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100822 LOGPC(DRSL, LOGL_ERROR, "\n");
823
Harald Welted011e8b2009-11-29 22:45:52 +0100824 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
825
Harald Welte3073a9f2009-08-09 19:50:08 +0200826 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000827 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000828}
829
Harald Welte7f93cea2009-02-23 00:02:59 +0000830/* Chapter 8.4.4: Connection Failure Indication */
831static int rsl_rx_conn_fail(struct msgb *msg)
832{
833 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
834 struct tlv_parsed tp;
835
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100836 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100837 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100838 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000839
840 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
841
Harald Welte8830e072009-07-28 17:58:09 +0200842 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100843 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200844 TLVP_LEN(&tp, RSL_IE_CAUSE));
845
Harald Welte (local)fc057502009-12-26 22:33:09 +0100846 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000847 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +0200848 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800849 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000850}
851
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100852static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
853 const char *prefix)
854{
Harald Welte6739dfb2009-12-16 16:52:07 +0100855 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
856 prefix, rxlev2dbm(mru->full.rx_lev),
857 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100858 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
859 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
860}
861
862static void print_meas_rep(struct gsm_meas_rep *mr)
863{
Harald Welte6739dfb2009-12-16 16:52:07 +0100864 int i;
865
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100866 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
867
868 if (mr->flags & MEAS_REP_F_DL_DTX)
869 DEBUGPC(DMEAS, "DTXd ");
870
871 print_meas_rep_uni(&mr->ul, "ul");
872 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
873 if (mr->flags & MEAS_REP_F_MS_TO)
874 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
875
876 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100877 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100878 DEBUGPC(DMEAS, "L1_FPC=%u ",
879 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
880 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
881 }
882
883 if (mr->flags & MEAS_REP_F_UL_DTX)
884 DEBUGPC(DMEAS, "DTXu ");
885 if (mr->flags & MEAS_REP_F_BA1)
886 DEBUGPC(DMEAS, "BA1 ");
887 if (!(mr->flags & MEAS_REP_F_DL_VALID))
888 DEBUGPC(DMEAS, "NOT VALID ");
889 else
890 print_meas_rep_uni(&mr->dl, "dl");
891
892 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100893 if (mr->num_cell == 7)
894 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100895 for (i = 0; i < mr->num_cell; i++) {
896 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100897 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
898 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100899 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100900}
901
Harald Welte440fed02009-05-01 18:43:47 +0000902static int rsl_rx_meas_res(struct msgb *msg)
903{
904 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
905 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100906 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100907 u_int8_t len;
908 const u_int8_t *val;
909 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000910
Harald Welteb8bfc562009-12-21 13:27:11 +0100911 /* check if this channel is actually active */
912 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100913 if (msg->lchan->state != LCHAN_S_ACTIVE) {
914 LOGP(DRSL, LOGL_NOTICE, "%s: MEAS RES for inactive channel\n",
915 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100916 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100917 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100918
Harald Welted12b0fd2009-12-15 21:36:05 +0100919 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100920 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100921
Harald Welte440fed02009-05-01 18:43:47 +0000922 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
923
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100924 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
925 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
926 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
927 return -EIO;
928
929 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100930 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100931
932 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
933 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
934 if (len >= 3) {
935 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100936 mr->flags |= MEAS_REP_F_DL_DTX;
937 mr->ul.full.rx_lev = val[0] & 0x3f;
938 mr->ul.sub.rx_lev = val[1] & 0x3f;
939 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
940 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000941 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100942
Harald Welted12b0fd2009-12-15 21:36:05 +0100943 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100944
945 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000946 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100947 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100948 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
949
Harald Weltefe9af262009-06-20 18:44:35 +0200950 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100951 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100952 mr->flags |= MEAS_REP_F_MS_L1;
953 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100954 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100955 mr->flags |= MEAS_REP_F_FPC;
956 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200957 }
Harald Weltef7c43522009-06-09 20:24:21 +0000958 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherddd918f2009-10-22 15:43:55 +0200959 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100960 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100961 if (rc < 0)
962 return rc;
963 }
964
Harald Welted12b0fd2009-12-15 21:36:05 +0100965 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +0000966
Harald Welted12b0fd2009-12-15 21:36:05 +0100967 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +0100968
Harald Welte75d34a82009-05-23 06:11:13 +0000969 return 0;
Harald Welte440fed02009-05-01 18:43:47 +0000970}
971
Harald Welted011e8b2009-11-29 22:45:52 +0100972/* Chapter 8.4.7 */
973static int rsl_rx_hando_det(struct msgb *msg)
974{
975 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
976 struct tlv_parsed tp;
977
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100978 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +0100979
980 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
981
982 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
983 DEBUGPC(DRSL, "access delay = %u\n",
984 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
985 else
986 DEBUGPC(DRSL, "\n");
987
988 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
989
990 return 0;
991}
992
Harald Welte52b1f982008-12-23 20:25:15 +0000993static int abis_rsl_rx_dchan(struct msgb *msg)
994{
Harald Welte8470bf22008-12-25 23:28:35 +0000995 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
996 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +0000997 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +0000998
Harald Welte8470bf22008-12-25 23:28:35 +0000999 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001000 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001001
Harald Welte8470bf22008-12-25 23:28:35 +00001002 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001003 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001004 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001005 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001006 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001007 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001008 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001009 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001010 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001011 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001012 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001013 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001014 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001015 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001016 case RSL_MT_HANDO_DET:
1017 rc = rsl_rx_hando_det(msg);
1018 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001019 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001020 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001021 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welte1887f9d2009-12-29 10:52:38 +01001022 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1023 gsm_lchan_name(msg->lchan),
1024 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001025 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001026 /* we have an error timer pending to release that */
1027 if (msg->lchan->state != LCHAN_S_REL_ERR)
1028 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte2d5b6382008-12-27 19:46:06 +00001029 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001030 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001031 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001032 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001033 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001034 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001035 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001036 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001037 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001038 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001039 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001040 break;
1041 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001042 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001043 break;
1044 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001045 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001046 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001047 break;
1048 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001049 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001050 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001051 case RSL_MT_PHY_CONTEXT_CONF:
1052 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001053 case RSL_MT_TALKER_DET:
1054 case RSL_MT_LISTENER_DET:
1055 case RSL_MT_REMOTE_CODEC_CONF_REP:
1056 case RSL_MT_MR_CODEC_MOD_ACK:
1057 case RSL_MT_MR_CODEC_MOD_NACK:
1058 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001059 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1060 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001061 break;
1062 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001063 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1064 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001065 return -EINVAL;
1066 }
Harald Weltef325eb42009-02-19 17:07:39 +00001067
Harald Welte8470bf22008-12-25 23:28:35 +00001068 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001069}
1070
Harald Welte702d8702008-12-26 20:25:35 +00001071static int rsl_rx_error_rep(struct msgb *msg)
1072{
1073 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001074 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001075
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001076 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001077
1078 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1079
1080 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001081 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001082 TLVP_LEN(&tp, RSL_IE_CAUSE));
1083
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001084 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001085
1086 return 0;
1087}
1088
Harald Welte52b1f982008-12-23 20:25:15 +00001089static int abis_rsl_rx_trx(struct msgb *msg)
1090{
Harald Welte702d8702008-12-26 20:25:35 +00001091 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001092 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001093
1094 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001095 case RSL_MT_ERROR_REPORT:
1096 rc = rsl_rx_error_rep(msg);
1097 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001098 case RSL_MT_RF_RES_IND:
1099 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001100 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001101 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001102 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001103 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001104 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1105 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001106 break;
1107 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001108 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1109 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001110 return -EINVAL;
1111 }
Harald Welte8470bf22008-12-25 23:28:35 +00001112 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001113}
1114
Harald Welteb7e81162009-08-10 00:26:10 +02001115/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1116static void t3101_expired(void *data)
1117{
1118 struct gsm_lchan *lchan = data;
1119
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001120 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001121}
1122
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001123/* If T3111 expires, we will send the RF Channel Request */
1124static void t3111_expired(void *data)
1125{
1126 struct gsm_lchan *lchan = data;
1127
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001128 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001129}
1130
Harald Welte8470bf22008-12-25 23:28:35 +00001131/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001132static int rsl_rx_chan_rqd(struct msgb *msg)
1133{
Harald Welte702d8702008-12-26 20:25:35 +00001134 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001135 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1136 struct gsm48_req_ref *rqd_ref;
Harald Welte52b1f982008-12-23 20:25:15 +00001137 struct gsm48_imm_ass ia;
Harald Welte8470bf22008-12-25 23:28:35 +00001138 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001139 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001140 struct gsm_lchan *lchan;
1141 u_int8_t rqd_ta;
Holger Freyther3186bf22008-12-29 06:23:49 +00001142 int ret;
Harald Welte8470bf22008-12-25 23:28:35 +00001143
Harald Welte52b1f982008-12-23 20:25:15 +00001144 u_int16_t arfcn;
1145 u_int8_t ts_number, subch;
1146
Harald Welte8470bf22008-12-25 23:28:35 +00001147 /* parse request reference to be used in immediate assign */
1148 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1149 return -EINVAL;
1150
1151 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1152
1153 /* parse access delay and use as TA */
1154 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1155 return -EINVAL;
1156 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1157
1158 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1159 * request reference RA */
Holger Hans Peter Freytherf7d752f2009-11-16 17:12:38 +01001160 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1161 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001162
Harald Welteffa55a42009-12-22 19:07:32 +01001163 counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001164
Harald Welte8470bf22008-12-25 23:28:35 +00001165 /* check availability / allocate channel */
1166 lchan = lchan_alloc(bts, lctype);
1167 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001168 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001169 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Welteffa55a42009-12-22 19:07:32 +01001170 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte8470bf22008-12-25 23:28:35 +00001171 /* FIXME: send some kind of reject ?!? */
1172 return -ENOMEM;
1173 }
1174
Harald Welte8e93b792009-12-29 10:44:17 +01001175 if (lchan->state != LCHAN_S_NONE)
1176 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001177 "in state %s\n", gsm_lchan_name(lchan),
1178 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001179 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001180
Harald Welte8470bf22008-12-25 23:28:35 +00001181 ts_number = lchan->ts->nr;
1182 arfcn = lchan->ts->trx->arfcn;
1183 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001184
Harald Welte08d91a52009-08-30 15:37:11 +09001185 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001186 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001187 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001188 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001189 lchan->tch_mode = GSM48_CMODE_SIGN;
Harald Welte8d77b952009-12-17 00:31:10 +01001190 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001191
1192 /* create IMMEDIATE ASSIGN 04.08 messge */
1193 memset(&ia, 0, sizeof(ia));
1194 ia.l2_plen = 0x2d;
1195 ia.proto_discr = GSM48_PDISC_RR;
1196 ia.msg_type = GSM48_MT_RR_IMM_ASS;
Harald Welte2d5b6382008-12-27 19:46:06 +00001197 ia.page_mode = GSM48_PM_SAME;
Harald Weltea39b0f22010-06-14 22:26:10 +02001198 gsm48_lchan2chan_desc(&ia.chan_desc, lchan);
1199
Harald Welte8470bf22008-12-25 23:28:35 +00001200 /* use request reference extracted from CHAN_RQD */
1201 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
1202 ia.timing_advance = rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001203 if (!lchan->ts->hopping.enabled) {
1204 ia.mob_alloc_len = 0;
1205 } else {
Harald Welte29aca172010-06-15 16:45:51 +02001206 uint8_t *ma;
1207 ia.mob_alloc_len = lchan->ts->hopping.ma_len;
1208 ma = msgb_put(msg, ia.mob_alloc_len);
1209 memcpy(ma, lchan->ts->hopping.ma_data, ia.mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001210 }
Harald Welte52b1f982008-12-23 20:25:15 +00001211
Harald Welte5b8ed432009-12-24 12:20:20 +01001212 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001213 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001214 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
Harald Welte4a543e82009-02-28 13:17:55 +00001215 rqd_ref->ra);
Harald Welte75a983f2008-12-27 21:34:06 +00001216
Harald Welteb7e81162009-08-10 00:26:10 +02001217 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1218 lchan->T3101.cb = t3101_expired;
1219 lchan->T3101.data = lchan;
Holger Hans Peter Freytherc4d88ad2009-11-21 21:18:38 +01001220 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001221
Harald Welte52b1f982008-12-23 20:25:15 +00001222 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Freyther3186bf22008-12-29 06:23:49 +00001223 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
1224
Harald Welte817f3c82008-12-30 14:57:59 +00001225 return ret;
Harald Welte52b1f982008-12-23 20:25:15 +00001226}
1227
Harald Welteea280442009-02-02 22:29:56 +00001228/* MS has requested a channel on the RACH */
1229static int rsl_rx_ccch_load(struct msgb *msg)
1230{
1231 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1232 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +00001233 u_int16_t rach_slot_count = -1;
1234 u_int16_t rach_busy_count = -1;
1235 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001236
1237 switch (rslh->data[0]) {
1238 case RSL_IE_PAGING_LOAD:
1239 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001240 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1241 /* paging load below configured threshold, use 50 as default */
1242 pg_buf_space = 50;
1243 }
Holger Freyther392209c2009-02-10 00:06:19 +00001244 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001245 break;
1246 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001247 if (msg->data_len >= 7) {
1248 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1249 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1250 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1251 }
Harald Welteea280442009-02-02 22:29:56 +00001252 break;
1253 default:
1254 break;
1255 }
1256
1257 return 0;
1258}
1259
Harald Welte52b1f982008-12-23 20:25:15 +00001260static int abis_rsl_rx_cchan(struct msgb *msg)
1261{
Harald Welteea280442009-02-02 22:29:56 +00001262 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001263 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001264
Harald Welte8470bf22008-12-25 23:28:35 +00001265 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1266
1267 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001268 case RSL_MT_CHAN_RQD:
1269 /* MS has requested a channel on the RACH */
1270 rc = rsl_rx_chan_rqd(msg);
1271 break;
Harald Welteea280442009-02-02 22:29:56 +00001272 case RSL_MT_CCCH_LOAD_IND:
1273 /* current load on the CCCH */
1274 rc = rsl_rx_ccch_load(msg);
1275 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001276 case RSL_MT_DELETE_IND:
1277 /* CCCH overloaded, IMM_ASSIGN was dropped */
1278 case RSL_MT_CBCH_LOAD_IND:
1279 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001280 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1281 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001282 break;
1283 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001284 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1285 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001286 return -EINVAL;
1287 }
Harald Welte8470bf22008-12-25 23:28:35 +00001288
1289 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001290}
1291
Harald Welte4b634542008-12-27 01:55:51 +00001292static int rsl_rx_rll_err_ind(struct msgb *msg)
1293{
1294 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1295 u_int8_t *rlm_cause = rllh->data;
1296
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001297 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001298 gsm_lchan_name(msg->lchan),
Harald Weltee95daf192010-03-25 12:13:02 +08001299 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001300
1301 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001302
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001303 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1304 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001305 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001306 }
Harald Welte81543bc2009-07-04 09:40:05 +02001307
Harald Welte4b634542008-12-27 01:55:51 +00001308 return 0;
1309}
Harald Weltef325eb42009-02-19 17:07:39 +00001310
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001311static void rsl_handle_release(struct gsm_lchan *lchan)
1312{
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001313 struct gsm_bts *bts;
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001314 if (lchan->state != LCHAN_S_REL_REQ)
1315 LOGP(DRSL, LOGL_ERROR, "RF release on %s but state %s\n",
1316 gsm_lchan_name(lchan),
1317 gsm_lchans_name(lchan->state));
1318
1319
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001320 /* wait a bit to send the RF Channel Release */
1321 lchan->T3111.cb = t3111_expired;
1322 lchan->T3111.data = lchan;
1323 bts = lchan->ts->trx->bts;
1324 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001325}
1326
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001327/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001328 0x02, 0x06,
1329 0x01, 0x20,
1330 0x02, 0x00,
1331 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1332
1333static int abis_rsl_rx_rll(struct msgb *msg)
1334{
1335 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001336 int rc = 0;
1337 char *ts_name;
Harald Welte (local)daef6062009-08-14 11:41:12 +02001338 u_int8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001339
1340 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001341 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001342 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001343
1344 switch (rllh->c.msg_type) {
1345 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001346 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001347 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001348 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1349 rllh->data[0] == RSL_IE_L3_INFO) {
1350 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001351 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001352 }
Harald Welte52b1f982008-12-23 20:25:15 +00001353 break;
1354 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001355 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001356 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001357 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welteb7e81162009-08-10 00:26:10 +02001358 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001359 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001360 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1361 rllh->data[0] == RSL_IE_L3_INFO) {
1362 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001363 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001364 }
Harald Welte52b1f982008-12-23 20:25:15 +00001365 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001366 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001367 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001368 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001369 rll_indication(msg->lchan, rllh->link_id,
1370 BSC_RLLR_IND_EST_CONF);
1371 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001372 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001373 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001374 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001375 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001376 rll_indication(msg->lchan, rllh->link_id,
1377 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001378 rsl_handle_release(msg->lchan);
Harald Welte2d5b6382008-12-27 19:46:06 +00001379 break;
1380 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001381 /* BTS informs us of having received UA from MS,
1382 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001383 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001384 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001385 rsl_handle_release(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +00001386 break;
1387 case RSL_MT_ERROR_IND:
1388 rc = rsl_rx_rll_err_ind(msg);
1389 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001390 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001391 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1392 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001393 break;
1394 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001395 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1396 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001397 }
Harald Welte8470bf22008-12-25 23:28:35 +00001398 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001399}
1400
Harald Welte0603c9d2009-12-02 01:58:23 +05301401static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001402{
Harald Welte0603c9d2009-12-02 01:58:23 +05301403 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001404 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301405 switch (lchan->type) {
1406 case GSM_LCHAN_TCH_F:
1407 return 0x00;
1408 case GSM_LCHAN_TCH_H:
1409 return 0x03;
1410 default:
1411 break;
1412 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001413 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301414 switch (lchan->type) {
1415 case GSM_LCHAN_TCH_F:
1416 return 0x01;
1417 /* there's no half-rate EFR */
1418 default:
1419 break;
1420 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001421 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301422 switch (lchan->type) {
1423 case GSM_LCHAN_TCH_F:
1424 return 0x02;
1425 case GSM_LCHAN_TCH_H:
1426 return 0x05;
1427 default:
1428 break;
1429 }
1430 default:
1431 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001432 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001433 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301434 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001435 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001436}
1437
Sylvain Munautb54dda42009-12-20 22:06:40 +01001438static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1439{
1440 switch (lchan->tch_mode) {
1441 case GSM48_CMODE_SPEECH_V1:
1442 switch (lchan->type) {
1443 case GSM_LCHAN_TCH_F:
1444 return RTP_PT_GSM_FULL;
1445 case GSM_LCHAN_TCH_H:
1446 return RTP_PT_GSM_HALF;
1447 default:
1448 break;
1449 }
1450 case GSM48_CMODE_SPEECH_EFR:
1451 switch (lchan->type) {
1452 case GSM_LCHAN_TCH_F:
1453 return RTP_PT_GSM_EFR;
1454 /* there's no half-rate EFR */
1455 default:
1456 break;
1457 }
1458 case GSM48_CMODE_SPEECH_AMR:
1459 switch (lchan->type) {
1460 case GSM_LCHAN_TCH_F:
1461 return RTP_PT_AMR_FULL;
1462 case GSM_LCHAN_TCH_H:
1463 return RTP_PT_AMR_HALF;
1464 default:
1465 break;
1466 }
1467 default:
1468 break;
1469 }
1470 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1471 "tch_mode == 0x%02x\n & lchan_type == %d",
1472 lchan->tch_mode, lchan->type);
1473 return 0;
1474}
1475
Harald Welte75099262009-02-16 21:12:08 +00001476/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001477static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1478{
1479 struct in_addr ip;
1480 u_int16_t port, conn_id;
1481
1482 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1483 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1484 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1485 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1486 }
1487
1488 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1489 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1490 port = ntohs(port);
1491 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1492 lchan->abis_ip.bound_port = port;
1493 }
1494
1495 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1496 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1497 conn_id = ntohs(conn_id);
1498 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1499 lchan->abis_ip.conn_id = conn_id;
1500 }
1501
1502 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1503 lchan->abis_ip.rtp_payload2 =
1504 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1505 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1506 lchan->abis_ip.rtp_payload2);
1507 }
1508
1509 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1510 lchan->abis_ip.speech_mode =
1511 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1512 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1513 lchan->abis_ip.speech_mode);
1514 }
1515
1516 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1517 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1518 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1519 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1520 }
1521
1522 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1523 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1524 port = ntohs(port);
1525 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1526 lchan->abis_ip.connect_port = port;
1527 }
1528}
1529
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001530int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001531{
1532 struct msgb *msg = rsl_msgb_alloc();
1533 struct abis_rsl_dchan_hdr *dh;
1534
1535 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001536 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001537 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1538 dh->chan_nr = lchan2chan_nr(lchan);
1539
Harald Weltef4e79f22009-07-28 18:11:56 +02001540 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001541 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001542 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001543 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001544 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001545
Sylvain Munautb54dda42009-12-20 22:06:40 +01001546 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1547 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1548 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001549
Harald Welte75099262009-02-16 21:12:08 +00001550 msg->trx = lchan->ts->trx;
1551
1552 return abis_rsl_sendmsg(msg);
1553}
1554
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001555int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte5e3d91b2009-12-19 16:42:06 +01001556 u_int8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001557{
1558 struct msgb *msg = rsl_msgb_alloc();
1559 struct abis_rsl_dchan_hdr *dh;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001560 u_int32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001561 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001562
1563 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001564 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001565 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1566 dh->chan_nr = lchan2chan_nr(lchan);
1567
Harald Welte5e3d91b2009-12-19 16:42:06 +01001568 /* we need to store these now as MDCX_ACK does not return them :( */
1569 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1570 lchan->abis_ip.connect_port = port;
1571 lchan->abis_ip.connect_ip = ip;
1572
Harald Welte58ca5b72009-07-29 12:12:18 +02001573 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001574 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001575 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001576
Harald Weltef4e79f22009-07-28 18:11:56 +02001577 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001578 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1579 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1580 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1581 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001582
Harald Welte5e3d91b2009-12-19 16:42:06 +01001583 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1584 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1585 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1586 *att_ip = ia.s_addr;
1587 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1588 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001589 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001590 if (rtp_payload2)
1591 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1592
Harald Welte75099262009-02-16 21:12:08 +00001593 msg->trx = lchan->ts->trx;
1594
1595 return abis_rsl_sendmsg(msg);
1596}
1597
Harald Weltea72273e2009-12-20 16:51:09 +01001598/* tell BTS to connect RTP stream to our local RTP socket */
1599int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1600{
1601 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1602 int rc;
1603
1604 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1605 ntohs(rs->rtp.sin_local.sin_port),
1606 /* FIXME: use RTP payload of bound socket, not BTS*/
1607 lchan->abis_ip.rtp_payload2);
1608
1609 return rc;
1610}
1611
Harald Welte4563eab2010-03-28 14:42:09 +08001612int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001613{
1614 struct msgb *msg = rsl_msgb_alloc();
1615 struct abis_rsl_dchan_hdr *dh;
Harald Welte4563eab2010-03-28 14:42:09 +08001616 u_int8_t msg_type;
1617
1618 if (act)
1619 msg_type = RSL_MT_IPAC_PDCH_ACT;
1620 else
1621 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001622
1623 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001624 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001625 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1626 dh->chan_nr = lchan2chan_nr(lchan);
1627
Harald Welte4563eab2010-03-28 14:42:09 +08001628 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_lchan_name(lchan),
1629 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001630
1631 msg->trx = lchan->ts->trx;
1632
1633 return abis_rsl_sendmsg(msg);
1634}
1635
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001636static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001637{
1638 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1639 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301640 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001641
1642 /* the BTS has acknowledged a local bind, it now tells us the IP
1643 * address and port number to which it has bound the given logical
1644 * channel */
1645
1646 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1647 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1648 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001649 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001650 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001651 return -EINVAL;
1652 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001653
Harald Welte5e3d91b2009-12-19 16:42:06 +01001654 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001655
1656 /* in case we don't use direct BTS-to-BTS RTP */
1657 if (!ipacc_rtp_direct) {
1658 int rc;
1659 /* the BTS has successfully bound a TCH to a local ip/port,
1660 * which means we can connect our UDP socket to it */
1661 if (lchan->abis_ip.rtp_socket) {
1662 rtp_socket_free(lchan->abis_ip.rtp_socket);
1663 lchan->abis_ip.rtp_socket = NULL;
1664 }
1665
1666 lchan->abis_ip.rtp_socket = rtp_socket_create();
1667 if (!lchan->abis_ip.rtp_socket)
1668 goto out_err;
1669
1670 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1671 lchan->abis_ip.bound_ip,
1672 lchan->abis_ip.bound_port);
1673 if (rc < 0)
1674 goto out_err;
1675 }
1676
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001677 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001678
Harald Welte75099262009-02-16 21:12:08 +00001679 return 0;
Harald Welte17f5bf62009-12-20 15:42:44 +01001680out_err:
1681 return -EIO;
Harald Welte75099262009-02-16 21:12:08 +00001682}
1683
Harald Welte5e3d91b2009-12-19 16:42:06 +01001684static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1685{
1686 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1687 struct tlv_parsed tv;
1688 struct gsm_lchan *lchan = msg->lchan;
1689
1690 /* the BTS has acknowledged a remote connect request and
1691 * it now tells us the IP address and port number to which it has
1692 * connected the given logical channel */
1693
1694 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1695 ipac_parse_rtp(lchan, &tv);
1696 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1697
1698 return 0;
1699}
1700
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001701static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001702{
1703 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1704 struct tlv_parsed tv;
Harald Welte17f5bf62009-12-20 15:42:44 +01001705 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001706
1707 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001708
Harald Welte8830e072009-07-28 17:58:09 +02001709 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001710 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001711 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001712
Harald Welte17f5bf62009-12-20 15:42:44 +01001713 /* the BTS tells us a RTP stream has been disconnected */
1714 if (lchan->abis_ip.rtp_socket) {
1715 rtp_socket_free(lchan->abis_ip.rtp_socket);
1716 lchan->abis_ip.rtp_socket = NULL;
1717 }
1718
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001719 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001720
Harald Welte75099262009-02-16 21:12:08 +00001721 return 0;
1722}
1723
1724static int abis_rsl_rx_ipacc(struct msgb *msg)
1725{
1726 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001727 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001728 int rc = 0;
1729
1730 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001731 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001732
1733 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001734 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001735 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001736 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001737 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001738 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001739 /* somehow the BTS was unable to bind the lchan to its local
1740 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001741 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001742 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001743 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001744 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001745 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001746 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001747 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001748 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001749 /* somehow the BTS was unable to connect the lchan to a remote
1750 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001751 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001752 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001753 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001754 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001755 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001756 break;
1757 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001758 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001759 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001760 break;
1761 }
Harald Welte6dab0552009-05-01 17:21:37 +00001762 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001763
1764 return rc;
1765}
1766
1767
Harald Welte52b1f982008-12-23 20:25:15 +00001768/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001769int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001770{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001771 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001772 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001773
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001774 if (!msg) {
1775 DEBUGP(DRSL, "Empty RSL msg?..\n");
1776 return -1;
1777 }
1778
1779 if (msgb_l2len(msg) < sizeof(*rslh)) {
1780 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1781 return -1;
1782 }
1783
1784 rslh = msgb_l2(msg);
1785
Harald Welte52b1f982008-12-23 20:25:15 +00001786 switch (rslh->msg_discr & 0xfe) {
1787 case ABIS_RSL_MDISC_RLL:
1788 rc = abis_rsl_rx_rll(msg);
1789 break;
1790 case ABIS_RSL_MDISC_DED_CHAN:
1791 rc = abis_rsl_rx_dchan(msg);
1792 break;
1793 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001794 rc = abis_rsl_rx_cchan(msg);
1795 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001796 case ABIS_RSL_MDISC_TRX:
1797 rc = abis_rsl_rx_trx(msg);
1798 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001799 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001800 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001801 rslh->msg_discr);
1802 break;
Harald Welte75099262009-02-16 21:12:08 +00001803 case ABIS_RSL_MDISC_IPACCESS:
1804 rc = abis_rsl_rx_ipacc(msg);
1805 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001806 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001807 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1808 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001809 return -EINVAL;
1810 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001811 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001812 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001813}
Holger Freyther3b72a892009-02-04 00:31:39 +00001814
Holger Freyther3b72a892009-02-04 00:31:39 +00001815/* From Table 10.5.33 of GSM 04.08 */
1816int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1817{
Harald Weltea43f7892009-12-01 18:04:30 +05301818 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1819 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1820 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001821 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301822 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1823 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001824 }
1825}