blob: aa3d78a58b755a4a3227313d04ca2d9c04b1f9c9 [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
Harald Welte9af6ddf2011-01-01 15:25:50 +01009 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
Harald Welte52b1f982008-12-23 20:25:15 +000011 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000017 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010018 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte52b1f982008-12-23 20:25:15 +000020 *
21 */
22
23#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000024#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000025#include <errno.h>
26#include <sys/types.h>
Harald Welte75099262009-02-16 21:12:08 +000027#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000028#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000029
Harald Welte8470bf22008-12-25 23:28:35 +000030#include <openbsc/gsm_data.h>
31#include <openbsc/gsm_04_08.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010032#include <osmocore/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000033#include <openbsc/abis_rsl.h>
34#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020035#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000036#include <openbsc/debug.h>
Harald Weltedfe6c7d2010-02-20 16:24:02 +010037#include <osmocore/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000038#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000039#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010040#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010041#include <openbsc/rtp_proxy.h>
Harald Welte2e411c72010-03-01 21:59:06 +010042#include <osmocore/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000043
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080044#include <osmocore/talloc.h>
45
Harald Welte8470bf22008-12-25 23:28:35 +000046#define RSL_ALLOC_SIZE 1024
47#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000048
Holger Freyther3b72a892009-02-04 00:31:39 +000049#define MAX(a, b) (a) >= (b) ? (a) : (b)
50
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080051static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
52
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010053static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
54 struct gsm_meas_rep *resp)
55{
56 struct lchan_signal_data sig;
57 sig.lchan = lchan;
58 sig.mr = resp;
59 dispatch_signal(SS_LCHAN, sig_no, &sig);
60}
61
Harald Welte52b1f982008-12-23 20:25:15 +000062static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
63{
64 /* mask off the transparent bit ? */
65 msg_type &= 0xfe;
66
Harald Welte8470bf22008-12-25 23:28:35 +000067 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000068 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000069 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000070 if (msg_type >= 0x19 && msg_type <= 0x22)
71 return ABIS_RSL_MDISC_TRX;
72 else
73 return ABIS_RSL_MDISC_COM_CHAN;
74 }
Harald Welte2d5b6382008-12-27 19:46:06 +000075 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000076 return ABIS_RSL_MDISC_DED_CHAN;
77
78 return ABIS_RSL_MDISC_LOC;
79}
80
81static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
82 u_int8_t msg_type)
83{
84 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
85 dh->c.msg_type = msg_type;
86 dh->ie_chan = RSL_IE_CHAN_NR;
87}
88
Harald Welte8470bf22008-12-25 23:28:35 +000089/* determine logical channel based on TRX and channel number IE */
90struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
91{
92 struct gsm_lchan *lchan;
93 u_int8_t ts_nr = chan_nr & 0x07;
94 u_int8_t cbits = chan_nr >> 3;
95 u_int8_t lch_idx;
96 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
97
98 if (cbits == 0x01) {
99 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +0200100 if (ts->pchan != GSM_PCHAN_TCH_F &&
101 ts->pchan != GSM_PCHAN_PDCH &&
102 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100103 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000104 chan_nr, ts->pchan);
105 } else if ((cbits & 0x1e) == 0x02) {
106 lch_idx = cbits & 0x1; /* TCH/H */
107 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100108 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000109 chan_nr, ts->pchan);
110 } else if ((cbits & 0x1c) == 0x04) {
111 lch_idx = cbits & 0x3; /* SDCCH/4 */
112 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100113 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000114 chan_nr, ts->pchan);
115 } else if ((cbits & 0x18) == 0x08) {
116 lch_idx = cbits & 0x7; /* SDCCH/8 */
117 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100118 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000119 chan_nr, ts->pchan);
120 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
121 lch_idx = 0;
122 if (ts->pchan != GSM_PCHAN_CCCH &&
123 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100124 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000125 chan_nr, ts->pchan);
126 /* FIXME: we should not return first sdcch4 !!! */
127 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100128 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000129 return NULL;
130 }
131
132 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800133 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800134 if (lchan->conn)
135 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000136
137 return lchan;
138}
139
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200140/* See Table 10.5.25 of GSM04.08 */
Harald Welte53cd7ac2010-12-23 12:59:52 +0100141static u_int8_t ts2chan_nr(const struct gsm_bts_trx_ts *ts, uint8_t lchan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +0000142{
Harald Welte8470bf22008-12-25 23:28:35 +0000143 u_int8_t cbits, chan_nr;
144
145 switch (ts->pchan) {
146 case GSM_PCHAN_TCH_F:
Harald Weltea1499d02009-10-24 10:25:50 +0200147 case GSM_PCHAN_PDCH:
148 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000149 cbits = 0x01;
150 break;
151 case GSM_PCHAN_TCH_H:
152 cbits = 0x02;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100153 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000154 break;
155 case GSM_PCHAN_CCCH_SDCCH4:
156 cbits = 0x04;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100157 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000158 break;
159 case GSM_PCHAN_SDCCH8_SACCH8C:
160 cbits = 0x08;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100161 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000162 break;
163 default:
164 case GSM_PCHAN_CCCH:
165 cbits = 0x10;
166 break;
167 }
168
169 chan_nr = (cbits << 3) | (ts->nr & 0x7);
170
171 return chan_nr;
172}
173
Harald Welte53cd7ac2010-12-23 12:59:52 +0100174u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
175{
176 return ts2chan_nr(lchan->ts, lchan->nr);
177}
178
Harald Welte52b1f982008-12-23 20:25:15 +0000179/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
180u_int64_t str_to_imsi(const char *imsi_str)
181{
182 u_int64_t ret;
183
184 ret = strtoull(imsi_str, NULL, 10);
185
186 return ret;
187}
188
189/* Table 5 Clause 7 TS 05.02 */
190unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
191{
192 if (!bs_ccch_sdcch_comb)
193 return 9 - bs_ag_blks_res;
194 else
195 return 3 - bs_ag_blks_res;
196}
197
198/* Chapter 6.5.2 of TS 05.02 */
199unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
200 unsigned int n_pag_blocks)
201{
202 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
203}
204
205/* Chapter 6.5.2 of TS 05.02 */
206unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
207 int n_pag_blocks)
208{
209 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
210}
211
Harald Welte8470bf22008-12-25 23:28:35 +0000212static struct msgb *rsl_msgb_alloc(void)
213{
Harald Welte966636f2009-06-26 19:39:35 +0200214 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
215 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000216}
217
Harald Welte362322e2009-02-15 14:36:38 +0000218#define MACBLOCK_SIZE 23
219static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
220{
221 memcpy(out, in, len);
222
223 if (len < MACBLOCK_SIZE)
224 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
225}
226
Harald Welte08d91a52009-08-30 15:37:11 +0900227/* Chapter 9.3.7: Encryption Information */
228static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
229{
230 *out++ = lchan->encr.alg_id & 0xff;
231 if (lchan->encr.key_len)
232 memcpy(out, lchan->encr.key, lchan->encr.key_len);
233 return lchan->encr.key_len + 1;
234}
235
Harald Welte5b8ed432009-12-24 12:20:20 +0100236static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200237{
Harald Welte7f93cea2009-02-23 00:02:59 +0000238 int i;
239
Harald Welte5b8ed432009-12-24 12:20:20 +0100240 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200241 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200242 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100243 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000244}
245
Harald Welte52b1f982008-12-23 20:25:15 +0000246/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000247int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000248 const u_int8_t *data, int len)
249{
250 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000251 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000252
253 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
254 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
255 dh->chan_nr = RSL_CHAN_BCCH;
256
257 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
258 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
259
Harald Weltee79769b2009-02-07 00:48:17 +0000260 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000261
262 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000263}
264
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200265int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000266 const u_int8_t *data, int len)
267{
268 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000269 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000270
271 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
272 ch->msg_discr = ABIS_RSL_MDISC_TRX;
273 ch->msg_type = RSL_MT_SACCH_FILL;
274
275 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000276 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000277
Harald Weltee79769b2009-02-07 00:48:17 +0000278 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000279
280 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000281}
282
Harald Weltefcd24452009-06-20 18:15:19 +0200283int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
284{
285 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200286 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200287 u_int8_t chan_nr = lchan2chan_nr(lchan);
288
289 db = abs(db);
290 if (db > 30)
291 return -EINVAL;
292
Harald Welteeab33352009-06-27 03:09:08 +0200293 msg = rsl_msgb_alloc();
294
Harald Weltefcd24452009-06-20 18:15:19 +0200295 lchan->bs_power = db/2;
296 if (fpc)
297 lchan->bs_power |= 0x10;
298
299 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
300 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
301 dh->chan_nr = chan_nr;
302
303 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
304
305 msg->trx = lchan->ts->trx;
306
307 return abis_rsl_sendmsg(msg);
308}
309
Harald Weltefcd24452009-06-20 18:15:19 +0200310int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
311{
312 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200313 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200314 u_int8_t chan_nr = lchan2chan_nr(lchan);
315 int ctl_lvl;
316
Harald Welte66b6a8d2009-08-09 14:45:18 +0200317 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200318 if (ctl_lvl < 0)
319 return ctl_lvl;
320
Harald Welteeab33352009-06-27 03:09:08 +0200321 msg = rsl_msgb_alloc();
322
Harald Weltefcd24452009-06-20 18:15:19 +0200323 lchan->ms_power = ctl_lvl;
324
325 if (fpc)
326 lchan->ms_power |= 0x20;
327
328 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
329 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
330 dh->chan_nr = chan_nr;
331
332 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
333
334 msg->trx = lchan->ts->trx;
335
336 return abis_rsl_sendmsg(msg);
337}
338
Harald Welte9943c5b2009-07-29 15:41:29 +0200339static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
340 struct gsm_lchan *lchan)
341{
342 memset(cm, 0, sizeof(cm));
343
344 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800345 if (lchan->ts->trx->bts->network->dtx_enabled)
346 cm->dtx_dtu = 0x03;
347 else
348 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200349
350 /* set TCH Speech/Data */
351 cm->spd_ind = lchan->rsl_cmode;
352
Harald Welte1a79d362009-11-27 08:55:16 +0100353 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
354 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100355 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100356 "but tch_mode != signalling\n");
357
Harald Welte9943c5b2009-07-29 15:41:29 +0200358 switch (lchan->type) {
359 case GSM_LCHAN_SDCCH:
360 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
361 break;
362 case GSM_LCHAN_TCH_F:
363 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
364 break;
365 case GSM_LCHAN_TCH_H:
366 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
367 break;
368 case GSM_LCHAN_NONE:
369 case GSM_LCHAN_UNKNOWN:
370 default:
371 return -EINVAL;
372 }
373
374 switch (lchan->tch_mode) {
375 case GSM48_CMODE_SIGN:
376 cm->chan_rate = 0;
377 break;
378 case GSM48_CMODE_SPEECH_V1:
379 cm->chan_rate = RSL_CMOD_SP_GSM1;
380 break;
381 case GSM48_CMODE_SPEECH_EFR:
382 cm->chan_rate = RSL_CMOD_SP_GSM2;
383 break;
384 case GSM48_CMODE_SPEECH_AMR:
385 cm->chan_rate = RSL_CMOD_SP_GSM3;
386 break;
387 case GSM48_CMODE_DATA_14k5:
388 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
389 break;
390 case GSM48_CMODE_DATA_12k0:
391 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
392 break;
393 case GSM48_CMODE_DATA_6k0:
394 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
395 break;
396 default:
397 return -EINVAL;
398 }
399
400 return 0;
401}
402
Harald Welte52b1f982008-12-23 20:25:15 +0000403/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000404#if 0
Harald Weltee79769b2009-02-07 00:48:17 +0000405int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000406 u_int8_t act_type,
407 struct rsl_ie_chan_mode *chan_mode,
408 struct rsl_ie_chan_ident *chan_ident,
409 u_int8_t bs_power, u_int8_t ms_power,
410 u_int8_t ta)
411{
412 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000413 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000414
415 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
416 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
417 dh->chan_nr = chan_nr;
418
419 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
420 /* For compatibility with Phase 1 */
421 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
422 (u_int8_t *) chan_mode);
423 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Harald Welte702d8702008-12-26 20:25:35 +0000424 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000425#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000426 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
427 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000428#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000429 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000430 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
431 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
432
Harald Weltee79769b2009-02-07 00:48:17 +0000433 msg->trx = trx;
434
Harald Welte8470bf22008-12-25 23:28:35 +0000435 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000436}
Harald Welteddab3c72009-02-28 13:19:15 +0000437#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000438
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200439int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte8d77b952009-12-17 00:31:10 +0100440 u_int8_t ta, u_int8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000441{
442 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200443 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200444 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200445 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000446
447 u_int8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000448 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200449 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000450
Harald Welte9943c5b2009-07-29 15:41:29 +0200451 rc = channel_mode_from_lchan(&cm, lchan);
452 if (rc < 0)
453 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000454
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800455 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200456 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000457
Harald Welteeab33352009-06-27 03:09:08 +0200458 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000459 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
460 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
461 dh->chan_nr = chan_nr;
462
463 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000464 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
465 (u_int8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800466
467 /*
468 * The Channel Identification is needed for Phase1 phones
469 * and it contains the GSM48 Channel Description and the
470 * Mobile Allocation. The GSM 08.58 asks for the Mobile
471 * Allocation to have a length of zero. We are using the
472 * msgb_l3len to calculate the length of both messages.
473 */
laforge694a5cf2010-06-20 21:38:19 +0200474 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200475 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800476 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800477
478 if (lchan->ts->hopping.enabled)
479 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
480 lchan->ts->hopping.ma_data);
481 else
482 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800483
484 /* update the calculated size */
485 msg->l3h = len + 1;
486 *len = msgb_l3len(msg);
487
Harald Welte08d91a52009-08-30 15:37:11 +0900488 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
489 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
490 rc = build_encr_info(encr_info, lchan);
491 if (rc > 0)
492 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
493 }
494
Harald Welte8d77b952009-12-17 00:31:10 +0100495 switch (act_type) {
496 case RSL_ACT_INTER_ASYNC:
497 case RSL_ACT_INTER_SYNC:
498 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
499 break;
500 default:
501 break;
502 }
503
Harald Welted4c9bf32009-02-15 16:56:18 +0000504 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
505 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000506 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
507
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100508 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
509 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
510 (u_int8_t *) &lchan->mr_conf);
511
Harald Weltee79769b2009-02-07 00:48:17 +0000512 msg->trx = lchan->ts->trx;
513
Harald Welte4b634542008-12-27 01:55:51 +0000514 return abis_rsl_sendmsg(msg);
515}
516
Harald Welte470abb72009-07-29 11:38:15 +0200517/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000518int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
519{
520 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200521 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200522 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000523
524 u_int8_t chan_nr = lchan2chan_nr(lchan);
525 struct rsl_ie_chan_mode cm;
526
Harald Welte9943c5b2009-07-29 15:41:29 +0200527 rc = channel_mode_from_lchan(&cm, lchan);
528 if (rc < 0)
529 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000530
Harald Welteeab33352009-06-27 03:09:08 +0200531 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000532 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
533 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
534 dh->chan_nr = chan_nr;
535
536 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
537 (u_int8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900538
539 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
540 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
541 rc = build_encr_info(encr_info, lchan);
542 if (rc > 0)
543 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
544 }
545
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100546 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
547 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
548 (u_int8_t *) &lchan->mr_conf);
549 }
550
Harald Welte08d91a52009-08-30 15:37:11 +0900551 msg->trx = lchan->ts->trx;
552
553 return abis_rsl_sendmsg(msg);
554}
555
556/* Chapter 8.4.6: Send the encryption command with given L3 info */
557int rsl_encryption_cmd(struct msgb *msg)
558{
559 struct abis_rsl_dchan_hdr *dh;
560 struct gsm_lchan *lchan = msg->lchan;
561 u_int8_t chan_nr = lchan2chan_nr(lchan);
562 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut82aa6842009-09-27 11:13:18 +0200563 u_int8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900564 int rc;
565
566 /* First push the L3 IE tag and length */
567 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
568
569 /* then the link identifier (SAPI0, main sign link) */
570 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
571
572 /* then encryption information */
573 rc = build_encr_info(encr_info, lchan);
574 if (rc <= 0)
575 return rc;
576 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
577
578 /* and finally the DCHAN header */
579 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
580 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
581 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000582
583 msg->trx = lchan->ts->trx;
584
585 return abis_rsl_sendmsg(msg);
586}
587
Harald Welte115d1032009-08-10 11:43:22 +0200588/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200589int rsl_deact_sacch(struct gsm_lchan *lchan)
590{
591 struct abis_rsl_dchan_hdr *dh;
592 struct msgb *msg = rsl_msgb_alloc();
593
594 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
595 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
596 dh->chan_nr = lchan2chan_nr(lchan);
597
598 msg->lchan = lchan;
599 msg->trx = lchan->ts->trx;
600
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100601 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200602
603 return abis_rsl_sendmsg(msg);
604}
605
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800606static void error_timeout_cb(void *data)
607{
608 struct gsm_lchan *lchan = data;
609 if (lchan->state != LCHAN_S_REL_ERR) {
610 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
611 gsm_lchan_name(lchan), lchan->state);
612 return;
613 }
614
615 /* go back to the none state */
616 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800617 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800618}
619
Harald Welte115d1032009-08-10 11:43:22 +0200620/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800621static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000622{
623 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800624 struct msgb *msg;
Harald Welte52b1f982008-12-23 20:25:15 +0000625
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800626 if (lchan->state == LCHAN_S_REL_ERR) {
627 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
628 gsm_lchan_name(lchan));
629 return -1;
630 }
631
632 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000633 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
634 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000635 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000636
Harald Welte8470bf22008-12-25 23:28:35 +0000637 msg->lchan = lchan;
638 msg->trx = lchan->ts->trx;
639
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800640 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
641
642 if (error) {
643 /*
644 * the nanoBTS sends RLL release indications after the channel release. This can
645 * be a problem when we have reassigned the channel to someone else and then can
646 * not figure out who used this channel.
647 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800648 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800649 lchan->error_timer.data = lchan;
650 lchan->error_timer.cb = error_timeout_cb;
651 bsc_schedule_timer(&lchan->error_timer,
652 msg->trx->bts->network->T3111 + 2, 0);
653 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000654
Harald Welte115d1032009-08-10 11:43:22 +0200655 /* BTS will respond by RF CHAN REL ACK */
Harald Welte8470bf22008-12-25 23:28:35 +0000656 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000657}
658
659int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
660 u_int8_t *ms_ident, u_int8_t chan_needed)
661{
662 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000663 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000664
665 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
666 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
667 dh->chan_nr = RSL_CHAN_PCH_AGCH;
668
669 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000670 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000671 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
672
Harald Welte8470bf22008-12-25 23:28:35 +0000673 msg->trx = bts->c0;
674
675 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000676}
677
678int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
679{
680 int i, len = strlen(str_in);
681
682 for (i = 0; i < len; i++) {
683 int num = str_in[i] - 0x30;
684 if (num < 0 || num > 9)
685 return -1;
686 if (i % 2 == 0)
687 bcd_out[i/2] = num;
688 else
689 bcd_out[i/2] |= (num << 4);
690 }
691
692 return 0;
693}
694
Harald Welte702d8702008-12-26 20:25:35 +0000695/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000696int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
697{
Harald Welte8470bf22008-12-25 23:28:35 +0000698 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000699 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000700 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000701
702 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
703 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
704 dh->chan_nr = RSL_CHAN_PCH_AGCH;
705
Harald Welte362322e2009-02-15 14:36:38 +0000706 switch (bts->type) {
707 case GSM_BTS_TYPE_BS11:
708 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
709 break;
710 default:
711 /* If phase 2, construct a FULL_IMM_ASS_INFO */
712 pad_macblock(buf, val, len);
713 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
714 break;
715 }
Harald Welte52b1f982008-12-23 20:25:15 +0000716
Harald Welte8470bf22008-12-25 23:28:35 +0000717 msg->trx = bts->c0;
718
719 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000720}
721
Harald Welte67fa91b2009-08-10 09:51:40 +0200722/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200723int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200724{
725 struct msgb *msg = rsl_msgb_alloc();
726 struct abis_rsl_dchan_hdr *dh;
727
728 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
729 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200730 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200731 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte31c48932009-08-10 10:07:33 +0200732 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200733
Harald Welte5b8ed432009-12-24 12:20:20 +0100734 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100735 gsm_lchan_name(lchan), *(u_int8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200736
737 msg->trx = lchan->ts->trx;
738
Harald Welte67fa91b2009-08-10 09:51:40 +0200739 return abis_rsl_sendmsg(msg);
740}
741
742
Harald Welte8470bf22008-12-25 23:28:35 +0000743/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000744/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000745int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000746{
Harald Welte8470bf22008-12-25 23:28:35 +0000747 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100748 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000749 return -EINVAL;
750 }
Harald Welte52b1f982008-12-23 20:25:15 +0000751
Harald Welte3c9c5f92010-03-04 10:33:10 +0100752 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
753 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000754
Harald Welte8470bf22008-12-25 23:28:35 +0000755 msg->trx = msg->lchan->ts->trx;
756
757 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000758}
759
Harald Welteedcc5272009-08-09 13:47:35 +0200760/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
761/* Chapter 8.3.1 */
762int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
763{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100764 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200765
Harald Welte3c9c5f92010-03-04 10:33:10 +0100766 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
767 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200768 msg->trx = lchan->ts->trx;
769
770 return abis_rsl_sendmsg(msg);
771}
772
Harald Welted2dc1de2009-08-08 13:15:07 +0200773/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
774 This is what higher layers should call. The BTS then responds with
775 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
776 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
777 lchan_free() */
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800778int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id, u_int8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200779{
Harald Welted2dc1de2009-08-08 13:15:07 +0200780
Harald Welte3c9c5f92010-03-04 10:33:10 +0100781 struct msgb *msg;
782
783 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
784 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800785 /* 0 is normal release, 1 is local end */
786 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200787
Harald Welte8e93b792009-12-29 10:44:17 +0100788 /* FIXME: start some timer in case we don't receive a REL ACK ? */
789
Harald Welted2dc1de2009-08-08 13:15:07 +0200790 msg->trx = lchan->ts->trx;
791
792 return abis_rsl_sendmsg(msg);
793}
794
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200795int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
796{
797 lchan->state = state;
798 return 0;
799}
800
Harald Welte702d8702008-12-26 20:25:35 +0000801/* Chapter 8.4.2: Channel Activate Acknowledge */
802static int rsl_rx_chan_act_ack(struct msgb *msg)
803{
804 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
805
806 /* BTS has confirmed channel activation, we now need
807 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000808 if (rslh->ie_chan != RSL_IE_CHAN_NR)
809 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100810
Harald Welte8e93b792009-12-29 10:44:17 +0100811 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100812 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
813 gsm_lchan_name(msg->lchan),
814 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200815 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100816
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800817 if (msg->lchan->rqd_ref) {
818 rsl_send_imm_assignment(msg->lchan);
819 talloc_free(msg->lchan->rqd_ref);
820 msg->lchan->rqd_ref = NULL;
821 msg->lchan->rqd_ta = 0;
822 }
823
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100824 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100825
Harald Welte4b634542008-12-27 01:55:51 +0000826 return 0;
827}
Harald Welte702d8702008-12-26 20:25:35 +0000828
Harald Welte4b634542008-12-27 01:55:51 +0000829/* Chapter 8.4.3: Channel Activate NACK */
830static int rsl_rx_chan_act_nack(struct msgb *msg)
831{
Harald Welte6dab0552009-05-01 17:21:37 +0000832 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
833 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000834
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100835 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100836 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100837
Harald Welte6dab0552009-05-01 17:21:37 +0000838 /* BTS has rejected channel activation ?!? */
839 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000840 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000841
842 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100843 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
844 const u_int8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
845 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200846 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100847 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200848 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100849 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200850 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200851
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100852 LOGPC(DRSL, LOGL_ERROR, "\n");
853
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100854 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100855
Harald Welte3073a9f2009-08-09 19:50:08 +0200856 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000857 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000858}
859
Harald Welte7f93cea2009-02-23 00:02:59 +0000860/* Chapter 8.4.4: Connection Failure Indication */
861static int rsl_rx_conn_fail(struct msgb *msg)
862{
863 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
864 struct tlv_parsed tp;
865
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100866 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100867 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100868 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000869
870 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
871
Harald Welte8830e072009-07-28 17:58:09 +0200872 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100873 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200874 TLVP_LEN(&tp, RSL_IE_CAUSE));
875
Harald Welte (local)fc057502009-12-26 22:33:09 +0100876 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000877 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +0200878 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800879 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000880}
881
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100882static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
883 const char *prefix)
884{
Harald Welte6739dfb2009-12-16 16:52:07 +0100885 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
886 prefix, rxlev2dbm(mru->full.rx_lev),
887 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100888 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
889 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
890}
891
892static void print_meas_rep(struct gsm_meas_rep *mr)
893{
Harald Welte6739dfb2009-12-16 16:52:07 +0100894 int i;
895
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100896 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
897
898 if (mr->flags & MEAS_REP_F_DL_DTX)
899 DEBUGPC(DMEAS, "DTXd ");
900
901 print_meas_rep_uni(&mr->ul, "ul");
902 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
903 if (mr->flags & MEAS_REP_F_MS_TO)
904 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
905
906 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100907 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100908 DEBUGPC(DMEAS, "L1_FPC=%u ",
909 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
910 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
911 }
912
913 if (mr->flags & MEAS_REP_F_UL_DTX)
914 DEBUGPC(DMEAS, "DTXu ");
915 if (mr->flags & MEAS_REP_F_BA1)
916 DEBUGPC(DMEAS, "BA1 ");
917 if (!(mr->flags & MEAS_REP_F_DL_VALID))
918 DEBUGPC(DMEAS, "NOT VALID ");
919 else
920 print_meas_rep_uni(&mr->dl, "dl");
921
922 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100923 if (mr->num_cell == 7)
924 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100925 for (i = 0; i < mr->num_cell; i++) {
926 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100927 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
928 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100929 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100930}
931
Harald Welte440fed02009-05-01 18:43:47 +0000932static int rsl_rx_meas_res(struct msgb *msg)
933{
934 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
935 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100936 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100937 u_int8_t len;
938 const u_int8_t *val;
939 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000940
Harald Welteb8bfc562009-12-21 13:27:11 +0100941 /* check if this channel is actually active */
942 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100943 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800944 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100945 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100946 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100947 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100948
Harald Welted12b0fd2009-12-15 21:36:05 +0100949 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100950 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100951
Harald Welte440fed02009-05-01 18:43:47 +0000952 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
953
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100954 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
955 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
956 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
957 return -EIO;
958
959 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100960 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100961
962 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
963 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
964 if (len >= 3) {
965 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100966 mr->flags |= MEAS_REP_F_DL_DTX;
967 mr->ul.full.rx_lev = val[0] & 0x3f;
968 mr->ul.sub.rx_lev = val[1] & 0x3f;
969 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
970 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000971 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100972
Harald Welted12b0fd2009-12-15 21:36:05 +0100973 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100974
975 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000976 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100977 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100978 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
979
Harald Weltefe9af262009-06-20 18:44:35 +0200980 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100981 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100982 mr->flags |= MEAS_REP_F_MS_L1;
983 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100984 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100985 mr->flags |= MEAS_REP_F_FPC;
986 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200987 }
Harald Weltef7c43522009-06-09 20:24:21 +0000988 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherddd918f2009-10-22 15:43:55 +0200989 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100990 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100991 if (rc < 0)
992 return rc;
993 }
994
Harald Welted12b0fd2009-12-15 21:36:05 +0100995 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +0000996
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100997 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +0100998
Harald Welte75d34a82009-05-23 06:11:13 +0000999 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001000}
1001
Harald Welted011e8b2009-11-29 22:45:52 +01001002/* Chapter 8.4.7 */
1003static int rsl_rx_hando_det(struct msgb *msg)
1004{
1005 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1006 struct tlv_parsed tp;
1007
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001008 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001009
1010 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1011
1012 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1013 DEBUGPC(DRSL, "access delay = %u\n",
1014 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1015 else
1016 DEBUGPC(DRSL, "\n");
1017
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001018 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001019
1020 return 0;
1021}
1022
Harald Welte52b1f982008-12-23 20:25:15 +00001023static int abis_rsl_rx_dchan(struct msgb *msg)
1024{
Harald Welte8470bf22008-12-25 23:28:35 +00001025 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1026 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001027 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001028
Harald Welte8470bf22008-12-25 23:28:35 +00001029 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001030 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001031
Harald Welte8470bf22008-12-25 23:28:35 +00001032 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001033 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001034 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001035 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001036 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001037 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001038 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001039 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001040 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001041 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001042 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001043 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001044 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001045 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001046 case RSL_MT_HANDO_DET:
1047 rc = rsl_rx_hando_det(msg);
1048 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001049 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001050 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001051 if (msg->lchan->state != LCHAN_S_REL_REQ && msg->lchan->state != LCHAN_S_REL_ERR)
Harald Welte1887f9d2009-12-29 10:52:38 +01001052 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
1053 gsm_lchan_name(msg->lchan),
1054 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001055 bsc_del_timer(&msg->lchan->T3111);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001056 /* we have an error timer pending to release that */
1057 if (msg->lchan->state != LCHAN_S_REL_ERR)
1058 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte2d5b6382008-12-27 19:46:06 +00001059 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001060 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001061 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001062 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001063 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001064 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001065 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001066 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001067 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001068 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001069 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001070 break;
1071 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001072 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001073 break;
1074 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001075 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001076 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001077 break;
1078 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001079 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001080 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001081 case RSL_MT_PHY_CONTEXT_CONF:
1082 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001083 case RSL_MT_TALKER_DET:
1084 case RSL_MT_LISTENER_DET:
1085 case RSL_MT_REMOTE_CODEC_CONF_REP:
1086 case RSL_MT_MR_CODEC_MOD_ACK:
1087 case RSL_MT_MR_CODEC_MOD_NACK:
1088 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001089 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1090 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001091 break;
1092 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001093 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1094 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001095 return -EINVAL;
1096 }
Harald Weltef325eb42009-02-19 17:07:39 +00001097
Harald Welte8470bf22008-12-25 23:28:35 +00001098 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001099}
1100
Harald Welte702d8702008-12-26 20:25:35 +00001101static int rsl_rx_error_rep(struct msgb *msg)
1102{
1103 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001104 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001105
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001106 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001107
1108 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1109
1110 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001111 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001112 TLVP_LEN(&tp, RSL_IE_CAUSE));
1113
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001114 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001115
1116 return 0;
1117}
1118
Harald Welte52b1f982008-12-23 20:25:15 +00001119static int abis_rsl_rx_trx(struct msgb *msg)
1120{
Harald Welte702d8702008-12-26 20:25:35 +00001121 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001122 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001123
1124 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001125 case RSL_MT_ERROR_REPORT:
1126 rc = rsl_rx_error_rep(msg);
1127 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001128 case RSL_MT_RF_RES_IND:
1129 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001130 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001131 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001132 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001133 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001134 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1135 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001136 break;
1137 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001138 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1139 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001140 return -EINVAL;
1141 }
Harald Welte8470bf22008-12-25 23:28:35 +00001142 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001143}
1144
Harald Welteb7e81162009-08-10 00:26:10 +02001145/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1146static void t3101_expired(void *data)
1147{
1148 struct gsm_lchan *lchan = data;
1149
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001150 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001151}
1152
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001153/* If T3111 expires, we will send the RF Channel Request */
1154static void t3111_expired(void *data)
1155{
1156 struct gsm_lchan *lchan = data;
1157
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001158 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001159}
1160
laforgecfa4a012010-06-21 12:08:52 +02001161#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1162
Harald Welte2862dca2010-12-23 14:39:29 +01001163/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1164static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1165 unsigned int num_req_refs,
1166 struct gsm48_req_ref *rqd_refs,
1167 uint8_t wait_ind)
1168{
1169 uint8_t buf[GSM_MACBLOCK_LEN];
1170 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1171
1172 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1173 memset(iar, 0, sizeof(*iar));
1174 iar->proto_discr = GSM48_PDISC_RR;
1175 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1176 iar->page_mode = GSM48_PM_SAME;
1177
1178 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1179 iar->wait_ind1 = wait_ind;
1180
1181 if (num_req_refs >= 2)
1182 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1183 else
1184 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1185 iar->wait_ind2 = wait_ind;
1186
1187 if (num_req_refs >= 3)
1188 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1189 else
1190 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1191 iar->wait_ind3 = wait_ind;
1192
1193 if (num_req_refs >= 4)
1194 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1195 else
1196 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1197 iar->wait_ind4 = wait_ind;
1198
1199 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1200}
1201
Harald Welte8470bf22008-12-25 23:28:35 +00001202/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001203static int rsl_rx_chan_rqd(struct msgb *msg)
1204{
Harald Welte702d8702008-12-26 20:25:35 +00001205 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001206 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1207 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001208 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001209 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001210 struct gsm_lchan *lchan;
1211 u_int8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001212 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001213
Harald Welte52b1f982008-12-23 20:25:15 +00001214 u_int16_t arfcn;
1215 u_int8_t ts_number, subch;
1216
Harald Welte8470bf22008-12-25 23:28:35 +00001217 /* parse request reference to be used in immediate assign */
1218 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1219 return -EINVAL;
1220
1221 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1222
1223 /* parse access delay and use as TA */
1224 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1225 return -EINVAL;
1226 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1227
1228 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1229 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001230 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1231 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001232
Harald Welteffa55a42009-12-22 19:07:32 +01001233 counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001234
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001235 /*
1236 * We want LOCATION UPDATES to succeed and will assign a TCH
1237 * if we have no SDCCH available.
1238 */
1239 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1240
Harald Welte8470bf22008-12-25 23:28:35 +00001241 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001242 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001243 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001244 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001245 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Welteffa55a42009-12-22 19:07:32 +01001246 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001247 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1248 if (bts->network->T3122)
1249 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001250 return -ENOMEM;
1251 }
1252
Harald Welte8e93b792009-12-29 10:44:17 +01001253 if (lchan->state != LCHAN_S_NONE)
1254 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001255 "in state %s\n", gsm_lchan_name(lchan),
1256 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001257 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001258
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001259 /* save the RACH data as we need it after the CHAN ACT ACK */
1260 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1261 if (!lchan->rqd_ref) {
1262 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1263 lchan_free(lchan);
1264 return -ENOMEM;
1265 }
1266
1267 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1268 lchan->rqd_ta = rqd_ta;
1269
Harald Welte8470bf22008-12-25 23:28:35 +00001270 ts_number = lchan->ts->nr;
1271 arfcn = lchan->ts->trx->arfcn;
1272 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001273
Harald Welte08d91a52009-08-30 15:37:11 +09001274 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001275 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001276 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001277 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001278 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001279
1280 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001281 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001282
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001283 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1284 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1285 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1286 rqd_ref->ra);
1287 return 0;
1288}
1289
1290static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1291{
1292 struct gsm_bts *bts = lchan->ts->trx->bts;
1293 u_int8_t buf[GSM_MACBLOCK_LEN];
1294 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1295
Harald Welte52b1f982008-12-23 20:25:15 +00001296 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001297 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001298 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001299 ia->proto_discr = GSM48_PDISC_RR;
1300 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1301 ia->page_mode = GSM48_PM_SAME;
1302 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001303
Harald Welte8470bf22008-12-25 23:28:35 +00001304 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001305 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1306 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001307 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001308 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001309 } else {
laforge09108bf2010-06-20 15:18:46 +02001310 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1311 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001312 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001313 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1314 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001315
Harald Welteb7e81162009-08-10 00:26:10 +02001316 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1317 lchan->T3101.cb = t3101_expired;
1318 lchan->T3101.data = lchan;
Holger Hans Peter Freytherc4d88ad2009-11-21 21:18:38 +01001319 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001320
Harald Welte52b1f982008-12-23 20:25:15 +00001321 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001322 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (u_int8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001323}
1324
Harald Welteea280442009-02-02 22:29:56 +00001325/* MS has requested a channel on the RACH */
1326static int rsl_rx_ccch_load(struct msgb *msg)
1327{
1328 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1329 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +00001330 u_int16_t rach_slot_count = -1;
1331 u_int16_t rach_busy_count = -1;
1332 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001333
1334 switch (rslh->data[0]) {
1335 case RSL_IE_PAGING_LOAD:
1336 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001337 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1338 /* paging load below configured threshold, use 50 as default */
1339 pg_buf_space = 50;
1340 }
Holger Freyther392209c2009-02-10 00:06:19 +00001341 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001342 break;
1343 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001344 if (msg->data_len >= 7) {
1345 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1346 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1347 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1348 }
Harald Welteea280442009-02-02 22:29:56 +00001349 break;
1350 default:
1351 break;
1352 }
1353
1354 return 0;
1355}
1356
Harald Welte52b1f982008-12-23 20:25:15 +00001357static int abis_rsl_rx_cchan(struct msgb *msg)
1358{
Harald Welteea280442009-02-02 22:29:56 +00001359 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001360 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001361
Harald Welte8470bf22008-12-25 23:28:35 +00001362 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1363
1364 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001365 case RSL_MT_CHAN_RQD:
1366 /* MS has requested a channel on the RACH */
1367 rc = rsl_rx_chan_rqd(msg);
1368 break;
Harald Welteea280442009-02-02 22:29:56 +00001369 case RSL_MT_CCCH_LOAD_IND:
1370 /* current load on the CCCH */
1371 rc = rsl_rx_ccch_load(msg);
1372 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001373 case RSL_MT_DELETE_IND:
1374 /* CCCH overloaded, IMM_ASSIGN was dropped */
1375 case RSL_MT_CBCH_LOAD_IND:
1376 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001377 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1378 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001379 break;
1380 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001381 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1382 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001383 return -EINVAL;
1384 }
Harald Welte8470bf22008-12-25 23:28:35 +00001385
1386 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001387}
1388
Harald Welte4b634542008-12-27 01:55:51 +00001389static int rsl_rx_rll_err_ind(struct msgb *msg)
1390{
1391 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1392 u_int8_t *rlm_cause = rllh->data;
1393
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001394 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001395 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001396 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001397
1398 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001399
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001400 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1401 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001402 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001403 }
Harald Welte81543bc2009-07-04 09:40:05 +02001404
Harald Welte4b634542008-12-27 01:55:51 +00001405 return 0;
1406}
Harald Weltef325eb42009-02-19 17:07:39 +00001407
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001408static void rsl_handle_release(struct gsm_lchan *lchan)
1409{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001410 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001411 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001412
1413 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001414 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001415 return;
1416
1417 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1418 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1419 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001420 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001421 gsm_lchan_name(lchan), sapi);
1422 return;
1423 }
1424
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001425
1426
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001427 /* wait a bit to send the RF Channel Release */
1428 lchan->T3111.cb = t3111_expired;
1429 lchan->T3111.data = lchan;
1430 bts = lchan->ts->trx->bts;
1431 bsc_schedule_timer(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001432}
1433
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001434/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001435 0x02, 0x06,
1436 0x01, 0x20,
1437 0x02, 0x00,
1438 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1439
1440static int abis_rsl_rx_rll(struct msgb *msg)
1441{
1442 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001443 int rc = 0;
1444 char *ts_name;
Harald Welte (local)daef6062009-08-14 11:41:12 +02001445 u_int8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001446
1447 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001448 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001449 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001450
1451 switch (rllh->c.msg_type) {
1452 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001453 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001454 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001455 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1456 rllh->data[0] == RSL_IE_L3_INFO) {
1457 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001458 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001459 }
Harald Welte52b1f982008-12-23 20:25:15 +00001460 break;
1461 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001462 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001463 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001464 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welteb7e81162009-08-10 00:26:10 +02001465 bsc_del_timer(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001466 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001467 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1468 rllh->data[0] == RSL_IE_L3_INFO) {
1469 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001470 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001471 }
Harald Welte52b1f982008-12-23 20:25:15 +00001472 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001473 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001474 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001475 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001476 rll_indication(msg->lchan, rllh->link_id,
1477 BSC_RLLR_IND_EST_CONF);
1478 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001479 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001480 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001481 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001482 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001483 rll_indication(msg->lchan, rllh->link_id,
1484 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001485 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001486 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001487 break;
1488 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001489 /* BTS informs us of having received UA from MS,
1490 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001491 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001492 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001493 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001494 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001495 break;
1496 case RSL_MT_ERROR_IND:
1497 rc = rsl_rx_rll_err_ind(msg);
1498 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001499 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001500 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1501 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001502 break;
1503 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001504 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1505 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001506 }
Harald Welte8470bf22008-12-25 23:28:35 +00001507 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001508}
1509
Harald Welte0603c9d2009-12-02 01:58:23 +05301510static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001511{
Harald Welte0603c9d2009-12-02 01:58:23 +05301512 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001513 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301514 switch (lchan->type) {
1515 case GSM_LCHAN_TCH_F:
1516 return 0x00;
1517 case GSM_LCHAN_TCH_H:
1518 return 0x03;
1519 default:
1520 break;
1521 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001522 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301523 switch (lchan->type) {
1524 case GSM_LCHAN_TCH_F:
1525 return 0x01;
1526 /* there's no half-rate EFR */
1527 default:
1528 break;
1529 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001530 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301531 switch (lchan->type) {
1532 case GSM_LCHAN_TCH_F:
1533 return 0x02;
1534 case GSM_LCHAN_TCH_H:
1535 return 0x05;
1536 default:
1537 break;
1538 }
1539 default:
1540 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001541 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001542 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301543 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001544 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001545}
1546
Sylvain Munautb54dda42009-12-20 22:06:40 +01001547static u_int8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
1548{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001549 struct gsm_network *net = lchan->ts->trx->bts->network;
1550
1551 /* allow to hardcode the rtp payload */
1552 if (net->hardcoded_rtp_payload != 0)
1553 return net->hardcoded_rtp_payload;
1554
Sylvain Munautb54dda42009-12-20 22:06:40 +01001555 switch (lchan->tch_mode) {
1556 case GSM48_CMODE_SPEECH_V1:
1557 switch (lchan->type) {
1558 case GSM_LCHAN_TCH_F:
1559 return RTP_PT_GSM_FULL;
1560 case GSM_LCHAN_TCH_H:
1561 return RTP_PT_GSM_HALF;
1562 default:
1563 break;
1564 }
1565 case GSM48_CMODE_SPEECH_EFR:
1566 switch (lchan->type) {
1567 case GSM_LCHAN_TCH_F:
1568 return RTP_PT_GSM_EFR;
1569 /* there's no half-rate EFR */
1570 default:
1571 break;
1572 }
1573 case GSM48_CMODE_SPEECH_AMR:
1574 switch (lchan->type) {
1575 case GSM_LCHAN_TCH_F:
1576 return RTP_PT_AMR_FULL;
1577 case GSM_LCHAN_TCH_H:
1578 return RTP_PT_AMR_HALF;
1579 default:
1580 break;
1581 }
1582 default:
1583 break;
1584 }
1585 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1586 "tch_mode == 0x%02x\n & lchan_type == %d",
1587 lchan->tch_mode, lchan->type);
1588 return 0;
1589}
1590
Harald Welte75099262009-02-16 21:12:08 +00001591/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001592static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1593{
1594 struct in_addr ip;
1595 u_int16_t port, conn_id;
1596
1597 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1598 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1599 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1600 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1601 }
1602
1603 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1604 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1605 port = ntohs(port);
1606 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1607 lchan->abis_ip.bound_port = port;
1608 }
1609
1610 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1611 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1612 conn_id = ntohs(conn_id);
1613 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1614 lchan->abis_ip.conn_id = conn_id;
1615 }
1616
1617 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1618 lchan->abis_ip.rtp_payload2 =
1619 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1620 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1621 lchan->abis_ip.rtp_payload2);
1622 }
1623
1624 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1625 lchan->abis_ip.speech_mode =
1626 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1627 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1628 lchan->abis_ip.speech_mode);
1629 }
1630
1631 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1632 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1633 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1634 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1635 }
1636
1637 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1638 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1639 port = ntohs(port);
1640 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1641 lchan->abis_ip.connect_port = port;
1642 }
1643}
1644
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001645int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001646{
1647 struct msgb *msg = rsl_msgb_alloc();
1648 struct abis_rsl_dchan_hdr *dh;
1649
1650 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001651 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001652 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1653 dh->chan_nr = lchan2chan_nr(lchan);
1654
Harald Weltef4e79f22009-07-28 18:11:56 +02001655 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001656 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001657 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001658 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001659 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001660
Sylvain Munautb54dda42009-12-20 22:06:40 +01001661 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1662 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1663 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001664
Harald Welte75099262009-02-16 21:12:08 +00001665 msg->trx = lchan->ts->trx;
1666
1667 return abis_rsl_sendmsg(msg);
1668}
1669
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001670int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte5e3d91b2009-12-19 16:42:06 +01001671 u_int8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001672{
1673 struct msgb *msg = rsl_msgb_alloc();
1674 struct abis_rsl_dchan_hdr *dh;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001675 u_int32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001676 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001677
1678 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001679 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001680 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1681 dh->chan_nr = lchan2chan_nr(lchan);
1682
Harald Welte5e3d91b2009-12-19 16:42:06 +01001683 /* we need to store these now as MDCX_ACK does not return them :( */
1684 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1685 lchan->abis_ip.connect_port = port;
1686 lchan->abis_ip.connect_ip = ip;
1687
Harald Welte58ca5b72009-07-29 12:12:18 +02001688 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001689 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001690 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001691
Harald Weltef4e79f22009-07-28 18:11:56 +02001692 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001693 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1694 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1695 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1696 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001697
Harald Welte5e3d91b2009-12-19 16:42:06 +01001698 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1699 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1700 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1701 *att_ip = ia.s_addr;
1702 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1703 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001704 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001705 if (rtp_payload2)
1706 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1707
Harald Welte75099262009-02-16 21:12:08 +00001708 msg->trx = lchan->ts->trx;
1709
1710 return abis_rsl_sendmsg(msg);
1711}
1712
Harald Weltea72273e2009-12-20 16:51:09 +01001713/* tell BTS to connect RTP stream to our local RTP socket */
1714int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1715{
1716 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1717 int rc;
1718
1719 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1720 ntohs(rs->rtp.sin_local.sin_port),
1721 /* FIXME: use RTP payload of bound socket, not BTS*/
1722 lchan->abis_ip.rtp_payload2);
1723
1724 return rc;
1725}
1726
Harald Welte53cd7ac2010-12-23 12:59:52 +01001727int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001728{
1729 struct msgb *msg = rsl_msgb_alloc();
1730 struct abis_rsl_dchan_hdr *dh;
Harald Welte4563eab2010-03-28 14:42:09 +08001731 u_int8_t msg_type;
1732
1733 if (act)
1734 msg_type = RSL_MT_IPAC_PDCH_ACT;
1735 else
1736 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001737
1738 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001739 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001740 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte53cd7ac2010-12-23 12:59:52 +01001741 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001742
Harald Welte53cd7ac2010-12-23 12:59:52 +01001743 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001744 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001745
Harald Welte53cd7ac2010-12-23 12:59:52 +01001746 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001747
1748 return abis_rsl_sendmsg(msg);
1749}
1750
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001751static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001752{
1753 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1754 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301755 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001756
1757 /* the BTS has acknowledged a local bind, it now tells us the IP
1758 * address and port number to which it has bound the given logical
1759 * channel */
1760
1761 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1762 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1763 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001764 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001765 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001766 return -EINVAL;
1767 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001768
Harald Welte5e3d91b2009-12-19 16:42:06 +01001769 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001770
1771 /* in case we don't use direct BTS-to-BTS RTP */
1772 if (!ipacc_rtp_direct) {
1773 int rc;
1774 /* the BTS has successfully bound a TCH to a local ip/port,
1775 * which means we can connect our UDP socket to it */
1776 if (lchan->abis_ip.rtp_socket) {
1777 rtp_socket_free(lchan->abis_ip.rtp_socket);
1778 lchan->abis_ip.rtp_socket = NULL;
1779 }
1780
1781 lchan->abis_ip.rtp_socket = rtp_socket_create();
1782 if (!lchan->abis_ip.rtp_socket)
1783 goto out_err;
1784
1785 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1786 lchan->abis_ip.bound_ip,
1787 lchan->abis_ip.bound_port);
1788 if (rc < 0)
1789 goto out_err;
1790 }
1791
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001792 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001793
Harald Welte75099262009-02-16 21:12:08 +00001794 return 0;
Harald Welte17f5bf62009-12-20 15:42:44 +01001795out_err:
1796 return -EIO;
Harald Welte75099262009-02-16 21:12:08 +00001797}
1798
Harald Welte5e3d91b2009-12-19 16:42:06 +01001799static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1800{
1801 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1802 struct tlv_parsed tv;
1803 struct gsm_lchan *lchan = msg->lchan;
1804
1805 /* the BTS has acknowledged a remote connect request and
1806 * it now tells us the IP address and port number to which it has
1807 * connected the given logical channel */
1808
1809 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1810 ipac_parse_rtp(lchan, &tv);
1811 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1812
1813 return 0;
1814}
1815
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001816static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001817{
1818 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1819 struct tlv_parsed tv;
Harald Welte17f5bf62009-12-20 15:42:44 +01001820 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001821
1822 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001823
Harald Welte8830e072009-07-28 17:58:09 +02001824 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001825 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001826 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001827
Harald Welte17f5bf62009-12-20 15:42:44 +01001828 /* the BTS tells us a RTP stream has been disconnected */
1829 if (lchan->abis_ip.rtp_socket) {
1830 rtp_socket_free(lchan->abis_ip.rtp_socket);
1831 lchan->abis_ip.rtp_socket = NULL;
1832 }
1833
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001834 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001835
Harald Welte75099262009-02-16 21:12:08 +00001836 return 0;
1837}
1838
1839static int abis_rsl_rx_ipacc(struct msgb *msg)
1840{
1841 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001842 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001843 int rc = 0;
1844
1845 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001846 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001847
1848 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001849 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001850 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001851 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001852 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001853 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001854 /* somehow the BTS was unable to bind the lchan to its local
1855 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001856 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001857 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001858 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001859 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001860 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001861 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001862 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001863 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001864 /* somehow the BTS was unable to connect the lchan to a remote
1865 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001866 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001867 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001868 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001869 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001870 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001871 break;
1872 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001873 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001874 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001875 break;
1876 }
Harald Welte6dab0552009-05-01 17:21:37 +00001877 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001878
1879 return rc;
1880}
1881
1882
Harald Welte52b1f982008-12-23 20:25:15 +00001883/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001884int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001885{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001886 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001887 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001888
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001889 if (!msg) {
1890 DEBUGP(DRSL, "Empty RSL msg?..\n");
1891 return -1;
1892 }
1893
1894 if (msgb_l2len(msg) < sizeof(*rslh)) {
1895 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1896 return -1;
1897 }
1898
1899 rslh = msgb_l2(msg);
1900
Harald Welte52b1f982008-12-23 20:25:15 +00001901 switch (rslh->msg_discr & 0xfe) {
1902 case ABIS_RSL_MDISC_RLL:
1903 rc = abis_rsl_rx_rll(msg);
1904 break;
1905 case ABIS_RSL_MDISC_DED_CHAN:
1906 rc = abis_rsl_rx_dchan(msg);
1907 break;
1908 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001909 rc = abis_rsl_rx_cchan(msg);
1910 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001911 case ABIS_RSL_MDISC_TRX:
1912 rc = abis_rsl_rx_trx(msg);
1913 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001914 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001915 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001916 rslh->msg_discr);
1917 break;
Harald Welte75099262009-02-16 21:12:08 +00001918 case ABIS_RSL_MDISC_IPACCESS:
1919 rc = abis_rsl_rx_ipacc(msg);
1920 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001921 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001922 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1923 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001924 return -EINVAL;
1925 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001926 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001927 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001928}
Holger Freyther3b72a892009-02-04 00:31:39 +00001929
Holger Freyther3b72a892009-02-04 00:31:39 +00001930/* From Table 10.5.33 of GSM 04.08 */
1931int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1932{
Harald Weltea43f7892009-12-01 18:04:30 +05301933 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1934 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1935 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001936 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301937 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1938 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001939 }
1940}
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001941
1942int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1943 uint8_t cb_command, const uint8_t *data, int len)
1944{
1945 struct abis_rsl_dchan_hdr *dh;
1946 struct msgb *cb_cmd;
1947
1948 cb_cmd = rsl_msgb_alloc();
1949 if (!cb_cmd)
1950 return -1;
1951
1952 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1953 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1954 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1955
1956 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1957 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1958
1959 cb_cmd->trx = bts->c0;
1960
1961 return abis_rsl_sendmsg(cb_cmd);
1962}