blob: c246213d4d94fe1568ea024a2bda363ef91a1fb5 [file] [log] [blame]
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte59b04682009-06-10 05:40:52 +08002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Weltea22d36b2010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte59b04682009-06-10 05:40:52 +08005 *
6 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
Harald Welte0e3e88e2011-01-01 15:25:50 +01009 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
Harald Welte59b04682009-06-10 05:40:52 +080011 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte0e3e88e2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte59b04682009-06-10 05:40:52 +080017 *
Harald Welte0e3e88e2011-01-01 15:25:50 +010018 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte59b04682009-06-10 05:40:52 +080020 *
21 */
22
23#include <stdio.h>
24#include <stdlib.h>
25#include <errno.h>
Harald Welte59b04682009-06-10 05:40:52 +080026#include <netinet/in.h>
27#include <arpa/inet.h>
28
29#include <openbsc/gsm_data.h>
30#include <openbsc/gsm_04_08.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010031#include <osmocom/gsm/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080032#include <openbsc/abis_rsl.h>
33#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020034#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080035#include <openbsc/debug.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010036#include <osmocom/gsm/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080037#include <openbsc/paging.h>
38#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010039#include <openbsc/meas_rep.h>
Harald Welte50517742009-12-20 15:42:44 +010040#include <openbsc/rtp_proxy.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010041#include <osmocom/gsm/rsl.h>
Harald Welte59b04682009-06-10 05:40:52 +080042
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080044
Harald Welte59b04682009-06-10 05:40:52 +080045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
47
48#define MAX(a, b) (a) >= (b) ? (a) : (b)
49
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080050static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
51
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010052static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
53 struct gsm_meas_rep *resp)
54{
55 struct lchan_signal_data sig;
56 sig.lchan = lchan;
57 sig.mr = resp;
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +020058 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010059}
60
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020061static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080062{
63 /* mask off the transparent bit ? */
64 msg_type &= 0xfe;
65
66 if ((msg_type & 0xf0) == 0x00)
67 return ABIS_RSL_MDISC_RLL;
68 if ((msg_type & 0xf0) == 0x10) {
69 if (msg_type >= 0x19 && msg_type <= 0x22)
70 return ABIS_RSL_MDISC_TRX;
71 else
72 return ABIS_RSL_MDISC_COM_CHAN;
73 }
74 if ((msg_type & 0xe0) == 0x20)
75 return ABIS_RSL_MDISC_DED_CHAN;
76
77 return ABIS_RSL_MDISC_LOC;
78}
79
80static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020081 uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080082{
83 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
84 dh->c.msg_type = msg_type;
85 dh->ie_chan = RSL_IE_CHAN_NR;
86}
87
Harald Welte59b04682009-06-10 05:40:52 +080088/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020089struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte59b04682009-06-10 05:40:52 +080090{
91 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020092 uint8_t ts_nr = chan_nr & 0x07;
93 uint8_t cbits = chan_nr >> 3;
94 uint8_t lch_idx;
Harald Welte59b04682009-06-10 05:40:52 +080095 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
96
97 if (cbits == 0x01) {
98 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +020099 if (ts->pchan != GSM_PCHAN_TCH_F &&
100 ts->pchan != GSM_PCHAN_PDCH &&
101 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100102 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800103 chan_nr, ts->pchan);
104 } else if ((cbits & 0x1e) == 0x02) {
105 lch_idx = cbits & 0x1; /* TCH/H */
106 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100107 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800108 chan_nr, ts->pchan);
109 } else if ((cbits & 0x1c) == 0x04) {
110 lch_idx = cbits & 0x3; /* SDCCH/4 */
111 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100112 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800113 chan_nr, ts->pchan);
114 } else if ((cbits & 0x18) == 0x08) {
115 lch_idx = cbits & 0x7; /* SDCCH/8 */
116 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100117 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800118 chan_nr, ts->pchan);
119 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
120 lch_idx = 0;
121 if (ts->pchan != GSM_PCHAN_CCCH &&
122 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100123 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800124 chan_nr, ts->pchan);
125 /* FIXME: we should not return first sdcch4 !!! */
126 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100127 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800128 return NULL;
129 }
130
131 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800132 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800133 if (lchan->conn)
134 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800135
136 return lchan;
137}
138
Harald Welte59b04682009-06-10 05:40:52 +0800139/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200140uint64_t str_to_imsi(const char *imsi_str)
Harald Welte59b04682009-06-10 05:40:52 +0800141{
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200142 uint64_t ret;
Harald Welte59b04682009-06-10 05:40:52 +0800143
144 ret = strtoull(imsi_str, NULL, 10);
145
146 return ret;
147}
148
149/* Table 5 Clause 7 TS 05.02 */
150unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
151{
152 if (!bs_ccch_sdcch_comb)
153 return 9 - bs_ag_blks_res;
154 else
155 return 3 - bs_ag_blks_res;
156}
157
158/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200159unsigned int get_ccch_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte59b04682009-06-10 05:40:52 +0800160 unsigned int n_pag_blocks)
161{
162 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
163}
164
165/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200166unsigned int get_paging_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte59b04682009-06-10 05:40:52 +0800167 int n_pag_blocks)
168{
169 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
170}
171
172static struct msgb *rsl_msgb_alloc(void)
173{
Harald Welte9cfc9352009-06-26 19:39:35 +0200174 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
175 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800176}
177
178#define MACBLOCK_SIZE 23
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200179static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800180{
181 memcpy(out, in, len);
182
183 if (len < MACBLOCK_SIZE)
184 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
185}
186
Harald Welted2dd9de2009-08-30 15:37:11 +0900187/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200188static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welted2dd9de2009-08-30 15:37:11 +0900189{
190 *out++ = lchan->encr.alg_id & 0xff;
191 if (lchan->encr.key_len)
192 memcpy(out, lchan->encr.key, lchan->encr.key_len);
193 return lchan->encr.key_len + 1;
194}
195
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200196static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200197{
Harald Welte59b04682009-06-10 05:40:52 +0800198 int i;
199
Harald Weltede4477a2009-12-24 12:20:20 +0100200 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200201 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200202 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100203 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800204}
205
206/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200207int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
208 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800209{
210 struct abis_rsl_dchan_hdr *dh;
211 struct msgb *msg = rsl_msgb_alloc();
212
213 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
214 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
215 dh->chan_nr = RSL_CHAN_BCCH;
216
217 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
218 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
219
220 msg->trx = trx;
221
222 return abis_rsl_sendmsg(msg);
223}
224
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200225int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
226 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800227{
228 struct abis_rsl_common_hdr *ch;
229 struct msgb *msg = rsl_msgb_alloc();
230
231 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
232 ch->msg_discr = ABIS_RSL_MDISC_TRX;
233 ch->msg_type = RSL_MT_SACCH_FILL;
234
235 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
236 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
237
238 msg->trx = trx;
239
240 return abis_rsl_sendmsg(msg);
241}
242
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200243int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
244 const uint8_t *data, int len)
Harald Welte10b7d8f2011-01-13 23:16:03 +0100245{
246 struct abis_rsl_dchan_hdr *dh;
247 struct msgb *msg = rsl_msgb_alloc();
Harald Weltee6d51f92011-06-25 10:02:33 +0200248 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte10b7d8f2011-01-13 23:16:03 +0100249
250 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
251 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
252 dh->chan_nr = chan_nr;
253
254 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
255 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
256
257 msg->trx = lchan->ts->trx;
258
259 return abis_rsl_sendmsg(msg);
260}
261
Harald Welte91afe4c2009-06-20 18:15:19 +0200262int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
263{
264 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200265 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200266 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200267
268 db = abs(db);
269 if (db > 30)
270 return -EINVAL;
271
Harald Welteed831842009-06-27 03:09:08 +0200272 msg = rsl_msgb_alloc();
273
Harald Welte91afe4c2009-06-20 18:15:19 +0200274 lchan->bs_power = db/2;
275 if (fpc)
276 lchan->bs_power |= 0x10;
277
278 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
279 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
280 dh->chan_nr = chan_nr;
281
282 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
283
284 msg->trx = lchan->ts->trx;
285
286 return abis_rsl_sendmsg(msg);
287}
288
Harald Welte91afe4c2009-06-20 18:15:19 +0200289int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
290{
291 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200292 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200293 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200294 int ctl_lvl;
295
Harald Weltec4dcda02009-08-09 14:45:18 +0200296 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200297 if (ctl_lvl < 0)
298 return ctl_lvl;
299
Harald Welteed831842009-06-27 03:09:08 +0200300 msg = rsl_msgb_alloc();
301
Harald Welte91afe4c2009-06-20 18:15:19 +0200302 lchan->ms_power = ctl_lvl;
303
304 if (fpc)
305 lchan->ms_power |= 0x20;
306
307 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
308 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
309 dh->chan_nr = chan_nr;
310
311 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
312
313 msg->trx = lchan->ts->trx;
314
315 return abis_rsl_sendmsg(msg);
316}
317
Harald Welte39274f42009-07-29 15:41:29 +0200318static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
319 struct gsm_lchan *lchan)
320{
321 memset(cm, 0, sizeof(cm));
322
323 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800324 if (lchan->ts->trx->bts->network->dtx_enabled)
325 cm->dtx_dtu = 0x03;
326 else
327 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200328
329 /* set TCH Speech/Data */
330 cm->spd_ind = lchan->rsl_cmode;
331
Harald Welte951e3512009-11-27 08:55:16 +0100332 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
333 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100334 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100335 "but tch_mode != signalling\n");
336
Harald Welte39274f42009-07-29 15:41:29 +0200337 switch (lchan->type) {
338 case GSM_LCHAN_SDCCH:
339 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
340 break;
341 case GSM_LCHAN_TCH_F:
342 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
343 break;
344 case GSM_LCHAN_TCH_H:
345 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
346 break;
347 case GSM_LCHAN_NONE:
348 case GSM_LCHAN_UNKNOWN:
349 default:
350 return -EINVAL;
351 }
352
353 switch (lchan->tch_mode) {
354 case GSM48_CMODE_SIGN:
355 cm->chan_rate = 0;
356 break;
357 case GSM48_CMODE_SPEECH_V1:
358 cm->chan_rate = RSL_CMOD_SP_GSM1;
359 break;
360 case GSM48_CMODE_SPEECH_EFR:
361 cm->chan_rate = RSL_CMOD_SP_GSM2;
362 break;
363 case GSM48_CMODE_SPEECH_AMR:
364 cm->chan_rate = RSL_CMOD_SP_GSM3;
365 break;
366 case GSM48_CMODE_DATA_14k5:
367 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
368 break;
369 case GSM48_CMODE_DATA_12k0:
370 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
371 break;
372 case GSM48_CMODE_DATA_6k0:
373 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
374 break;
375 default:
376 return -EINVAL;
377 }
378
379 return 0;
380}
381
Harald Welte59b04682009-06-10 05:40:52 +0800382/* Chapter 8.4.1 */
383#if 0
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200384int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
385 uint8_t act_type,
Harald Welte59b04682009-06-10 05:40:52 +0800386 struct rsl_ie_chan_mode *chan_mode,
387 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200388 uint8_t bs_power, uint8_t ms_power,
389 uint8_t ta)
Harald Welte59b04682009-06-10 05:40:52 +0800390{
391 struct abis_rsl_dchan_hdr *dh;
392 struct msgb *msg = rsl_msgb_alloc();
393
394 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
395 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
396 dh->chan_nr = chan_nr;
397
398 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
399 /* For compatibility with Phase 1 */
400 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200401 (uint8_t *) chan_mode);
Harald Welte59b04682009-06-10 05:40:52 +0800402 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200403 (uint8_t *) chan_ident);
Harald Welte59b04682009-06-10 05:40:52 +0800404#if 0
405 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200406 (uint8_t *) &encr_info);
Harald Welte59b04682009-06-10 05:40:52 +0800407#endif
408 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
409 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
410 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
411
412 msg->trx = trx;
413
414 return abis_rsl_sendmsg(msg);
415}
416#endif
417
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200418int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
419 uint8_t ta, uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800420{
421 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200422 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200423 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200424 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800425
Harald Weltee6d51f92011-06-25 10:02:33 +0200426 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800427 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200428 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800429
Harald Welte39274f42009-07-29 15:41:29 +0200430 rc = channel_mode_from_lchan(&cm, lchan);
431 if (rc < 0)
432 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800433
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800434 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200435 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800436
Harald Welteed831842009-06-27 03:09:08 +0200437 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800438 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
439 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
440 dh->chan_nr = chan_nr;
441
442 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800443 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200444 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800445
446 /*
447 * The Channel Identification is needed for Phase1 phones
448 * and it contains the GSM48 Channel Description and the
449 * Mobile Allocation. The GSM 08.58 asks for the Mobile
450 * Allocation to have a length of zero. We are using the
451 * msgb_l3len to calculate the length of both messages.
452 */
laforgef723cf02010-06-20 21:38:19 +0200453 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200454 len = msgb_put(msg, 1);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800455 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800456
457 if (lchan->ts->hopping.enabled)
458 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
459 lchan->ts->hopping.ma_data);
460 else
461 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800462
463 /* update the calculated size */
464 msg->l3h = len + 1;
465 *len = msgb_l3len(msg);
466
Harald Welted2dd9de2009-08-30 15:37:11 +0900467 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200468 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900469 rc = build_encr_info(encr_info, lchan);
470 if (rc > 0)
471 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
472 }
473
Harald Welteb90d7bd2009-12-17 00:31:10 +0100474 switch (act_type) {
475 case RSL_ACT_INTER_ASYNC:
476 case RSL_ACT_INTER_SYNC:
477 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
478 break;
479 default:
480 break;
481 }
482
Harald Welte59b04682009-06-10 05:40:52 +0800483 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
484 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
485 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
486
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100487 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
488 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200489 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100490
Harald Welte59b04682009-06-10 05:40:52 +0800491 msg->trx = lchan->ts->trx;
492
493 return abis_rsl_sendmsg(msg);
494}
495
Harald Welte8e770492009-07-29 11:38:15 +0200496/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800497int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
498{
499 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200500 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200501 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800502
Harald Weltee6d51f92011-06-25 10:02:33 +0200503 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800504 struct rsl_ie_chan_mode cm;
505
Harald Welte39274f42009-07-29 15:41:29 +0200506 rc = channel_mode_from_lchan(&cm, lchan);
507 if (rc < 0)
508 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800509
Harald Welteed831842009-06-27 03:09:08 +0200510 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800511 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
512 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
513 dh->chan_nr = chan_nr;
514
515 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200516 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900517
518 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200519 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900520 rc = build_encr_info(encr_info, lchan);
521 if (rc > 0)
522 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
523 }
524
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100525 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
526 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200527 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100528 }
529
Harald Welted2dd9de2009-08-30 15:37:11 +0900530 msg->trx = lchan->ts->trx;
531
532 return abis_rsl_sendmsg(msg);
533}
534
535/* Chapter 8.4.6: Send the encryption command with given L3 info */
536int rsl_encryption_cmd(struct msgb *msg)
537{
538 struct abis_rsl_dchan_hdr *dh;
539 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200540 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200541 uint8_t encr_info[MAX_A5_KEY_LEN+2];
542 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900543 int rc;
544
545 /* First push the L3 IE tag and length */
546 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
547
548 /* then the link identifier (SAPI0, main sign link) */
549 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
550
551 /* then encryption information */
552 rc = build_encr_info(encr_info, lchan);
553 if (rc <= 0)
554 return rc;
555 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
556
557 /* and finally the DCHAN header */
558 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
559 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
560 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800561
562 msg->trx = lchan->ts->trx;
563
564 return abis_rsl_sendmsg(msg);
565}
566
Harald Welte85a163c2009-08-10 11:43:22 +0200567/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200568int rsl_deact_sacch(struct gsm_lchan *lchan)
569{
570 struct abis_rsl_dchan_hdr *dh;
571 struct msgb *msg = rsl_msgb_alloc();
572
573 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
574 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200575 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200576
577 msg->lchan = lchan;
578 msg->trx = lchan->ts->trx;
579
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100580 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200581
582 return abis_rsl_sendmsg(msg);
583}
584
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800585static void error_timeout_cb(void *data)
586{
587 struct gsm_lchan *lchan = data;
588 if (lchan->state != LCHAN_S_REL_ERR) {
589 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
590 gsm_lchan_name(lchan), lchan->state);
591 return;
592 }
593
594 /* go back to the none state */
595 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800596 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800597}
598
Harald Welte08011e22011-03-04 13:41:31 +0100599static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
600
Harald Welte85a163c2009-08-10 11:43:22 +0200601/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800602static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800603{
604 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800605 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100606 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800607
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800608 if (lchan->state == LCHAN_S_REL_ERR) {
609 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
610 gsm_lchan_name(lchan));
611 return -1;
612 }
613
614 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800615 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
616 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200617 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800618
619 msg->lchan = lchan;
620 msg->trx = lchan->ts->trx;
621
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800622 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
623
624 if (error) {
625 /*
626 * the nanoBTS sends RLL release indications after the channel release. This can
627 * be a problem when we have reassigned the channel to someone else and then can
628 * not figure out who used this channel.
629 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800630 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800631 lchan->error_timer.data = lchan;
632 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200633 osmo_timer_schedule(&lchan->error_timer,
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800634 msg->trx->bts->network->T3111 + 2, 0);
635 }
Harald Welte59b04682009-06-10 05:40:52 +0800636
Harald Welte08011e22011-03-04 13:41:31 +0100637 rc = abis_rsl_sendmsg(msg);
638
Harald Welte85a163c2009-08-10 11:43:22 +0200639 /* BTS will respond by RF CHAN REL ACK */
Harald Welte6bddd822011-01-14 23:18:59 +0100640#ifdef HSL_SR_1_0
Harald Welte08011e22011-03-04 13:41:31 +0100641 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
642 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
643 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte6bddd822011-01-14 23:18:59 +0100644#endif
Harald Welte08011e22011-03-04 13:41:31 +0100645
646 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800647}
648
Harald Welte9773f6c2011-01-14 14:16:16 +0100649static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
650{
651
652 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
653
654 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
655 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
656 gsm_lchan_name(lchan),
657 gsm_lchans_name(lchan->state));
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200658 osmo_timer_del(&lchan->T3111);
Harald Welte9773f6c2011-01-14 14:16:16 +0100659 /* we have an error timer pending to release that */
660 if (lchan->state != LCHAN_S_REL_ERR)
661 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
662 lchan_free(lchan);
663
664 return 0;
665}
666
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200667int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
668 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800669{
670 struct abis_rsl_dchan_hdr *dh;
671 struct msgb *msg = rsl_msgb_alloc();
672
673 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
674 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
675 dh->chan_nr = RSL_CHAN_PCH_AGCH;
676
677 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
678 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
679 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
680
681 msg->trx = bts->c0;
682
683 return abis_rsl_sendmsg(msg);
684}
685
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200686int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800687{
688 int i, len = strlen(str_in);
689
690 for (i = 0; i < len; i++) {
691 int num = str_in[i] - 0x30;
692 if (num < 0 || num > 9)
693 return -1;
694 if (i % 2 == 0)
695 bcd_out[i/2] = num;
696 else
697 bcd_out[i/2] |= (num << 4);
698 }
699
700 return 0;
701}
702
703/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200704int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800705{
706 struct msgb *msg = rsl_msgb_alloc();
707 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200708 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800709
710 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
711 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
712 dh->chan_nr = RSL_CHAN_PCH_AGCH;
713
714 switch (bts->type) {
715 case GSM_BTS_TYPE_BS11:
716 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
717 break;
718 default:
719 /* If phase 2, construct a FULL_IMM_ASS_INFO */
720 pad_macblock(buf, val, len);
721 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
722 break;
723 }
724
725 msg->trx = bts->c0;
726
727 return abis_rsl_sendmsg(msg);
728}
729
Harald Welte4684e632009-08-10 09:51:40 +0200730/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200731int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200732{
733 struct msgb *msg = rsl_msgb_alloc();
734 struct abis_rsl_dchan_hdr *dh;
735
736 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
737 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200738 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200739 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200740 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200741
Harald Weltede4477a2009-12-24 12:20:20 +0100742 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200743 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200744
745 msg->trx = lchan->ts->trx;
746
Harald Welte4684e632009-08-10 09:51:40 +0200747 return abis_rsl_sendmsg(msg);
748}
749
750
Harald Welte59b04682009-06-10 05:40:52 +0800751/* Send "DATA REQUEST" message with given L3 Info payload */
752/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200753int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800754{
Harald Welte59b04682009-06-10 05:40:52 +0800755 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100756 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800757 return -EINVAL;
758 }
759
Harald Weltee6d51f92011-06-25 10:02:33 +0200760 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100761 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800762
763 msg->trx = msg->lchan->ts->trx;
764
765 return abis_rsl_sendmsg(msg);
766}
767
Harald Welteed9a5ab2009-08-09 13:47:35 +0200768/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
769/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200770int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200771{
Harald Weltea22d36b2010-03-04 10:33:10 +0100772 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200773
Harald Weltee6d51f92011-06-25 10:02:33 +0200774 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100775 link_id, 0);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200776 msg->trx = lchan->ts->trx;
777
778 return abis_rsl_sendmsg(msg);
779}
780
Harald Welte0f2e3c12009-08-08 13:15:07 +0200781/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
782 This is what higher layers should call. The BTS then responds with
783 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
784 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
785 lchan_free() */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200786int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200787{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200788
Harald Weltea22d36b2010-03-04 10:33:10 +0100789 struct msgb *msg;
790
Harald Weltee6d51f92011-06-25 10:02:33 +0200791 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100792 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800793 /* 0 is normal release, 1 is local end */
794 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200795
Harald Weltec88a4432009-12-29 10:44:17 +0100796 /* FIXME: start some timer in case we don't receive a REL ACK ? */
797
Harald Welte0f2e3c12009-08-08 13:15:07 +0200798 msg->trx = lchan->ts->trx;
799
800 return abis_rsl_sendmsg(msg);
801}
802
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200803int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
804{
805 lchan->state = state;
806 return 0;
807}
808
Harald Welte59b04682009-06-10 05:40:52 +0800809/* Chapter 8.4.2: Channel Activate Acknowledge */
810static int rsl_rx_chan_act_ack(struct msgb *msg)
811{
812 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
813
814 /* BTS has confirmed channel activation, we now need
815 * to assign the activated channel to the MS */
816 if (rslh->ie_chan != RSL_IE_CHAN_NR)
817 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100818
Harald Weltec88a4432009-12-29 10:44:17 +0100819 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100820 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
821 gsm_lchan_name(msg->lchan),
822 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200823 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100824
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800825 if (msg->lchan->rqd_ref) {
826 rsl_send_imm_assignment(msg->lchan);
827 talloc_free(msg->lchan->rqd_ref);
828 msg->lchan->rqd_ref = NULL;
829 msg->lchan->rqd_ta = 0;
830 }
831
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100832 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100833
Harald Welte59b04682009-06-10 05:40:52 +0800834 return 0;
835}
836
837/* Chapter 8.4.3: Channel Activate NACK */
838static int rsl_rx_chan_act_nack(struct msgb *msg)
839{
840 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
841 struct tlv_parsed tp;
842
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100843 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100844 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100845
Harald Welte59b04682009-06-10 05:40:52 +0800846 /* BTS has rejected channel activation ?!? */
847 if (dh->ie_chan != RSL_IE_CHAN_NR)
848 return -EINVAL;
849
850 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100851 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200852 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100853 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200854 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100855 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200856 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100857 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200858 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200859
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100860 LOGPC(DRSL, LOGL_ERROR, "\n");
861
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100862 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100863
Harald Weltecddb9802009-08-09 19:50:08 +0200864 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800865 return 0;
866}
867
868/* Chapter 8.4.4: Connection Failure Indication */
869static int rsl_rx_conn_fail(struct msgb *msg)
870{
871 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
872 struct tlv_parsed tp;
873
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100874 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100875 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100876 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800877
878 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
879
Harald Weltef1a168d2009-07-28 17:58:09 +0200880 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100881 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200882 TLVP_LEN(&tp, RSL_IE_CAUSE));
883
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100884 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800885 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200886 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800887 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800888}
889
Harald Weltec20bd1d2009-11-29 19:07:28 +0100890static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
891 const char *prefix)
892{
Harald Welte0e4fa782009-12-16 16:52:07 +0100893 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
894 prefix, rxlev2dbm(mru->full.rx_lev),
895 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100896 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
897 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
898}
899
900static void print_meas_rep(struct gsm_meas_rep *mr)
901{
Harald Welte0e4fa782009-12-16 16:52:07 +0100902 int i;
903
Harald Weltec20bd1d2009-11-29 19:07:28 +0100904 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
905
906 if (mr->flags & MEAS_REP_F_DL_DTX)
907 DEBUGPC(DMEAS, "DTXd ");
908
909 print_meas_rep_uni(&mr->ul, "ul");
910 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
911 if (mr->flags & MEAS_REP_F_MS_TO)
912 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
913
914 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100915 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100916 DEBUGPC(DMEAS, "L1_FPC=%u ",
917 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
918 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
919 }
920
921 if (mr->flags & MEAS_REP_F_UL_DTX)
922 DEBUGPC(DMEAS, "DTXu ");
923 if (mr->flags & MEAS_REP_F_BA1)
924 DEBUGPC(DMEAS, "BA1 ");
925 if (!(mr->flags & MEAS_REP_F_DL_VALID))
926 DEBUGPC(DMEAS, "NOT VALID ");
927 else
928 print_meas_rep_uni(&mr->dl, "dl");
929
930 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100931 if (mr->num_cell == 7)
932 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100933 for (i = 0; i < mr->num_cell; i++) {
934 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100935 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
936 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100937 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100938}
939
Harald Welte59b04682009-06-10 05:40:52 +0800940static int rsl_rx_meas_res(struct msgb *msg)
941{
942 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
943 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100944 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200945 uint8_t len;
946 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +0100947 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800948
Harald Welte4baa9c52009-12-21 13:27:11 +0100949 /* check if this channel is actually active */
950 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100951 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800952 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100953 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100954 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100955 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100956
Harald Weltef9476812009-12-15 21:36:05 +0100957 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100958 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100959
Harald Welte59b04682009-06-10 05:40:52 +0800960 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
961
Harald Weltec20bd1d2009-11-29 19:07:28 +0100962 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
963 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
964 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
965 return -EIO;
966
967 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100968 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100969
970 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
971 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
972 if (len >= 3) {
973 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +0100974 mr->flags |= MEAS_REP_F_DL_DTX;
975 mr->ul.full.rx_lev = val[0] & 0x3f;
976 mr->ul.sub.rx_lev = val[1] & 0x3f;
977 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
978 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +0800979 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100980
Harald Weltef9476812009-12-15 21:36:05 +0100981 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100982
983 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800984 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +0100985 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +0100986 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
987
Harald Weltea1467eb2009-06-20 18:44:35 +0200988 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +0100989 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100990 mr->flags |= MEAS_REP_F_MS_L1;
991 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100992 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +0100993 mr->flags |= MEAS_REP_F_FPC;
994 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +0200995 }
Harald Welte59b04682009-06-10 05:40:52 +0800996 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200997 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +0100998 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100999 if (rc < 0)
1000 return rc;
1001 }
1002
Harald Weltef9476812009-12-15 21:36:05 +01001003 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001004
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001005 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001006
Harald Welte59b04682009-06-10 05:40:52 +08001007 return 0;
1008}
1009
Harald Welte6720a432009-11-29 22:45:52 +01001010/* Chapter 8.4.7 */
1011static int rsl_rx_hando_det(struct msgb *msg)
1012{
1013 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1014 struct tlv_parsed tp;
1015
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001016 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001017
1018 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1019
1020 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1021 DEBUGPC(DRSL, "access delay = %u\n",
1022 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1023 else
1024 DEBUGPC(DRSL, "\n");
1025
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001026 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001027
1028 return 0;
1029}
1030
Harald Welte59b04682009-06-10 05:40:52 +08001031static int abis_rsl_rx_dchan(struct msgb *msg)
1032{
1033 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1034 int rc = 0;
1035 char *ts_name;
1036
1037 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001038 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001039
Harald Welte59b04682009-06-10 05:40:52 +08001040 switch (rslh->c.msg_type) {
1041 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001042 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001043 rc = rsl_rx_chan_act_ack(msg);
1044 break;
1045 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001046 rc = rsl_rx_chan_act_nack(msg);
1047 break;
1048 case RSL_MT_CONN_FAIL:
1049 rc = rsl_rx_conn_fail(msg);
1050 break;
1051 case RSL_MT_MEAS_RES:
1052 rc = rsl_rx_meas_res(msg);
1053 break;
Harald Welte6720a432009-11-29 22:45:52 +01001054 case RSL_MT_HANDO_DET:
1055 rc = rsl_rx_hando_det(msg);
1056 break;
Harald Welte59b04682009-06-10 05:40:52 +08001057 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001058 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001059 break;
1060 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001061 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001062 break;
1063 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001064 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001065 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001066 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001067 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001068 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001069 break;
1070 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001071 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001072 break;
1073 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001074 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001075 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001076 break;
1077 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001078 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001079 break;
Harald Welte59b04682009-06-10 05:40:52 +08001080 case RSL_MT_PHY_CONTEXT_CONF:
1081 case RSL_MT_PREPROC_MEAS_RES:
1082 case RSL_MT_TALKER_DET:
1083 case RSL_MT_LISTENER_DET:
1084 case RSL_MT_REMOTE_CODEC_CONF_REP:
1085 case RSL_MT_MR_CODEC_MOD_ACK:
1086 case RSL_MT_MR_CODEC_MOD_NACK:
1087 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001088 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1089 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001090 break;
1091 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001092 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1093 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001094 return -EINVAL;
1095 }
1096
1097 return rc;
1098}
1099
1100static int rsl_rx_error_rep(struct msgb *msg)
1101{
1102 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001103 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001104
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001105 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001106
1107 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1108
1109 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001110 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001111 TLVP_LEN(&tp, RSL_IE_CAUSE));
1112
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001113 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001114
1115 return 0;
1116}
1117
1118static int abis_rsl_rx_trx(struct msgb *msg)
1119{
1120 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1121 int rc = 0;
1122
1123 switch (rslh->msg_type) {
1124 case RSL_MT_ERROR_REPORT:
1125 rc = rsl_rx_error_rep(msg);
1126 break;
1127 case RSL_MT_RF_RES_IND:
1128 /* interference on idle channels of TRX */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001129 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001130 break;
1131 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001132 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001133 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1134 gsm_trx_name(msg->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001135 break;
1136 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001137 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1138 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001139 return -EINVAL;
1140 }
1141 return rc;
1142}
1143
Harald Welte427dbc42009-08-10 00:26:10 +02001144/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1145static void t3101_expired(void *data)
1146{
1147 struct gsm_lchan *lchan = data;
1148
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001149 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001150}
1151
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001152/* If T3111 expires, we will send the RF Channel Request */
1153static void t3111_expired(void *data)
1154{
1155 struct gsm_lchan *lchan = data;
1156
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001157 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001158}
1159
laforge50312e82010-06-21 12:08:52 +02001160#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1161
Harald Weltea00fdd72010-12-23 14:39:29 +01001162/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1163static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1164 unsigned int num_req_refs,
1165 struct gsm48_req_ref *rqd_refs,
1166 uint8_t wait_ind)
1167{
1168 uint8_t buf[GSM_MACBLOCK_LEN];
1169 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1170
1171 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1172 memset(iar, 0, sizeof(*iar));
1173 iar->proto_discr = GSM48_PDISC_RR;
1174 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1175 iar->page_mode = GSM48_PM_SAME;
1176
1177 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1178 iar->wait_ind1 = wait_ind;
1179
1180 if (num_req_refs >= 2)
1181 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1182 else
1183 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1184 iar->wait_ind2 = wait_ind;
1185
1186 if (num_req_refs >= 3)
1187 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1188 else
1189 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1190 iar->wait_ind3 = wait_ind;
1191
1192 if (num_req_refs >= 4)
1193 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1194 else
1195 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1196 iar->wait_ind4 = wait_ind;
1197
1198 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1199}
1200
Harald Welte59b04682009-06-10 05:40:52 +08001201/* MS has requested a channel on the RACH */
1202static int rsl_rx_chan_rqd(struct msgb *msg)
1203{
1204 struct gsm_bts *bts = msg->trx->bts;
1205 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1206 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001207 enum gsm_chan_t lctype;
1208 enum gsm_chreq_reason_t chreq_reason;
1209 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001210 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001211 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001212
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001213 uint16_t arfcn;
1214 uint8_t ts_number, subch;
Harald Welte59b04682009-06-10 05:40:52 +08001215
1216 /* parse request reference to be used in immediate assign */
1217 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1218 return -EINVAL;
1219
1220 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1221
1222 /* parse access delay and use as TA */
1223 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1224 return -EINVAL;
1225 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1226
1227 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1228 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001229 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1230 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001231
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001232 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001233
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001234 /*
1235 * We want LOCATION UPDATES to succeed and will assign a TCH
1236 * if we have no SDCCH available.
1237 */
1238 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1239
Harald Welte59b04682009-06-10 05:40:52 +08001240 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001241 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001242 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001243 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001244 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001245 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001246 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1247 if (bts->network->T3122)
1248 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001249 return -ENOMEM;
1250 }
1251
Harald Weltec88a4432009-12-29 10:44:17 +01001252 if (lchan->state != LCHAN_S_NONE)
1253 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001254 "in state %s\n", gsm_lchan_name(lchan),
1255 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001256 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001257
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001258 /* save the RACH data as we need it after the CHAN ACT ACK */
1259 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1260 if (!lchan->rqd_ref) {
1261 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1262 lchan_free(lchan);
1263 return -ENOMEM;
1264 }
1265
1266 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1267 lchan->rqd_ta = rqd_ta;
1268
Harald Welte59b04682009-06-10 05:40:52 +08001269 ts_number = lchan->ts->nr;
1270 arfcn = lchan->ts->trx->arfcn;
1271 subch = lchan->nr;
1272
Harald Welted2dd9de2009-08-30 15:37:11 +09001273 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001274 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001275 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001276 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001277 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001278
1279 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welteb90d7bd2009-12-17 00:31:10 +01001280 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001281
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001282 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1283 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1284 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1285 rqd_ref->ra);
1286 return 0;
1287}
1288
1289static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1290{
1291 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001292 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001293 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1294
Harald Welte59b04682009-06-10 05:40:52 +08001295 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001296 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001297 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001298 ia->proto_discr = GSM48_PDISC_RR;
1299 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1300 ia->page_mode = GSM48_PM_SAME;
1301 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001302
Harald Welte59b04682009-06-10 05:40:52 +08001303 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001304 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1305 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001306 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001307 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001308 } else {
laforgee06d5982010-06-20 15:18:46 +02001309 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1310 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001311 }
Harald Welte07f32182010-06-28 18:41:27 +02001312 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1313 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001314
Harald Welte427dbc42009-08-10 00:26:10 +02001315 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1316 lchan->T3101.cb = t3101_expired;
1317 lchan->T3101.data = lchan;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001318 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001319
1320 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001321 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001322}
1323
1324/* MS has requested a channel on the RACH */
1325static int rsl_rx_ccch_load(struct msgb *msg)
1326{
1327 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001328 uint16_t pg_buf_space;
1329 uint16_t rach_slot_count = -1;
1330 uint16_t rach_busy_count = -1;
1331 uint16_t rach_access_count = -1;
Harald Welte59b04682009-06-10 05:40:52 +08001332
1333 switch (rslh->data[0]) {
1334 case RSL_IE_PAGING_LOAD:
1335 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte008a4922010-04-19 10:24:07 +02001336 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1337 /* paging load below configured threshold, use 50 as default */
1338 pg_buf_space = 50;
1339 }
Harald Welte59b04682009-06-10 05:40:52 +08001340 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1341 break;
1342 case RSL_IE_RACH_LOAD:
1343 if (msg->data_len >= 7) {
1344 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1345 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1346 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1347 }
1348 break;
1349 default:
1350 break;
1351 }
1352
1353 return 0;
1354}
1355
1356static int abis_rsl_rx_cchan(struct msgb *msg)
1357{
1358 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1359 int rc = 0;
1360
1361 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1362
1363 switch (rslh->c.msg_type) {
1364 case RSL_MT_CHAN_RQD:
1365 /* MS has requested a channel on the RACH */
1366 rc = rsl_rx_chan_rqd(msg);
1367 break;
1368 case RSL_MT_CCCH_LOAD_IND:
1369 /* current load on the CCCH */
1370 rc = rsl_rx_ccch_load(msg);
1371 break;
1372 case RSL_MT_DELETE_IND:
1373 /* CCCH overloaded, IMM_ASSIGN was dropped */
1374 case RSL_MT_CBCH_LOAD_IND:
1375 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001376 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1377 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001378 break;
1379 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001380 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1381 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001382 return -EINVAL;
1383 }
1384
1385 return rc;
1386}
1387
1388static int rsl_rx_rll_err_ind(struct msgb *msg)
1389{
1390 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001391 uint8_t *rlm_cause = rllh->data;
Harald Welte59b04682009-06-10 05:40:52 +08001392
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001393 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001394 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001395 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001396
1397 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001398
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001399 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001400 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001401 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001402 }
Harald Welte692f5852009-07-04 09:40:05 +02001403
Harald Welte59b04682009-06-10 05:40:52 +08001404 return 0;
1405}
1406
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001407static void rsl_handle_release(struct gsm_lchan *lchan)
1408{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001409 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001410 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001411
1412 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001413 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001414 return;
1415
1416 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1417 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1418 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001419 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001420 gsm_lchan_name(lchan), sapi);
1421 return;
1422 }
1423
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001424
1425
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001426 /* wait a bit to send the RF Channel Release */
1427 lchan->T3111.cb = t3111_expired;
1428 lchan->T3111.data = lchan;
1429 bts = lchan->ts->trx->bts;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001430 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001431}
1432
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001433/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001434 0x02, 0x06,
1435 0x01, 0x20,
1436 0x02, 0x00,
1437 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1438
1439static int abis_rsl_rx_rll(struct msgb *msg)
1440{
1441 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1442 int rc = 0;
1443 char *ts_name;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001444 uint8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001445
1446 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001447 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001448 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001449
1450 switch (rllh->c.msg_type) {
1451 case RSL_MT_DATA_IND:
1452 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001453 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001454 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1455 rllh->data[0] == RSL_IE_L3_INFO) {
1456 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001457 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001458 }
1459 break;
1460 case RSL_MT_EST_IND:
1461 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001462 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001463 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001464 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001465 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001466 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1467 rllh->data[0] == RSL_IE_L3_INFO) {
1468 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001469 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001470 }
1471 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001472 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001473 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001474 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001475 rll_indication(msg->lchan, rllh->link_id,
1476 BSC_RLLR_IND_EST_CONF);
1477 break;
Harald Welte59b04682009-06-10 05:40:52 +08001478 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001479 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001480 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001481 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001482 rll_indication(msg->lchan, rllh->link_id,
1483 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001484 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001485 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001486 break;
1487 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001488 /* BTS informs us of having received UA from MS,
1489 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001490 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001491 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001492 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001493 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001494 break;
1495 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001496 rc = rsl_rx_rll_err_ind(msg);
1497 break;
1498 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001499 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1500 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001501 break;
1502 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001503 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1504 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001505 }
Harald Welte59b04682009-06-10 05:40:52 +08001506 return rc;
1507}
1508
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001509static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001510{
Harald Welteb284b472009-12-02 01:58:23 +05301511 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001512 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301513 switch (lchan->type) {
1514 case GSM_LCHAN_TCH_F:
1515 return 0x00;
1516 case GSM_LCHAN_TCH_H:
1517 return 0x03;
1518 default:
1519 break;
1520 }
Harald Welte98d79f92009-07-28 18:11:56 +02001521 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301522 switch (lchan->type) {
1523 case GSM_LCHAN_TCH_F:
1524 return 0x01;
1525 /* there's no half-rate EFR */
1526 default:
1527 break;
1528 }
Harald Welte98d79f92009-07-28 18:11:56 +02001529 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301530 switch (lchan->type) {
1531 case GSM_LCHAN_TCH_F:
1532 return 0x02;
1533 case GSM_LCHAN_TCH_H:
1534 return 0x05;
1535 default:
1536 break;
1537 }
1538 default:
1539 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001540 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001541 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301542 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001543 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001544}
1545
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001546static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munaut1338a552009-12-20 22:06:40 +01001547{
Holger Hans Peter Freyther6651b692010-11-14 21:09:08 +01001548 struct gsm_network *net = lchan->ts->trx->bts->network;
1549
1550 /* allow to hardcode the rtp payload */
1551 if (net->hardcoded_rtp_payload != 0)
1552 return net->hardcoded_rtp_payload;
1553
Sylvain Munaut1338a552009-12-20 22:06:40 +01001554 switch (lchan->tch_mode) {
1555 case GSM48_CMODE_SPEECH_V1:
1556 switch (lchan->type) {
1557 case GSM_LCHAN_TCH_F:
1558 return RTP_PT_GSM_FULL;
1559 case GSM_LCHAN_TCH_H:
1560 return RTP_PT_GSM_HALF;
1561 default:
1562 break;
1563 }
1564 case GSM48_CMODE_SPEECH_EFR:
1565 switch (lchan->type) {
1566 case GSM_LCHAN_TCH_F:
1567 return RTP_PT_GSM_EFR;
1568 /* there's no half-rate EFR */
1569 default:
1570 break;
1571 }
1572 case GSM48_CMODE_SPEECH_AMR:
1573 switch (lchan->type) {
1574 case GSM_LCHAN_TCH_F:
1575 return RTP_PT_AMR_FULL;
1576 case GSM_LCHAN_TCH_H:
1577 return RTP_PT_AMR_HALF;
1578 default:
1579 break;
1580 }
1581 default:
1582 break;
1583 }
1584 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1585 "tch_mode == 0x%02x\n & lchan_type == %d",
1586 lchan->tch_mode, lchan->type);
1587 return 0;
1588}
1589
Harald Welte59b04682009-06-10 05:40:52 +08001590/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001591static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1592{
1593 struct in_addr ip;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001594 uint16_t port, conn_id;
Harald Weltebffa4992009-12-19 16:42:06 +01001595
1596 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001597 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001598 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1599 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1600 }
1601
1602 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001603 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001604 port = ntohs(port);
1605 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1606 lchan->abis_ip.bound_port = port;
1607 }
1608
1609 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001610 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Weltebffa4992009-12-19 16:42:06 +01001611 conn_id = ntohs(conn_id);
1612 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1613 lchan->abis_ip.conn_id = conn_id;
1614 }
1615
1616 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1617 lchan->abis_ip.rtp_payload2 =
1618 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1619 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1620 lchan->abis_ip.rtp_payload2);
1621 }
1622
1623 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1624 lchan->abis_ip.speech_mode =
1625 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1626 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1627 lchan->abis_ip.speech_mode);
1628 }
1629
1630 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001631 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001632 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1633 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1634 }
1635
1636 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001637 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001638 port = ntohs(port);
1639 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1640 lchan->abis_ip.connect_port = port;
1641 }
1642}
1643
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001644int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001645{
1646 struct msgb *msg = rsl_msgb_alloc();
1647 struct abis_rsl_dchan_hdr *dh;
1648
1649 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001650 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001651 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001652 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001653
Harald Welte98d79f92009-07-28 18:11:56 +02001654 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001655 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001656 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001657 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001658 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001659
Sylvain Munaut1338a552009-12-20 22:06:40 +01001660 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1661 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1662 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001663
Harald Welte59b04682009-06-10 05:40:52 +08001664 msg->trx = lchan->ts->trx;
1665
1666 return abis_rsl_sendmsg(msg);
1667}
1668
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001669int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1670 uint8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001671{
1672 struct msgb *msg = rsl_msgb_alloc();
1673 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001674 uint32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001675 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001676
1677 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001678 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001679 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001680 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001681
Harald Weltebffa4992009-12-19 16:42:06 +01001682 /* we need to store these now as MDCX_ACK does not return them :( */
1683 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1684 lchan->abis_ip.connect_port = port;
1685 lchan->abis_ip.connect_ip = ip;
1686
Harald Weltefb4a9e92009-07-29 12:12:18 +02001687 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001688 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001689 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001690
Harald Welte98d79f92009-07-28 18:11:56 +02001691 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001692 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1693 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1694 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1695 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001696
Harald Weltebffa4992009-12-19 16:42:06 +01001697 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1698 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001699 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Weltebffa4992009-12-19 16:42:06 +01001700 *att_ip = ia.s_addr;
1701 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1702 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001703 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001704 if (rtp_payload2)
1705 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1706
Harald Welte59b04682009-06-10 05:40:52 +08001707 msg->trx = lchan->ts->trx;
1708
1709 return abis_rsl_sendmsg(msg);
1710}
1711
Harald Welte9947d9f2009-12-20 16:51:09 +01001712/* tell BTS to connect RTP stream to our local RTP socket */
1713int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1714{
1715 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1716 int rc;
1717
1718 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1719 ntohs(rs->rtp.sin_local.sin_port),
1720 /* FIXME: use RTP payload of bound socket, not BTS*/
1721 lchan->abis_ip.rtp_payload2);
1722
1723 return rc;
1724}
1725
Harald Welte6f40df02010-12-23 12:59:52 +01001726int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001727{
1728 struct msgb *msg = rsl_msgb_alloc();
1729 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001730 uint8_t msg_type;
Harald Welte2b361522010-03-28 14:42:09 +08001731
1732 if (act)
1733 msg_type = RSL_MT_IPAC_PDCH_ACT;
1734 else
1735 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001736
1737 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001738 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001739 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +02001740 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001741
Harald Welte6f40df02010-12-23 12:59:52 +01001742 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001743 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001744
Harald Welte6f40df02010-12-23 12:59:52 +01001745 msg->trx = ts->trx;
Harald Welteaed946e2009-10-24 10:29:22 +02001746
1747 return abis_rsl_sendmsg(msg);
1748}
1749
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001750static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001751{
1752 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1753 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301754 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001755
1756 /* the BTS has acknowledged a local bind, it now tells us the IP
1757 * address and port number to which it has bound the given logical
1758 * channel */
1759
1760 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1761 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1762 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001763 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001764 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001765 return -EINVAL;
1766 }
Harald Welte50517742009-12-20 15:42:44 +01001767
Harald Weltebffa4992009-12-19 16:42:06 +01001768 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001769
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001770 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001771
1772 return 0;
1773}
1774
Harald Weltebffa4992009-12-19 16:42:06 +01001775static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1776{
1777 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1778 struct tlv_parsed tv;
1779 struct gsm_lchan *lchan = msg->lchan;
1780
1781 /* the BTS has acknowledged a remote connect request and
1782 * it now tells us the IP address and port number to which it has
1783 * connected the given logical channel */
1784
1785 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1786 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001787 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001788
1789 return 0;
1790}
1791
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001792static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001793{
1794 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1795 struct tlv_parsed tv;
1796
1797 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001798
Harald Weltef1a168d2009-07-28 17:58:09 +02001799 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001800 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001801 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001802
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001803 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001804
Harald Welte59b04682009-06-10 05:40:52 +08001805 return 0;
1806}
1807
1808static int abis_rsl_rx_ipacc(struct msgb *msg)
1809{
1810 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001811 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001812 int rc = 0;
1813
1814 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001815 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001816
1817 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001818 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001819 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001820 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001821 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001822 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001823 /* somehow the BTS was unable to bind the lchan to its local
1824 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001825 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001826 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001827 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001828 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001829 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001830 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001831 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001832 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001833 /* somehow the BTS was unable to connect the lchan to a remote
1834 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001835 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001836 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001837 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001838 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001839 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001840 break;
1841 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001842 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001843 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001844 break;
1845 }
1846 DEBUGPC(DRSL, "\n");
1847
1848 return rc;
1849}
1850
1851
1852/* Entry-point where L2 RSL from BTS enters */
1853int abis_rsl_rcvmsg(struct msgb *msg)
1854{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001855 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001856 int rc = 0;
1857
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001858 if (!msg) {
1859 DEBUGP(DRSL, "Empty RSL msg?..\n");
1860 return -1;
1861 }
1862
1863 if (msgb_l2len(msg) < sizeof(*rslh)) {
1864 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1865 return -1;
1866 }
1867
1868 rslh = msgb_l2(msg);
1869
Harald Welte59b04682009-06-10 05:40:52 +08001870 switch (rslh->msg_discr & 0xfe) {
1871 case ABIS_RSL_MDISC_RLL:
1872 rc = abis_rsl_rx_rll(msg);
1873 break;
1874 case ABIS_RSL_MDISC_DED_CHAN:
1875 rc = abis_rsl_rx_dchan(msg);
1876 break;
1877 case ABIS_RSL_MDISC_COM_CHAN:
1878 rc = abis_rsl_rx_cchan(msg);
1879 break;
1880 case ABIS_RSL_MDISC_TRX:
1881 rc = abis_rsl_rx_trx(msg);
1882 break;
1883 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001884 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001885 rslh->msg_discr);
1886 break;
1887 case ABIS_RSL_MDISC_IPACCESS:
1888 rc = abis_rsl_rx_ipacc(msg);
1889 break;
1890 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001891 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1892 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001893 return -EINVAL;
1894 }
1895 msgb_free(msg);
1896 return rc;
1897}
1898
Harald Welte59b04682009-06-10 05:40:52 +08001899/* From Table 10.5.33 of GSM 04.08 */
1900int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1901{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301902 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1903 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1904 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001905 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301906 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1907 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001908 }
1909}
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08001910
1911int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1912 uint8_t cb_command, const uint8_t *data, int len)
1913{
1914 struct abis_rsl_dchan_hdr *dh;
1915 struct msgb *cb_cmd;
1916
1917 cb_cmd = rsl_msgb_alloc();
1918 if (!cb_cmd)
1919 return -1;
1920
1921 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1922 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1923 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1924
1925 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1926 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1927
1928 cb_cmd->trx = bts->c0;
1929
1930 return abis_rsl_sendmsg(cb_cmd);
1931}