blob: 5093d793f6b600992ea4f231190f44be993d5acb [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
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080045#include <osmocore/talloc.h>
46
Harald Welte8470bf22008-12-25 23:28:35 +000047#define RSL_ALLOC_SIZE 1024
48#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000049
Holger Freyther3b72a892009-02-04 00:31:39 +000050#define MAX(a, b) (a) >= (b) ? (a) : (b)
51
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080052static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
53
Harald Welte52b1f982008-12-23 20:25:15 +000054static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
55{
56 /* mask off the transparent bit ? */
57 msg_type &= 0xfe;
58
Harald Welte8470bf22008-12-25 23:28:35 +000059 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000060 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000061 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000062 if (msg_type >= 0x19 && msg_type <= 0x22)
63 return ABIS_RSL_MDISC_TRX;
64 else
65 return ABIS_RSL_MDISC_COM_CHAN;
66 }
Harald Welte2d5b6382008-12-27 19:46:06 +000067 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000068 return ABIS_RSL_MDISC_DED_CHAN;
69
70 return ABIS_RSL_MDISC_LOC;
71}
72
73static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
74 u_int8_t msg_type)
75{
76 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
77 dh->c.msg_type = msg_type;
78 dh->ie_chan = RSL_IE_CHAN_NR;
79}
80
Harald Welte8470bf22008-12-25 23:28:35 +000081/* determine logical channel based on TRX and channel number IE */
82struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
83{
84 struct gsm_lchan *lchan;
85 u_int8_t ts_nr = chan_nr & 0x07;
86 u_int8_t cbits = chan_nr >> 3;
87 u_int8_t lch_idx;
88 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
89
90 if (cbits == 0x01) {
91 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020092 if (ts->pchan != GSM_PCHAN_TCH_F &&
93 ts->pchan != GSM_PCHAN_PDCH &&
94 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +010095 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +000096 chan_nr, ts->pchan);
97 } else if ((cbits & 0x1e) == 0x02) {
98 lch_idx = cbits & 0x1; /* TCH/H */
99 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000101 chan_nr, ts->pchan);
102 } else if ((cbits & 0x1c) == 0x04) {
103 lch_idx = cbits & 0x3; /* SDCCH/4 */
104 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000106 chan_nr, ts->pchan);
107 } else if ((cbits & 0x18) == 0x08) {
108 lch_idx = cbits & 0x7; /* SDCCH/8 */
109 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000111 chan_nr, ts->pchan);
112 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
113 lch_idx = 0;
114 if (ts->pchan != GSM_PCHAN_CCCH &&
115 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100116 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000117 chan_nr, ts->pchan);
118 /* FIXME: we should not return first sdcch4 !!! */
119 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100120 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000121 return NULL;
122 }
123
124 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800125 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800126 if (lchan->conn)
127 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000128
129 return lchan;
130}
131
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200132/* See Table 10.5.25 of GSM04.08 */
Harald Welte24766092009-12-09 19:18:32 +0100133u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte8470bf22008-12-25 23:28:35 +0000134{
135 struct gsm_bts_trx_ts *ts = lchan->ts;
136 u_int8_t cbits, chan_nr;
137
138 switch (ts->pchan) {
139 case GSM_PCHAN_TCH_F:
Harald Weltea1499d02009-10-24 10:25:50 +0200140 case GSM_PCHAN_PDCH:
141 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000142 cbits = 0x01;
143 break;
144 case GSM_PCHAN_TCH_H:
145 cbits = 0x02;
146 cbits += lchan->nr;
147 break;
148 case GSM_PCHAN_CCCH_SDCCH4:
149 cbits = 0x04;
150 cbits += lchan->nr;
151 break;
152 case GSM_PCHAN_SDCCH8_SACCH8C:
153 cbits = 0x08;
154 cbits += lchan->nr;
155 break;
156 default:
157 case GSM_PCHAN_CCCH:
158 cbits = 0x10;
159 break;
160 }
161
162 chan_nr = (cbits << 3) | (ts->nr & 0x7);
163
164 return chan_nr;
165}
166
Harald Welte52b1f982008-12-23 20:25:15 +0000167/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
168u_int64_t str_to_imsi(const char *imsi_str)
169{
170 u_int64_t ret;
171
172 ret = strtoull(imsi_str, NULL, 10);
173
174 return ret;
175}
176
177/* Table 5 Clause 7 TS 05.02 */
178unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
179{
180 if (!bs_ccch_sdcch_comb)
181 return 9 - bs_ag_blks_res;
182 else
183 return 3 - bs_ag_blks_res;
184}
185
186/* Chapter 6.5.2 of TS 05.02 */
187unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
188 unsigned int n_pag_blocks)
189{
190 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
191}
192
193/* Chapter 6.5.2 of TS 05.02 */
194unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
195 int n_pag_blocks)
196{
197 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
198}
199
Harald Welte8470bf22008-12-25 23:28:35 +0000200static struct msgb *rsl_msgb_alloc(void)
201{
Harald Welte966636f2009-06-26 19:39:35 +0200202 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
203 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000204}
205
Harald Welte362322e2009-02-15 14:36:38 +0000206#define MACBLOCK_SIZE 23
207static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
208{
209 memcpy(out, in, len);
210
211 if (len < MACBLOCK_SIZE)
212 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
213}
214
Harald Welte08d91a52009-08-30 15:37:11 +0900215/* Chapter 9.3.7: Encryption Information */
216static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
217{
218 *out++ = lchan->encr.alg_id & 0xff;
219 if (lchan->encr.key_len)
220 memcpy(out, lchan->encr.key, lchan->encr.key_len);
221 return lchan->encr.key_len + 1;
222}
223
Harald Welte5b8ed432009-12-24 12:20:20 +0100224static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200225{
Harald Welte7f93cea2009-02-23 00:02:59 +0000226 int i;
227
Harald Welte5b8ed432009-12-24 12:20:20 +0100228 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200229 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200230 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100231 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000232}
233
Harald Welte52b1f982008-12-23 20:25:15 +0000234/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000235int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000236 const u_int8_t *data, int len)
237{
238 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000239 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000240
241 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
242 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
243 dh->chan_nr = RSL_CHAN_BCCH;
244
245 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
246 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
247
Harald Weltee79769b2009-02-07 00:48:17 +0000248 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000249
250 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000251}
252
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200253int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000254 const u_int8_t *data, int len)
255{
256 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000257 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000258
259 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
260 ch->msg_discr = ABIS_RSL_MDISC_TRX;
261 ch->msg_type = RSL_MT_SACCH_FILL;
262
263 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000264 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000265
Harald Weltee79769b2009-02-07 00:48:17 +0000266 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000267
268 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000269}
270
Harald Weltefcd24452009-06-20 18:15:19 +0200271int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
272{
273 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200274 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200275 u_int8_t chan_nr = lchan2chan_nr(lchan);
276
277 db = abs(db);
278 if (db > 30)
279 return -EINVAL;
280
Harald Welteeab33352009-06-27 03:09:08 +0200281 msg = rsl_msgb_alloc();
282
Harald Weltefcd24452009-06-20 18:15:19 +0200283 lchan->bs_power = db/2;
284 if (fpc)
285 lchan->bs_power |= 0x10;
286
287 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
288 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
289 dh->chan_nr = chan_nr;
290
291 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
292
293 msg->trx = lchan->ts->trx;
294
295 return abis_rsl_sendmsg(msg);
296}
297
Harald Weltefcd24452009-06-20 18:15:19 +0200298int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
299{
300 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200301 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200302 u_int8_t chan_nr = lchan2chan_nr(lchan);
303 int ctl_lvl;
304
Harald Welte66b6a8d2009-08-09 14:45:18 +0200305 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200306 if (ctl_lvl < 0)
307 return ctl_lvl;
308
Harald Welteeab33352009-06-27 03:09:08 +0200309 msg = rsl_msgb_alloc();
310
Harald Weltefcd24452009-06-20 18:15:19 +0200311 lchan->ms_power = ctl_lvl;
312
313 if (fpc)
314 lchan->ms_power |= 0x20;
315
316 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
317 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
318 dh->chan_nr = chan_nr;
319
320 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
321
322 msg->trx = lchan->ts->trx;
323
324 return abis_rsl_sendmsg(msg);
325}
326
Harald Welte9943c5b2009-07-29 15:41:29 +0200327static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
328 struct gsm_lchan *lchan)
329{
330 memset(cm, 0, sizeof(cm));
331
332 /* FIXME: what to do with data calls ? */
333 cm->dtx_dtu = 0x00;
334
335 /* set TCH Speech/Data */
336 cm->spd_ind = lchan->rsl_cmode;
337
Harald Welte1a79d362009-11-27 08:55:16 +0100338 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
339 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100340 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100341 "but tch_mode != signalling\n");
342
Harald Welte9943c5b2009-07-29 15:41:29 +0200343 switch (lchan->type) {
344 case GSM_LCHAN_SDCCH:
345 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
346 break;
347 case GSM_LCHAN_TCH_F:
348 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
349 break;
350 case GSM_LCHAN_TCH_H:
351 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
352 break;
353 case GSM_LCHAN_NONE:
354 case GSM_LCHAN_UNKNOWN:
355 default:
356 return -EINVAL;
357 }
358
359 switch (lchan->tch_mode) {
360 case GSM48_CMODE_SIGN:
361 cm->chan_rate = 0;
362 break;
363 case GSM48_CMODE_SPEECH_V1:
364 cm->chan_rate = RSL_CMOD_SP_GSM1;
365 break;
366 case GSM48_CMODE_SPEECH_EFR:
367 cm->chan_rate = RSL_CMOD_SP_GSM2;
368 break;
369 case GSM48_CMODE_SPEECH_AMR:
370 cm->chan_rate = RSL_CMOD_SP_GSM3;
371 break;
372 case GSM48_CMODE_DATA_14k5:
373 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
374 break;
375 case GSM48_CMODE_DATA_12k0:
376 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
377 break;
378 case GSM48_CMODE_DATA_6k0:
379 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
380 break;
381 default:
382 return -EINVAL;
383 }
384
385 return 0;
386}
387
Harald Welte52b1f982008-12-23 20:25:15 +0000388/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000389#if 0
Harald Weltee79769b2009-02-07 00:48:17 +0000390int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000391 u_int8_t act_type,
392 struct rsl_ie_chan_mode *chan_mode,
393 struct rsl_ie_chan_ident *chan_ident,
394 u_int8_t bs_power, u_int8_t ms_power,
395 u_int8_t ta)
396{
397 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000398 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000399
400 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
401 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
402 dh->chan_nr = chan_nr;
403
404 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
405 /* For compatibility with Phase 1 */
406 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
407 (u_int8_t *) chan_mode);
408 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Harald Welte702d8702008-12-26 20:25:35 +0000409 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000410#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000411 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
412 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000413#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000414 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000415 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
416 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
417
Harald Weltee79769b2009-02-07 00:48:17 +0000418 msg->trx = trx;
419
Harald Welte8470bf22008-12-25 23:28:35 +0000420 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000421}
Harald Welteddab3c72009-02-28 13:19:15 +0000422#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000423
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200424int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte8d77b952009-12-17 00:31:10 +0100425 u_int8_t ta, u_int8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000426{
427 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200428 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200429 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200430 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000431
432 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000433 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200434 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000435
Harald Welte9943c5b2009-07-29 15:41:29 +0200436 rc = channel_mode_from_lchan(&cm, lchan);
437 if (rc < 0)
438 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000439
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800440 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200441 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000442
Harald Welteeab33352009-06-27 03:09:08 +0200443 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000444 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
445 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
446 dh->chan_nr = chan_nr;
447
448 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000449 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
450 (u_int8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800451
452 /*
453 * The Channel Identification is needed for Phase1 phones
454 * and it contains the GSM48 Channel Description and the
455 * Mobile Allocation. The GSM 08.58 asks for the Mobile
456 * Allocation to have a length of zero. We are using the
457 * msgb_l3len to calculate the length of both messages.
458 */
laforge694a5cf2010-06-20 21:38:19 +0200459 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200460 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800461 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800462
463 if (lchan->ts->hopping.enabled)
464 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
465 lchan->ts->hopping.ma_data);
466 else
467 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800468
469 /* update the calculated size */
470 msg->l3h = len + 1;
471 *len = msgb_l3len(msg);
472
Harald Welte08d91a52009-08-30 15:37:11 +0900473 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
474 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
475 rc = build_encr_info(encr_info, lchan);
476 if (rc > 0)
477 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
478 }
479
Harald Welte8d77b952009-12-17 00:31:10 +0100480 switch (act_type) {
481 case RSL_ACT_INTER_ASYNC:
482 case RSL_ACT_INTER_SYNC:
483 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
484 break;
485 default:
486 break;
487 }
488
Harald Welted4c9bf32009-02-15 16:56:18 +0000489 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
490 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000491 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
492
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100493 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
494 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
495 (u_int8_t *) &lchan->mr_conf);
496
Harald Weltee79769b2009-02-07 00:48:17 +0000497 msg->trx = lchan->ts->trx;
498
Harald Welte4b634542008-12-27 01:55:51 +0000499 return abis_rsl_sendmsg(msg);
500}
501
Harald Welte470abb72009-07-29 11:38:15 +0200502/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000503int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
504{
505 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200506 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200507 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000508
509 u_int8_t chan_nr = lchan2chan_nr(lchan);
510 struct rsl_ie_chan_mode cm;
511
Harald Welte9943c5b2009-07-29 15:41:29 +0200512 rc = channel_mode_from_lchan(&cm, lchan);
513 if (rc < 0)
514 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000515
Harald Welteeab33352009-06-27 03:09:08 +0200516 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000517 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
518 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
519 dh->chan_nr = chan_nr;
520
521 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
522 (u_int8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900523
524 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
525 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
526 rc = build_encr_info(encr_info, lchan);
527 if (rc > 0)
528 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
529 }
530
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100531 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
532 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
533 (u_int8_t *) &lchan->mr_conf);
534 }
535
Harald Welte08d91a52009-08-30 15:37:11 +0900536 msg->trx = lchan->ts->trx;
537
538 return abis_rsl_sendmsg(msg);
539}
540
541/* Chapter 8.4.6: Send the encryption command with given L3 info */
542int rsl_encryption_cmd(struct msgb *msg)
543{
544 struct abis_rsl_dchan_hdr *dh;
545 struct gsm_lchan *lchan = msg->lchan;
546 u_int8_t chan_nr = lchan2chan_nr(lchan);
547 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut82aa6842009-09-27 11:13:18 +0200548 u_int8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900549 int rc;
550
551 /* First push the L3 IE tag and length */
552 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
553
554 /* then the link identifier (SAPI0, main sign link) */
555 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
556
557 /* then encryption information */
558 rc = build_encr_info(encr_info, lchan);
559 if (rc <= 0)
560 return rc;
561 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
562
563 /* and finally the DCHAN header */
564 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
565 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
566 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000567
568 msg->trx = lchan->ts->trx;
569
570 return abis_rsl_sendmsg(msg);
571}
572
Harald Welte115d1032009-08-10 11:43:22 +0200573/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200574int rsl_deact_sacch(struct gsm_lchan *lchan)
575{
576 struct abis_rsl_dchan_hdr *dh;
577 struct msgb *msg = rsl_msgb_alloc();
578
579 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
580 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
581 dh->chan_nr = lchan2chan_nr(lchan);
582
583 msg->lchan = lchan;
584 msg->trx = lchan->ts->trx;
585
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100586 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200587
588 return abis_rsl_sendmsg(msg);
589}
590
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800591static void error_timeout_cb(void *data)
592{
593 struct gsm_lchan *lchan = data;
594 if (lchan->state != LCHAN_S_REL_ERR) {
595 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
596 gsm_lchan_name(lchan), lchan->state);
597 return;
598 }
599
600 /* go back to the none state */
601 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800602 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800603}
604
Harald Welte115d1032009-08-10 11:43:22 +0200605/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800606static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000607{
608 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800609 struct msgb *msg;
Harald Welte52b1f982008-12-23 20:25:15 +0000610
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800611 if (lchan->state == LCHAN_S_REL_ERR) {
612 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
613 gsm_lchan_name(lchan));
614 return -1;
615 }
616
617 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000618 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
619 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000620 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000621
Harald Welte8470bf22008-12-25 23:28:35 +0000622 msg->lchan = lchan;
623 msg->trx = lchan->ts->trx;
624
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800625 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
626
627 if (error) {
628 /*
629 * the nanoBTS sends RLL release indications after the channel release. This can
630 * be a problem when we have reassigned the channel to someone else and then can
631 * not figure out who used this channel.
632 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800633 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800634 lchan->error_timer.data = lchan;
635 lchan->error_timer.cb = error_timeout_cb;
636 bsc_schedule_timer(&lchan->error_timer,
637 msg->trx->bts->network->T3111 + 2, 0);
638 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000639
Harald Welte115d1032009-08-10 11:43:22 +0200640 /* BTS will respond by RF CHAN REL ACK */
Harald Welte8470bf22008-12-25 23:28:35 +0000641 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000642}
643
644int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
645 u_int8_t *ms_ident, u_int8_t chan_needed)
646{
647 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000648 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000649
650 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
651 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
652 dh->chan_nr = RSL_CHAN_PCH_AGCH;
653
654 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000655 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000656 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
657
Harald Welte8470bf22008-12-25 23:28:35 +0000658 msg->trx = bts->c0;
659
660 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000661}
662
Holger Freyther7448a532009-01-04 20:18:23 +0000663int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
664 struct gsm_subscriber *subscr)
665{
Holger Freytherca362a62009-01-04 21:05:01 +0000666#if 0
Holger Freyther7448a532009-01-04 20:18:23 +0000667 u_int8_t mi[128];
668 unsigned int mi_len;
669 u_int8_t paging_group;
Holger Freytherca362a62009-01-04 21:05:01 +0000670#endif
Holger Freyther7448a532009-01-04 20:18:23 +0000671
672 return -1;
673}
674
Harald Welte52b1f982008-12-23 20:25:15 +0000675int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
676{
677 int i, len = strlen(str_in);
678
679 for (i = 0; i < len; i++) {
680 int num = str_in[i] - 0x30;
681 if (num < 0 || num > 9)
682 return -1;
683 if (i % 2 == 0)
684 bcd_out[i/2] = num;
685 else
686 bcd_out[i/2] |= (num << 4);
687 }
688
689 return 0;
690}
691
Harald Welte702d8702008-12-26 20:25:35 +0000692/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000693int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
694{
Harald Welte8470bf22008-12-25 23:28:35 +0000695 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000696 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000697 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000698
699 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
700 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
701 dh->chan_nr = RSL_CHAN_PCH_AGCH;
702
Harald Welte362322e2009-02-15 14:36:38 +0000703 switch (bts->type) {
704 case GSM_BTS_TYPE_BS11:
705 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
706 break;
707 default:
708 /* If phase 2, construct a FULL_IMM_ASS_INFO */
709 pad_macblock(buf, val, len);
710 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
711 break;
712 }
Harald Welte52b1f982008-12-23 20:25:15 +0000713
Harald Welte8470bf22008-12-25 23:28:35 +0000714 msg->trx = bts->c0;
715
716 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000717}
718
Harald Welte67fa91b2009-08-10 09:51:40 +0200719/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200720int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200721{
722 struct msgb *msg = rsl_msgb_alloc();
723 struct abis_rsl_dchan_hdr *dh;
724
725 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
726 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200727 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200728 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte31c48932009-08-10 10:07:33 +0200729 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200730
Harald Welte5b8ed432009-12-24 12:20:20 +0100731 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100732 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200733
734 msg->trx = lchan->ts->trx;
735
Harald Welte67fa91b2009-08-10 09:51:40 +0200736 return abis_rsl_sendmsg(msg);
737}
738
739
Harald Welte8470bf22008-12-25 23:28:35 +0000740/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000741/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000742int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000743{
Harald Welte8470bf22008-12-25 23:28:35 +0000744 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100745 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000746 return -EINVAL;
747 }
Harald Welte52b1f982008-12-23 20:25:15 +0000748
Harald Welte3c9c5f92010-03-04 10:33:10 +0100749 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
750 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000751
Harald Welte8470bf22008-12-25 23:28:35 +0000752 msg->trx = msg->lchan->ts->trx;
753
754 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000755}
756
Harald Welteedcc5272009-08-09 13:47:35 +0200757/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
758/* Chapter 8.3.1 */
759int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
760{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100761 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200762
Harald Welte3c9c5f92010-03-04 10:33:10 +0100763 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
764 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200765 msg->trx = lchan->ts->trx;
766
767 return abis_rsl_sendmsg(msg);
768}
769
Harald Welted2dc1de2009-08-08 13:15:07 +0200770/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
771 This is what higher layers should call. The BTS then responds with
772 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
773 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
774 lchan_free() */
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800775int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200776{
Harald Welted2dc1de2009-08-08 13:15:07 +0200777
Harald Welte3c9c5f92010-03-04 10:33:10 +0100778 struct msgb *msg;
779
780 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
781 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800782 /* 0 is normal release, 1 is local end */
783 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200784
Harald Welte8e93b792009-12-29 10:44:17 +0100785 /* FIXME: start some timer in case we don't receive a REL ACK ? */
786
Harald Welted2dc1de2009-08-08 13:15:07 +0200787 msg->trx = lchan->ts->trx;
788
789 return abis_rsl_sendmsg(msg);
790}
791
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200792int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
793{
794 lchan->state = state;
795 return 0;
796}
797
Harald Welte702d8702008-12-26 20:25:35 +0000798/* Chapter 8.4.2: Channel Activate Acknowledge */
799static int rsl_rx_chan_act_ack(struct msgb *msg)
800{
801 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
802
803 /* BTS has confirmed channel activation, we now need
804 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000805 if (rslh->ie_chan != RSL_IE_CHAN_NR)
806 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100807
Harald Welte8e93b792009-12-29 10:44:17 +0100808 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100809 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
810 gsm_lchan_name(msg->lchan),
811 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200812 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100813
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800814 if (msg->lchan->rqd_ref) {
815 rsl_send_imm_assignment(msg->lchan);
816 talloc_free(msg->lchan->rqd_ref);
817 msg->lchan->rqd_ref = NULL;
818 msg->lchan->rqd_ta = 0;
819 }
820
Harald Welted011e8b2009-11-29 22:45:52 +0100821 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
822
Harald Welte4b634542008-12-27 01:55:51 +0000823 return 0;
824}
Harald Welte702d8702008-12-26 20:25:35 +0000825
Harald Welte4b634542008-12-27 01:55:51 +0000826/* Chapter 8.4.3: Channel Activate NACK */
827static int rsl_rx_chan_act_nack(struct msgb *msg)
828{
Harald Welte6dab0552009-05-01 17:21:37 +0000829 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
830 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000831
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100832 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100833 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100834
Harald Welte6dab0552009-05-01 17:21:37 +0000835 /* BTS has rejected channel activation ?!? */
836 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000837 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000838
839 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100840 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
841 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
842 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200843 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100844 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200845 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100846 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200847 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200848
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100849 LOGPC(DRSL, LOGL_ERROR, "\n");
850
Harald Welted011e8b2009-11-29 22:45:52 +0100851 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
852
Harald Welte3073a9f2009-08-09 19:50:08 +0200853 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000854 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000855}
856
Harald Welte7f93cea2009-02-23 00:02:59 +0000857/* Chapter 8.4.4: Connection Failure Indication */
858static int rsl_rx_conn_fail(struct msgb *msg)
859{
860 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
861 struct tlv_parsed tp;
862
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100863 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100864 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100865 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000866
867 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
868
Harald Welte8830e072009-07-28 17:58:09 +0200869 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100870 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200871 TLVP_LEN(&tp, RSL_IE_CAUSE));
872
Harald Welte (local)fc057502009-12-26 22:33:09 +0100873 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000874 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +0200875 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800876 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000877}
878
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100879static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
880 const char *prefix)
881{
Harald Welte6739dfb2009-12-16 16:52:07 +0100882 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
883 prefix, rxlev2dbm(mru->full.rx_lev),
884 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100885 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
886 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
887}
888
889static void print_meas_rep(struct gsm_meas_rep *mr)
890{
Harald Welte6739dfb2009-12-16 16:52:07 +0100891 int i;
892
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100893 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
894
895 if (mr->flags & MEAS_REP_F_DL_DTX)
896 DEBUGPC(DMEAS, "DTXd ");
897
898 print_meas_rep_uni(&mr->ul, "ul");
899 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
900 if (mr->flags & MEAS_REP_F_MS_TO)
901 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
902
903 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100904 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100905 DEBUGPC(DMEAS, "L1_FPC=%u ",
906 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
907 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
908 }
909
910 if (mr->flags & MEAS_REP_F_UL_DTX)
911 DEBUGPC(DMEAS, "DTXu ");
912 if (mr->flags & MEAS_REP_F_BA1)
913 DEBUGPC(DMEAS, "BA1 ");
914 if (!(mr->flags & MEAS_REP_F_DL_VALID))
915 DEBUGPC(DMEAS, "NOT VALID ");
916 else
917 print_meas_rep_uni(&mr->dl, "dl");
918
919 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100920 if (mr->num_cell == 7)
921 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100922 for (i = 0; i < mr->num_cell; i++) {
923 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100924 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
925 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100926 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100927}
928
Harald Welte440fed02009-05-01 18:43:47 +0000929static int rsl_rx_meas_res(struct msgb *msg)
930{
931 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
932 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100933 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100934 u_int8_t len;
935 const u_int8_t *val;
936 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000937
Harald Welteb8bfc562009-12-21 13:27:11 +0100938 /* check if this channel is actually active */
939 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100940 if (msg->lchan->state != LCHAN_S_ACTIVE) {
941 LOGP(DRSL, LOGL_NOTICE, "%s: MEAS RES for inactive channel\n",
942 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100943 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100944 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100945
Harald Welted12b0fd2009-12-15 21:36:05 +0100946 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100947 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100948
Harald Welte440fed02009-05-01 18:43:47 +0000949 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
950
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100951 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
952 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
953 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
954 return -EIO;
955
956 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100957 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100958
959 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
960 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
961 if (len >= 3) {
962 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100963 mr->flags |= MEAS_REP_F_DL_DTX;
964 mr->ul.full.rx_lev = val[0] & 0x3f;
965 mr->ul.sub.rx_lev = val[1] & 0x3f;
966 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
967 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000968 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100969
Harald Welted12b0fd2009-12-15 21:36:05 +0100970 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100971
972 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000973 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100974 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100975 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
976
Harald Weltefe9af262009-06-20 18:44:35 +0200977 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100978 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100979 mr->flags |= MEAS_REP_F_MS_L1;
980 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100981 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100982 mr->flags |= MEAS_REP_F_FPC;
983 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200984 }
Harald Weltef7c43522009-06-09 20:24:21 +0000985 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherddd918f2009-10-22 15:43:55 +0200986 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100987 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100988 if (rc < 0)
989 return rc;
990 }
991
Harald Welted12b0fd2009-12-15 21:36:05 +0100992 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +0000993
Harald Welted12b0fd2009-12-15 21:36:05 +0100994 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +0100995
Harald Welte75d34a82009-05-23 06:11:13 +0000996 return 0;
Harald Welte440fed02009-05-01 18:43:47 +0000997}
998
Harald Welted011e8b2009-11-29 22:45:52 +0100999/* Chapter 8.4.7 */
1000static int rsl_rx_hando_det(struct msgb *msg)
1001{
1002 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1003 struct tlv_parsed tp;
1004
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001005 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001006
1007 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1008
1009 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1010 DEBUGPC(DRSL, "access delay = %u\n",
1011 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1012 else
1013 DEBUGPC(DRSL, "\n");
1014
1015 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1016
1017 return 0;
1018}
1019
Harald Welte52b1f982008-12-23 20:25:15 +00001020static int abis_rsl_rx_dchan(struct msgb *msg)
1021{
Harald Welte8470bf22008-12-25 23:28:35 +00001022 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1023 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001024 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001025
Harald Welte8470bf22008-12-25 23:28:35 +00001026 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001027 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001028
Harald Welte8470bf22008-12-25 23:28:35 +00001029 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001030 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001031 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001032 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001033 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001034 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001035 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001036 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001037 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001038 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001039 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001040 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001041 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001042 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001043 case RSL_MT_HANDO_DET:
1044 rc = rsl_rx_hando_det(msg);
1045 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001046 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001047 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001048 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welte1887f9d2009-12-29 10:52:38 +01001049 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1050 gsm_lchan_name(msg->lchan),
1051 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001052 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001053 /* we have an error timer pending to release that */
1054 if (msg->lchan->state != LCHAN_S_REL_ERR)
1055 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte2d5b6382008-12-27 19:46:06 +00001056 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001057 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001058 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001059 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001060 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001061 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001062 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001063 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001064 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001065 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001066 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001067 break;
1068 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001069 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001070 break;
1071 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001072 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001073 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001074 break;
1075 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001076 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001077 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001078 case RSL_MT_PHY_CONTEXT_CONF:
1079 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001080 case RSL_MT_TALKER_DET:
1081 case RSL_MT_LISTENER_DET:
1082 case RSL_MT_REMOTE_CODEC_CONF_REP:
1083 case RSL_MT_MR_CODEC_MOD_ACK:
1084 case RSL_MT_MR_CODEC_MOD_NACK:
1085 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001086 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1087 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001088 break;
1089 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001090 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1091 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001092 return -EINVAL;
1093 }
Harald Weltef325eb42009-02-19 17:07:39 +00001094
Harald Welte8470bf22008-12-25 23:28:35 +00001095 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001096}
1097
Harald Welte702d8702008-12-26 20:25:35 +00001098static int rsl_rx_error_rep(struct msgb *msg)
1099{
1100 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001101 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001102
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001103 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001104
1105 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1106
1107 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001108 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001109 TLVP_LEN(&tp, RSL_IE_CAUSE));
1110
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001111 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001112
1113 return 0;
1114}
1115
Harald Welte52b1f982008-12-23 20:25:15 +00001116static int abis_rsl_rx_trx(struct msgb *msg)
1117{
Harald Welte702d8702008-12-26 20:25:35 +00001118 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001119 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001120
1121 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001122 case RSL_MT_ERROR_REPORT:
1123 rc = rsl_rx_error_rep(msg);
1124 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001125 case RSL_MT_RF_RES_IND:
1126 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001127 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001128 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001129 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001130 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001131 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1132 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001133 break;
1134 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001135 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1136 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001137 return -EINVAL;
1138 }
Harald Welte8470bf22008-12-25 23:28:35 +00001139 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001140}
1141
Harald Welteb7e81162009-08-10 00:26:10 +02001142/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1143static void t3101_expired(void *data)
1144{
1145 struct gsm_lchan *lchan = data;
1146
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001147 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001148}
1149
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001150/* If T3111 expires, we will send the RF Channel Request */
1151static void t3111_expired(void *data)
1152{
1153 struct gsm_lchan *lchan = data;
1154
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001155 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001156}
1157
laforgecfa4a012010-06-21 12:08:52 +02001158#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1159
Harald Welte8470bf22008-12-25 23:28:35 +00001160/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001161static int rsl_rx_chan_rqd(struct msgb *msg)
1162{
Harald Welte702d8702008-12-26 20:25:35 +00001163 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001164 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1165 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001166 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001167 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001168 struct gsm_lchan *lchan;
1169 u_int8_t rqd_ta;
1170
Harald Welte52b1f982008-12-23 20:25:15 +00001171 u_int16_t arfcn;
1172 u_int8_t ts_number, subch;
1173
Harald Welte8470bf22008-12-25 23:28:35 +00001174 /* parse request reference to be used in immediate assign */
1175 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1176 return -EINVAL;
1177
1178 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1179
1180 /* parse access delay and use as TA */
1181 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1182 return -EINVAL;
1183 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1184
1185 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1186 * request reference RA */
Holger Hans Peter Freytherf7d752f2009-11-16 17:12:38 +01001187 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1188 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001189
Harald Welteffa55a42009-12-22 19:07:32 +01001190 counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001191
Harald Welte8470bf22008-12-25 23:28:35 +00001192 /* check availability / allocate channel */
1193 lchan = lchan_alloc(bts, lctype);
1194 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001195 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001196 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Welteffa55a42009-12-22 19:07:32 +01001197 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte8470bf22008-12-25 23:28:35 +00001198 /* FIXME: send some kind of reject ?!? */
1199 return -ENOMEM;
1200 }
1201
Harald Welte8e93b792009-12-29 10:44:17 +01001202 if (lchan->state != LCHAN_S_NONE)
1203 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001204 "in state %s\n", gsm_lchan_name(lchan),
1205 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001206 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001207
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001208 /* save the RACH data as we need it after the CHAN ACT ACK */
1209 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1210 if (!lchan->rqd_ref) {
1211 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1212 lchan_free(lchan);
1213 return -ENOMEM;
1214 }
1215
1216 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1217 lchan->rqd_ta = rqd_ta;
1218
Harald Welte8470bf22008-12-25 23:28:35 +00001219 ts_number = lchan->ts->nr;
1220 arfcn = lchan->ts->trx->arfcn;
1221 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001222
Harald Welte08d91a52009-08-30 15:37:11 +09001223 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001224 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001225 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001226 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001227 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001228
1229 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001230 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001231
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001232 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1233 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1234 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1235 rqd_ref->ra);
1236 return 0;
1237}
1238
1239static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1240{
1241 struct gsm_bts *bts = lchan->ts->trx->bts;
1242 u_int8_t buf[GSM_MACBLOCK_LEN];
1243 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1244
Harald Welte52b1f982008-12-23 20:25:15 +00001245 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001246 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001247 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001248 ia->proto_discr = GSM48_PDISC_RR;
1249 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1250 ia->page_mode = GSM48_PM_SAME;
1251 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001252
Harald Welte8470bf22008-12-25 23:28:35 +00001253 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001254 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1255 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001256 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001257 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001258 } else {
laforge09108bf2010-06-20 15:18:46 +02001259 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1260 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001261 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001262 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1263 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001264
Harald Welteb7e81162009-08-10 00:26:10 +02001265 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1266 lchan->T3101.cb = t3101_expired;
1267 lchan->T3101.data = lchan;
Holger Hans Peter Freytherc4d88ad2009-11-21 21:18:38 +01001268 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001269
Harald Welte52b1f982008-12-23 20:25:15 +00001270 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001271 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001272}
1273
Harald Welteea280442009-02-02 22:29:56 +00001274/* MS has requested a channel on the RACH */
1275static int rsl_rx_ccch_load(struct msgb *msg)
1276{
1277 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1278 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +00001279 u_int16_t rach_slot_count = -1;
1280 u_int16_t rach_busy_count = -1;
1281 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001282
1283 switch (rslh->data[0]) {
1284 case RSL_IE_PAGING_LOAD:
1285 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001286 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1287 /* paging load below configured threshold, use 50 as default */
1288 pg_buf_space = 50;
1289 }
Holger Freyther392209c2009-02-10 00:06:19 +00001290 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001291 break;
1292 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001293 if (msg->data_len >= 7) {
1294 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1295 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1296 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1297 }
Harald Welteea280442009-02-02 22:29:56 +00001298 break;
1299 default:
1300 break;
1301 }
1302
1303 return 0;
1304}
1305
Harald Welte52b1f982008-12-23 20:25:15 +00001306static int abis_rsl_rx_cchan(struct msgb *msg)
1307{
Harald Welteea280442009-02-02 22:29:56 +00001308 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001309 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001310
Harald Welte8470bf22008-12-25 23:28:35 +00001311 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1312
1313 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001314 case RSL_MT_CHAN_RQD:
1315 /* MS has requested a channel on the RACH */
1316 rc = rsl_rx_chan_rqd(msg);
1317 break;
Harald Welteea280442009-02-02 22:29:56 +00001318 case RSL_MT_CCCH_LOAD_IND:
1319 /* current load on the CCCH */
1320 rc = rsl_rx_ccch_load(msg);
1321 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001322 case RSL_MT_DELETE_IND:
1323 /* CCCH overloaded, IMM_ASSIGN was dropped */
1324 case RSL_MT_CBCH_LOAD_IND:
1325 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001326 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1327 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001328 break;
1329 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001330 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1331 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001332 return -EINVAL;
1333 }
Harald Welte8470bf22008-12-25 23:28:35 +00001334
1335 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001336}
1337
Harald Welte4b634542008-12-27 01:55:51 +00001338static int rsl_rx_rll_err_ind(struct msgb *msg)
1339{
1340 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1341 u_int8_t *rlm_cause = rllh->data;
1342
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001343 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001344 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001345 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001346
1347 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001348
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001349 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1350 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001351 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001352 }
Harald Welte81543bc2009-07-04 09:40:05 +02001353
Harald Welte4b634542008-12-27 01:55:51 +00001354 return 0;
1355}
Harald Weltef325eb42009-02-19 17:07:39 +00001356
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001357static void rsl_handle_release(struct gsm_lchan *lchan)
1358{
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001359 struct gsm_bts *bts;
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001360 if (lchan->state != LCHAN_S_REL_REQ)
1361 LOGP(DRSL, LOGL_ERROR, "RF release on %s but state %s\n",
1362 gsm_lchan_name(lchan),
1363 gsm_lchans_name(lchan->state));
1364
1365
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001366 /* wait a bit to send the RF Channel Release */
1367 lchan->T3111.cb = t3111_expired;
1368 lchan->T3111.data = lchan;
1369 bts = lchan->ts->trx->bts;
1370 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001371}
1372
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001373/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001374 0x02, 0x06,
1375 0x01, 0x20,
1376 0x02, 0x00,
1377 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1378
1379static int abis_rsl_rx_rll(struct msgb *msg)
1380{
1381 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001382 int rc = 0;
1383 char *ts_name;
Harald Welte (local)daef6062009-08-14 11:41:12 +02001384 u_int8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001385
1386 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001387 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001388 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001389
1390 switch (rllh->c.msg_type) {
1391 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001392 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001393 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001394 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1395 rllh->data[0] == RSL_IE_L3_INFO) {
1396 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001397 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001398 }
Harald Welte52b1f982008-12-23 20:25:15 +00001399 break;
1400 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001401 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001402 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001403 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welteb7e81162009-08-10 00:26:10 +02001404 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001405 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001406 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1407 rllh->data[0] == RSL_IE_L3_INFO) {
1408 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001409 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001410 }
Harald Welte52b1f982008-12-23 20:25:15 +00001411 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001412 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001413 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001414 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001415 rll_indication(msg->lchan, rllh->link_id,
1416 BSC_RLLR_IND_EST_CONF);
1417 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001418 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001419 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001420 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001421 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001422 rll_indication(msg->lchan, rllh->link_id,
1423 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001424 rsl_handle_release(msg->lchan);
Harald Welte2d5b6382008-12-27 19:46:06 +00001425 break;
1426 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001427 /* BTS informs us of having received UA from MS,
1428 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001429 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001430 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001431 rsl_handle_release(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +00001432 break;
1433 case RSL_MT_ERROR_IND:
1434 rc = rsl_rx_rll_err_ind(msg);
1435 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001436 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001437 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1438 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001439 break;
1440 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001441 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1442 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001443 }
Harald Welte8470bf22008-12-25 23:28:35 +00001444 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001445}
1446
Harald Welte0603c9d2009-12-02 01:58:23 +05301447static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001448{
Harald Welte0603c9d2009-12-02 01:58:23 +05301449 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001450 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301451 switch (lchan->type) {
1452 case GSM_LCHAN_TCH_F:
1453 return 0x00;
1454 case GSM_LCHAN_TCH_H:
1455 return 0x03;
1456 default:
1457 break;
1458 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001459 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301460 switch (lchan->type) {
1461 case GSM_LCHAN_TCH_F:
1462 return 0x01;
1463 /* there's no half-rate EFR */
1464 default:
1465 break;
1466 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001467 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301468 switch (lchan->type) {
1469 case GSM_LCHAN_TCH_F:
1470 return 0x02;
1471 case GSM_LCHAN_TCH_H:
1472 return 0x05;
1473 default:
1474 break;
1475 }
1476 default:
1477 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001478 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001479 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301480 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001481 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001482}
1483
Sylvain Munautb54dda42009-12-20 22:06:40 +01001484static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1485{
1486 switch (lchan->tch_mode) {
1487 case GSM48_CMODE_SPEECH_V1:
1488 switch (lchan->type) {
1489 case GSM_LCHAN_TCH_F:
1490 return RTP_PT_GSM_FULL;
1491 case GSM_LCHAN_TCH_H:
1492 return RTP_PT_GSM_HALF;
1493 default:
1494 break;
1495 }
1496 case GSM48_CMODE_SPEECH_EFR:
1497 switch (lchan->type) {
1498 case GSM_LCHAN_TCH_F:
1499 return RTP_PT_GSM_EFR;
1500 /* there's no half-rate EFR */
1501 default:
1502 break;
1503 }
1504 case GSM48_CMODE_SPEECH_AMR:
1505 switch (lchan->type) {
1506 case GSM_LCHAN_TCH_F:
1507 return RTP_PT_AMR_FULL;
1508 case GSM_LCHAN_TCH_H:
1509 return RTP_PT_AMR_HALF;
1510 default:
1511 break;
1512 }
1513 default:
1514 break;
1515 }
1516 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1517 "tch_mode == 0x%02x\n & lchan_type == %d",
1518 lchan->tch_mode, lchan->type);
1519 return 0;
1520}
1521
Harald Welte75099262009-02-16 21:12:08 +00001522/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001523static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1524{
1525 struct in_addr ip;
1526 u_int16_t port, conn_id;
1527
1528 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1529 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1530 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1531 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1532 }
1533
1534 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1535 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1536 port = ntohs(port);
1537 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1538 lchan->abis_ip.bound_port = port;
1539 }
1540
1541 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1542 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1543 conn_id = ntohs(conn_id);
1544 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1545 lchan->abis_ip.conn_id = conn_id;
1546 }
1547
1548 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1549 lchan->abis_ip.rtp_payload2 =
1550 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1551 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1552 lchan->abis_ip.rtp_payload2);
1553 }
1554
1555 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1556 lchan->abis_ip.speech_mode =
1557 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1558 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1559 lchan->abis_ip.speech_mode);
1560 }
1561
1562 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1563 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1564 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1565 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1566 }
1567
1568 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1569 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1570 port = ntohs(port);
1571 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1572 lchan->abis_ip.connect_port = port;
1573 }
1574}
1575
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001576int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001577{
1578 struct msgb *msg = rsl_msgb_alloc();
1579 struct abis_rsl_dchan_hdr *dh;
1580
1581 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001582 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001583 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1584 dh->chan_nr = lchan2chan_nr(lchan);
1585
Harald Weltef4e79f22009-07-28 18:11:56 +02001586 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001587 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001588 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001589 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001590 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001591
Sylvain Munautb54dda42009-12-20 22:06:40 +01001592 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1593 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1594 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001595
Harald Welte75099262009-02-16 21:12:08 +00001596 msg->trx = lchan->ts->trx;
1597
1598 return abis_rsl_sendmsg(msg);
1599}
1600
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001601int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte5e3d91b2009-12-19 16:42:06 +01001602 u_int8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001603{
1604 struct msgb *msg = rsl_msgb_alloc();
1605 struct abis_rsl_dchan_hdr *dh;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001606 u_int32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001607 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001608
1609 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001610 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001611 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1612 dh->chan_nr = lchan2chan_nr(lchan);
1613
Harald Welte5e3d91b2009-12-19 16:42:06 +01001614 /* we need to store these now as MDCX_ACK does not return them :( */
1615 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1616 lchan->abis_ip.connect_port = port;
1617 lchan->abis_ip.connect_ip = ip;
1618
Harald Welte58ca5b72009-07-29 12:12:18 +02001619 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001620 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001621 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001622
Harald Weltef4e79f22009-07-28 18:11:56 +02001623 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001624 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1625 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1626 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1627 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001628
Harald Welte5e3d91b2009-12-19 16:42:06 +01001629 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1630 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1631 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1632 *att_ip = ia.s_addr;
1633 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1634 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001635 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001636 if (rtp_payload2)
1637 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1638
Harald Welte75099262009-02-16 21:12:08 +00001639 msg->trx = lchan->ts->trx;
1640
1641 return abis_rsl_sendmsg(msg);
1642}
1643
Harald Weltea72273e2009-12-20 16:51:09 +01001644/* tell BTS to connect RTP stream to our local RTP socket */
1645int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1646{
1647 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1648 int rc;
1649
1650 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1651 ntohs(rs->rtp.sin_local.sin_port),
1652 /* FIXME: use RTP payload of bound socket, not BTS*/
1653 lchan->abis_ip.rtp_payload2);
1654
1655 return rc;
1656}
1657
Harald Welte4563eab2010-03-28 14:42:09 +08001658int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001659{
1660 struct msgb *msg = rsl_msgb_alloc();
1661 struct abis_rsl_dchan_hdr *dh;
Harald Welte4563eab2010-03-28 14:42:09 +08001662 u_int8_t msg_type;
1663
1664 if (act)
1665 msg_type = RSL_MT_IPAC_PDCH_ACT;
1666 else
1667 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001668
1669 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001670 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001671 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1672 dh->chan_nr = lchan2chan_nr(lchan);
1673
Harald Welte4563eab2010-03-28 14:42:09 +08001674 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_lchan_name(lchan),
1675 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001676
1677 msg->trx = lchan->ts->trx;
1678
1679 return abis_rsl_sendmsg(msg);
1680}
1681
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001682static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001683{
1684 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1685 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301686 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001687
1688 /* the BTS has acknowledged a local bind, it now tells us the IP
1689 * address and port number to which it has bound the given logical
1690 * channel */
1691
1692 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1693 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1694 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001695 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001696 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001697 return -EINVAL;
1698 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001699
Harald Welte5e3d91b2009-12-19 16:42:06 +01001700 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001701
1702 /* in case we don't use direct BTS-to-BTS RTP */
1703 if (!ipacc_rtp_direct) {
1704 int rc;
1705 /* the BTS has successfully bound a TCH to a local ip/port,
1706 * which means we can connect our UDP socket to it */
1707 if (lchan->abis_ip.rtp_socket) {
1708 rtp_socket_free(lchan->abis_ip.rtp_socket);
1709 lchan->abis_ip.rtp_socket = NULL;
1710 }
1711
1712 lchan->abis_ip.rtp_socket = rtp_socket_create();
1713 if (!lchan->abis_ip.rtp_socket)
1714 goto out_err;
1715
1716 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1717 lchan->abis_ip.bound_ip,
1718 lchan->abis_ip.bound_port);
1719 if (rc < 0)
1720 goto out_err;
1721 }
1722
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001723 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001724
Harald Welte75099262009-02-16 21:12:08 +00001725 return 0;
Harald Welte17f5bf62009-12-20 15:42:44 +01001726out_err:
1727 return -EIO;
Harald Welte75099262009-02-16 21:12:08 +00001728}
1729
Harald Welte5e3d91b2009-12-19 16:42:06 +01001730static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1731{
1732 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1733 struct tlv_parsed tv;
1734 struct gsm_lchan *lchan = msg->lchan;
1735
1736 /* the BTS has acknowledged a remote connect request and
1737 * it now tells us the IP address and port number to which it has
1738 * connected the given logical channel */
1739
1740 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1741 ipac_parse_rtp(lchan, &tv);
1742 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1743
1744 return 0;
1745}
1746
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001747static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001748{
1749 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1750 struct tlv_parsed tv;
Harald Welte17f5bf62009-12-20 15:42:44 +01001751 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001752
1753 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001754
Harald Welte8830e072009-07-28 17:58:09 +02001755 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001756 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001757 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001758
Harald Welte17f5bf62009-12-20 15:42:44 +01001759 /* the BTS tells us a RTP stream has been disconnected */
1760 if (lchan->abis_ip.rtp_socket) {
1761 rtp_socket_free(lchan->abis_ip.rtp_socket);
1762 lchan->abis_ip.rtp_socket = NULL;
1763 }
1764
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001765 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001766
Harald Welte75099262009-02-16 21:12:08 +00001767 return 0;
1768}
1769
1770static int abis_rsl_rx_ipacc(struct msgb *msg)
1771{
1772 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001773 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001774 int rc = 0;
1775
1776 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001777 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001778
1779 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001780 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001781 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001782 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001783 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001784 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001785 /* somehow the BTS was unable to bind the lchan to its local
1786 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001787 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001788 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001789 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001790 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001791 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001792 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001793 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001794 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001795 /* somehow the BTS was unable to connect the lchan to a remote
1796 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001797 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001798 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001799 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001800 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001801 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001802 break;
1803 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001804 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001805 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001806 break;
1807 }
Harald Welte6dab0552009-05-01 17:21:37 +00001808 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001809
1810 return rc;
1811}
1812
1813
Harald Welte52b1f982008-12-23 20:25:15 +00001814/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001815int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001816{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001817 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001818 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001819
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001820 if (!msg) {
1821 DEBUGP(DRSL, "Empty RSL msg?..\n");
1822 return -1;
1823 }
1824
1825 if (msgb_l2len(msg) < sizeof(*rslh)) {
1826 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1827 return -1;
1828 }
1829
1830 rslh = msgb_l2(msg);
1831
Harald Welte52b1f982008-12-23 20:25:15 +00001832 switch (rslh->msg_discr & 0xfe) {
1833 case ABIS_RSL_MDISC_RLL:
1834 rc = abis_rsl_rx_rll(msg);
1835 break;
1836 case ABIS_RSL_MDISC_DED_CHAN:
1837 rc = abis_rsl_rx_dchan(msg);
1838 break;
1839 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001840 rc = abis_rsl_rx_cchan(msg);
1841 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001842 case ABIS_RSL_MDISC_TRX:
1843 rc = abis_rsl_rx_trx(msg);
1844 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001845 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001846 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001847 rslh->msg_discr);
1848 break;
Harald Welte75099262009-02-16 21:12:08 +00001849 case ABIS_RSL_MDISC_IPACCESS:
1850 rc = abis_rsl_rx_ipacc(msg);
1851 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001852 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001853 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1854 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001855 return -EINVAL;
1856 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001857 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001858 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001859}
Holger Freyther3b72a892009-02-04 00:31:39 +00001860
Holger Freyther3b72a892009-02-04 00:31:39 +00001861/* From Table 10.5.33 of GSM 04.08 */
1862int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1863{
Harald Weltea43f7892009-12-01 18:04:30 +05301864 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1865 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1866 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001867 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301868 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1869 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001870 }
1871}
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001872
1873int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1874 uint8_t cb_command, const uint8_t *data, int len)
1875{
1876 struct abis_rsl_dchan_hdr *dh;
1877 struct msgb *cb_cmd;
1878
1879 cb_cmd = rsl_msgb_alloc();
1880 if (!cb_cmd)
1881 return -1;
1882
1883 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1884 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1885 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1886
1887 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1888 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1889
1890 cb_cmd->trx = bts->c0;
1891
1892 return abis_rsl_sendmsg(cb_cmd);
1893}