blob: d186008d4ebf38a96e73afdebdd791044dc122d2 [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>
Harald Welte75099262009-02-16 21:12:08 +000026#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000027#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000028
Harald Welte8470bf22008-12-25 23:28:35 +000029#include <openbsc/gsm_data.h>
30#include <openbsc/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010031#include <osmocom/gsm/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000032#include <openbsc/abis_rsl.h>
33#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020034#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000035#include <openbsc/debug.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010036#include <osmocom/gsm/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000037#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000038#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010039#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010040#include <openbsc/rtp_proxy.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010041#include <osmocom/gsm/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000042
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080044
Harald Welte8470bf22008-12-25 23:28:35 +000045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000047
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080048static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
49
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010050static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
51 struct gsm_meas_rep *resp)
52{
53 struct lchan_signal_data sig;
54 sig.lchan = lchan;
55 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020056 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010057}
58
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020059static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000060{
61 /* mask off the transparent bit ? */
62 msg_type &= 0xfe;
63
Harald Welte8470bf22008-12-25 23:28:35 +000064 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000065 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000066 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000067 if (msg_type >= 0x19 && msg_type <= 0x22)
68 return ABIS_RSL_MDISC_TRX;
69 else
70 return ABIS_RSL_MDISC_COM_CHAN;
71 }
Harald Welte2d5b6382008-12-27 19:46:06 +000072 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000073 return ABIS_RSL_MDISC_DED_CHAN;
74
75 return ABIS_RSL_MDISC_LOC;
76}
77
78static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020079 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000080{
81 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
82 dh->c.msg_type = msg_type;
83 dh->ie_chan = RSL_IE_CHAN_NR;
84}
85
Harald Welte8470bf22008-12-25 23:28:35 +000086/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020087struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +000088{
89 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020090 uint8_t ts_nr = chan_nr & 0x07;
91 uint8_t cbits = chan_nr >> 3;
92 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +000093 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
94
95 if (cbits == 0x01) {
96 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020097 if (ts->pchan != GSM_PCHAN_TCH_F &&
98 ts->pchan != GSM_PCHAN_PDCH &&
99 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000101 chan_nr, ts->pchan);
102 } else if ((cbits & 0x1e) == 0x02) {
103 lch_idx = cbits & 0x1; /* TCH/H */
104 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000106 chan_nr, ts->pchan);
107 } else if ((cbits & 0x1c) == 0x04) {
108 lch_idx = cbits & 0x3; /* SDCCH/4 */
109 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000111 chan_nr, ts->pchan);
112 } else if ((cbits & 0x18) == 0x08) {
113 lch_idx = cbits & 0x7; /* SDCCH/8 */
114 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100115 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000116 chan_nr, ts->pchan);
117 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
118 lch_idx = 0;
119 if (ts->pchan != GSM_PCHAN_CCCH &&
120 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000122 chan_nr, ts->pchan);
123 /* FIXME: we should not return first sdcch4 !!! */
124 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100125 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000126 return NULL;
127 }
128
129 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800130 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800131 if (lchan->conn)
132 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000133
134 return lchan;
135}
136
Harald Welte52b1f982008-12-23 20:25:15 +0000137/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200138uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000139{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200140 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000141
142 ret = strtoull(imsi_str, NULL, 10);
143
144 return ret;
145}
146
147/* Table 5 Clause 7 TS 05.02 */
148unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
149{
150 if (!bs_ccch_sdcch_comb)
151 return 9 - bs_ag_blks_res;
152 else
153 return 3 - bs_ag_blks_res;
154}
155
156/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200157unsigned int get_ccch_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000158 unsigned int n_pag_blocks)
159{
160 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
161}
162
163/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200164unsigned int get_paging_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000165 int n_pag_blocks)
166{
167 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
168}
169
Harald Welte8470bf22008-12-25 23:28:35 +0000170static struct msgb *rsl_msgb_alloc(void)
171{
Harald Welte966636f2009-06-26 19:39:35 +0200172 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
173 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000174}
175
Harald Welte362322e2009-02-15 14:36:38 +0000176#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200177static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000178{
179 memcpy(out, in, len);
180
181 if (len < MACBLOCK_SIZE)
182 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
183}
184
Harald Welte08d91a52009-08-30 15:37:11 +0900185/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200186static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900187{
188 *out++ = lchan->encr.alg_id & 0xff;
189 if (lchan->encr.key_len)
190 memcpy(out, lchan->encr.key, lchan->encr.key_len);
191 return lchan->encr.key_len + 1;
192}
193
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200194static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200195{
Harald Welte7f93cea2009-02-23 00:02:59 +0000196 int i;
197
Harald Welte5b8ed432009-12-24 12:20:20 +0100198 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200199 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200200 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100201 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000202}
203
Harald Welte52b1f982008-12-23 20:25:15 +0000204/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200205int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
206 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000207{
208 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000209 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000210
211 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
212 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
213 dh->chan_nr = RSL_CHAN_BCCH;
214
215 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
216 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
217
Harald Weltee79769b2009-02-07 00:48:17 +0000218 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000219
220 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000221}
222
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200223int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
224 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000225{
226 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000227 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000228
229 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
230 ch->msg_discr = ABIS_RSL_MDISC_TRX;
231 ch->msg_type = RSL_MT_SACCH_FILL;
232
233 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000234 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000235
Harald Weltee79769b2009-02-07 00:48:17 +0000236 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000237
238 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000239}
240
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200241int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
242 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100243{
244 struct abis_rsl_dchan_hdr *dh;
245 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200246 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100247
248 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
249 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
250 dh->chan_nr = chan_nr;
251
252 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
253 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
254
255 msg->trx = lchan->ts->trx;
256
257 return abis_rsl_sendmsg(msg);
258}
259
Harald Weltefcd24452009-06-20 18:15:19 +0200260int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
261{
262 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200263 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200264 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200265
266 db = abs(db);
267 if (db > 30)
268 return -EINVAL;
269
Harald Welteeab33352009-06-27 03:09:08 +0200270 msg = rsl_msgb_alloc();
271
Harald Weltefcd24452009-06-20 18:15:19 +0200272 lchan->bs_power = db/2;
273 if (fpc)
274 lchan->bs_power |= 0x10;
275
276 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
277 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
278 dh->chan_nr = chan_nr;
279
280 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
281
282 msg->trx = lchan->ts->trx;
283
284 return abis_rsl_sendmsg(msg);
285}
286
Harald Weltefcd24452009-06-20 18:15:19 +0200287int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
288{
289 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200290 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200291 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200292 int ctl_lvl;
293
Harald Welte66b6a8d2009-08-09 14:45:18 +0200294 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200295 if (ctl_lvl < 0)
296 return ctl_lvl;
297
Harald Welteeab33352009-06-27 03:09:08 +0200298 msg = rsl_msgb_alloc();
299
Harald Weltefcd24452009-06-20 18:15:19 +0200300 lchan->ms_power = ctl_lvl;
301
302 if (fpc)
303 lchan->ms_power |= 0x20;
304
305 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
306 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
307 dh->chan_nr = chan_nr;
308
309 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
310
311 msg->trx = lchan->ts->trx;
312
313 return abis_rsl_sendmsg(msg);
314}
315
Harald Welte9943c5b2009-07-29 15:41:29 +0200316static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
317 struct gsm_lchan *lchan)
318{
319 memset(cm, 0, sizeof(cm));
320
321 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800322 if (lchan->ts->trx->bts->network->dtx_enabled)
323 cm->dtx_dtu = 0x03;
324 else
325 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200326
327 /* set TCH Speech/Data */
328 cm->spd_ind = lchan->rsl_cmode;
329
Harald Welte1a79d362009-11-27 08:55:16 +0100330 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
331 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100332 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100333 "but tch_mode != signalling\n");
334
Harald Welte9943c5b2009-07-29 15:41:29 +0200335 switch (lchan->type) {
336 case GSM_LCHAN_SDCCH:
337 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
338 break;
339 case GSM_LCHAN_TCH_F:
340 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
341 break;
342 case GSM_LCHAN_TCH_H:
343 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
344 break;
345 case GSM_LCHAN_NONE:
346 case GSM_LCHAN_UNKNOWN:
347 default:
348 return -EINVAL;
349 }
350
351 switch (lchan->tch_mode) {
352 case GSM48_CMODE_SIGN:
353 cm->chan_rate = 0;
354 break;
355 case GSM48_CMODE_SPEECH_V1:
356 cm->chan_rate = RSL_CMOD_SP_GSM1;
357 break;
358 case GSM48_CMODE_SPEECH_EFR:
359 cm->chan_rate = RSL_CMOD_SP_GSM2;
360 break;
361 case GSM48_CMODE_SPEECH_AMR:
362 cm->chan_rate = RSL_CMOD_SP_GSM3;
363 break;
364 case GSM48_CMODE_DATA_14k5:
365 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
366 break;
367 case GSM48_CMODE_DATA_12k0:
368 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
369 break;
370 case GSM48_CMODE_DATA_6k0:
371 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
372 break;
373 default:
374 return -EINVAL;
375 }
376
377 return 0;
378}
379
Harald Welte52b1f982008-12-23 20:25:15 +0000380/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000381#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200382int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
383 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000384 struct rsl_ie_chan_mode *chan_mode,
385 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200386 uint8_t bs_power, uint8_t ms_power,
387 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000388{
389 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000390 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000391
392 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
393 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
394 dh->chan_nr = chan_nr;
395
396 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
397 /* For compatibility with Phase 1 */
398 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200399 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000400 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200401 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000402#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000403 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200404 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000405#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000406 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000407 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
408 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
409
Harald Weltee79769b2009-02-07 00:48:17 +0000410 msg->trx = trx;
411
Harald Welte8470bf22008-12-25 23:28:35 +0000412 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000413}
Harald Welteddab3c72009-02-28 13:19:15 +0000414#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000415
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200416int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
417 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000418{
419 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200420 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200421 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200422 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000423
Harald Weltef6093a42011-06-25 10:02:33 +0200424 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000425 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200426 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000427
Harald Welte9943c5b2009-07-29 15:41:29 +0200428 rc = channel_mode_from_lchan(&cm, lchan);
429 if (rc < 0)
430 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000431
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800432 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200433 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000434
Harald Welteeab33352009-06-27 03:09:08 +0200435 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000436 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
437 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
438 dh->chan_nr = chan_nr;
439
440 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000441 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200442 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800443
444 /*
445 * The Channel Identification is needed for Phase1 phones
446 * and it contains the GSM48 Channel Description and the
447 * Mobile Allocation. The GSM 08.58 asks for the Mobile
448 * Allocation to have a length of zero. We are using the
449 * msgb_l3len to calculate the length of both messages.
450 */
laforge694a5cf2010-06-20 21:38:19 +0200451 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200452 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800453 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800454
455 if (lchan->ts->hopping.enabled)
456 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
457 lchan->ts->hopping.ma_data);
458 else
459 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800460
461 /* update the calculated size */
462 msg->l3h = len + 1;
463 *len = msgb_l3len(msg);
464
Harald Welte08d91a52009-08-30 15:37:11 +0900465 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200466 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900467 rc = build_encr_info(encr_info, lchan);
468 if (rc > 0)
469 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
470 }
471
Harald Welte8d77b952009-12-17 00:31:10 +0100472 switch (act_type) {
473 case RSL_ACT_INTER_ASYNC:
474 case RSL_ACT_INTER_SYNC:
475 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
476 break;
477 default:
478 break;
479 }
480
Harald Welted4c9bf32009-02-15 16:56:18 +0000481 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
482 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000483 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
484
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100485 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
486 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200487 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100488
Harald Weltee79769b2009-02-07 00:48:17 +0000489 msg->trx = lchan->ts->trx;
490
Harald Welte4b634542008-12-27 01:55:51 +0000491 return abis_rsl_sendmsg(msg);
492}
493
Harald Welte470abb72009-07-29 11:38:15 +0200494/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000495int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
496{
497 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200498 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200499 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000500
Harald Weltef6093a42011-06-25 10:02:33 +0200501 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000502 struct rsl_ie_chan_mode cm;
503
Harald Welte9943c5b2009-07-29 15:41:29 +0200504 rc = channel_mode_from_lchan(&cm, lchan);
505 if (rc < 0)
506 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000507
Harald Welteeab33352009-06-27 03:09:08 +0200508 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000509 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
510 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
511 dh->chan_nr = chan_nr;
512
513 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200514 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900515
516 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200517 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900518 rc = build_encr_info(encr_info, lchan);
519 if (rc > 0)
520 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
521 }
522
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100523 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
524 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200525 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100526 }
527
Harald Welte08d91a52009-08-30 15:37:11 +0900528 msg->trx = lchan->ts->trx;
529
530 return abis_rsl_sendmsg(msg);
531}
532
533/* Chapter 8.4.6: Send the encryption command with given L3 info */
534int rsl_encryption_cmd(struct msgb *msg)
535{
536 struct abis_rsl_dchan_hdr *dh;
537 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200538 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200539 uint8_t encr_info[MAX_A5_KEY_LEN+2];
540 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900541 int rc;
542
543 /* First push the L3 IE tag and length */
544 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
545
546 /* then the link identifier (SAPI0, main sign link) */
547 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
548
549 /* then encryption information */
550 rc = build_encr_info(encr_info, lchan);
551 if (rc <= 0)
552 return rc;
553 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
554
555 /* and finally the DCHAN header */
556 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
557 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
558 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000559
560 msg->trx = lchan->ts->trx;
561
562 return abis_rsl_sendmsg(msg);
563}
564
Harald Welte115d1032009-08-10 11:43:22 +0200565/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200566int rsl_deact_sacch(struct gsm_lchan *lchan)
567{
568 struct abis_rsl_dchan_hdr *dh;
569 struct msgb *msg = rsl_msgb_alloc();
570
571 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
572 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200573 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200574
575 msg->lchan = lchan;
576 msg->trx = lchan->ts->trx;
577
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100578 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200579
580 return abis_rsl_sendmsg(msg);
581}
582
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800583static void error_timeout_cb(void *data)
584{
585 struct gsm_lchan *lchan = data;
586 if (lchan->state != LCHAN_S_REL_ERR) {
587 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
588 gsm_lchan_name(lchan), lchan->state);
589 return;
590 }
591
592 /* go back to the none state */
593 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800594 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800595}
596
Harald Weltefd355a32011-03-04 13:41:31 +0100597static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
598
Harald Welte115d1032009-08-10 11:43:22 +0200599/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800600static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000601{
602 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800603 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100604 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000605
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800606 if (lchan->state == LCHAN_S_REL_ERR) {
607 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
608 gsm_lchan_name(lchan));
609 return -1;
610 }
611
612 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000613 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
614 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200615 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000616
Harald Welte8470bf22008-12-25 23:28:35 +0000617 msg->lchan = lchan;
618 msg->trx = lchan->ts->trx;
619
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800620 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
621
622 if (error) {
623 /*
624 * the nanoBTS sends RLL release indications after the channel release. This can
625 * be a problem when we have reassigned the channel to someone else and then can
626 * not figure out who used this channel.
627 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800628 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800629 lchan->error_timer.data = lchan;
630 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200631 osmo_timer_schedule(&lchan->error_timer,
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800632 msg->trx->bts->network->T3111 + 2, 0);
633 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000634
Harald Weltefd355a32011-03-04 13:41:31 +0100635 rc = abis_rsl_sendmsg(msg);
636
Harald Welte115d1032009-08-10 11:43:22 +0200637 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100638#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100639 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
640 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
641 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100642#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100643
644 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000645}
646
Harald Welte64bb7542011-01-14 14:16:16 +0100647static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
648{
649
650 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
651
652 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
653 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
654 gsm_lchan_name(lchan),
655 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200656 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100657 /* we have an error timer pending to release that */
658 if (lchan->state != LCHAN_S_REL_ERR)
659 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
660 lchan_free(lchan);
661
662 return 0;
663}
664
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200665int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
666 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000667{
668 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000669 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000670
671 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
672 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
673 dh->chan_nr = RSL_CHAN_PCH_AGCH;
674
675 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000676 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000677 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
678
Harald Welte8470bf22008-12-25 23:28:35 +0000679 msg->trx = bts->c0;
680
681 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000682}
683
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200684int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000685{
686 int i, len = strlen(str_in);
687
688 for (i = 0; i < len; i++) {
689 int num = str_in[i] - 0x30;
690 if (num < 0 || num > 9)
691 return -1;
692 if (i % 2 == 0)
693 bcd_out[i/2] = num;
694 else
695 bcd_out[i/2] |= (num << 4);
696 }
697
698 return 0;
699}
700
Harald Welte702d8702008-12-26 20:25:35 +0000701/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200702int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000703{
Harald Welte8470bf22008-12-25 23:28:35 +0000704 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000705 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200706 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000707
708 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
709 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
710 dh->chan_nr = RSL_CHAN_PCH_AGCH;
711
Harald Welte362322e2009-02-15 14:36:38 +0000712 switch (bts->type) {
713 case GSM_BTS_TYPE_BS11:
714 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
715 break;
716 default:
717 /* If phase 2, construct a FULL_IMM_ASS_INFO */
718 pad_macblock(buf, val, len);
719 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
720 break;
721 }
Harald Welte52b1f982008-12-23 20:25:15 +0000722
Harald Welte8470bf22008-12-25 23:28:35 +0000723 msg->trx = bts->c0;
724
725 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000726}
727
Harald Welte67fa91b2009-08-10 09:51:40 +0200728/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200729int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200730{
731 struct msgb *msg = rsl_msgb_alloc();
732 struct abis_rsl_dchan_hdr *dh;
733
734 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
735 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200736 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200737 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200738 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200739
Harald Welte5b8ed432009-12-24 12:20:20 +0100740 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200741 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200742
743 msg->trx = lchan->ts->trx;
744
Harald Welte67fa91b2009-08-10 09:51:40 +0200745 return abis_rsl_sendmsg(msg);
746}
747
748
Harald Welte8470bf22008-12-25 23:28:35 +0000749/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000750/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200751int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000752{
Harald Welte8470bf22008-12-25 23:28:35 +0000753 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100754 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000755 return -EINVAL;
756 }
Harald Welte52b1f982008-12-23 20:25:15 +0000757
Harald Weltef6093a42011-06-25 10:02:33 +0200758 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100759 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000760
Harald Welte8470bf22008-12-25 23:28:35 +0000761 msg->trx = msg->lchan->ts->trx;
762
763 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000764}
765
Harald Welteedcc5272009-08-09 13:47:35 +0200766/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
767/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200768int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200769{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100770 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200771
Harald Weltef6093a42011-06-25 10:02:33 +0200772 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100773 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200774 msg->trx = lchan->ts->trx;
775
776 return abis_rsl_sendmsg(msg);
777}
778
Harald Welted2dc1de2009-08-08 13:15:07 +0200779/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
780 This is what higher layers should call. The BTS then responds with
781 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
782 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
783 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200784int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200785{
Harald Welted2dc1de2009-08-08 13:15:07 +0200786
Harald Welte3c9c5f92010-03-04 10:33:10 +0100787 struct msgb *msg;
788
Harald Weltef6093a42011-06-25 10:02:33 +0200789 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100790 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800791 /* 0 is normal release, 1 is local end */
792 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200793
Harald Welte8e93b792009-12-29 10:44:17 +0100794 /* FIXME: start some timer in case we don't receive a REL ACK ? */
795
Harald Welted2dc1de2009-08-08 13:15:07 +0200796 msg->trx = lchan->ts->trx;
797
798 return abis_rsl_sendmsg(msg);
799}
800
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200801int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
802{
803 lchan->state = state;
804 return 0;
805}
806
Harald Welte702d8702008-12-26 20:25:35 +0000807/* Chapter 8.4.2: Channel Activate Acknowledge */
808static int rsl_rx_chan_act_ack(struct msgb *msg)
809{
810 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
811
812 /* BTS has confirmed channel activation, we now need
813 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000814 if (rslh->ie_chan != RSL_IE_CHAN_NR)
815 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100816
Harald Welte8e93b792009-12-29 10:44:17 +0100817 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100818 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
819 gsm_lchan_name(msg->lchan),
820 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200821 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100822
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800823 if (msg->lchan->rqd_ref) {
824 rsl_send_imm_assignment(msg->lchan);
825 talloc_free(msg->lchan->rqd_ref);
826 msg->lchan->rqd_ref = NULL;
827 msg->lchan->rqd_ta = 0;
828 }
829
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100830 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100831
Harald Welte4b634542008-12-27 01:55:51 +0000832 return 0;
833}
Harald Welte702d8702008-12-26 20:25:35 +0000834
Harald Welte4b634542008-12-27 01:55:51 +0000835/* Chapter 8.4.3: Channel Activate NACK */
836static int rsl_rx_chan_act_nack(struct msgb *msg)
837{
Harald Welte6dab0552009-05-01 17:21:37 +0000838 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
839 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000840
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100841 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100842 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100843
Harald Welte6dab0552009-05-01 17:21:37 +0000844 /* BTS has rejected channel activation ?!? */
845 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000846 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000847
848 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100849 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200850 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100851 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200852 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100853 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200854 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100855 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200856 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200857
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100858 LOGPC(DRSL, LOGL_ERROR, "\n");
859
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100860 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100861
Harald Welte3073a9f2009-08-09 19:50:08 +0200862 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000863 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000864}
865
Harald Welte7f93cea2009-02-23 00:02:59 +0000866/* Chapter 8.4.4: Connection Failure Indication */
867static int rsl_rx_conn_fail(struct msgb *msg)
868{
869 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
870 struct tlv_parsed tp;
871
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100872 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100873 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100874 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000875
876 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
877
Harald Welte8830e072009-07-28 17:58:09 +0200878 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100879 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200880 TLVP_LEN(&tp, RSL_IE_CAUSE));
881
Harald Welte (local)fc057502009-12-26 22:33:09 +0100882 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000883 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200884 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800885 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000886}
887
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100888static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
889 const char *prefix)
890{
Harald Welte6739dfb2009-12-16 16:52:07 +0100891 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
892 prefix, rxlev2dbm(mru->full.rx_lev),
893 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100894 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
895 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
896}
897
898static void print_meas_rep(struct gsm_meas_rep *mr)
899{
Harald Welte6739dfb2009-12-16 16:52:07 +0100900 int i;
901
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100902 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
903
904 if (mr->flags & MEAS_REP_F_DL_DTX)
905 DEBUGPC(DMEAS, "DTXd ");
906
907 print_meas_rep_uni(&mr->ul, "ul");
908 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
909 if (mr->flags & MEAS_REP_F_MS_TO)
910 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
911
912 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100913 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100914 DEBUGPC(DMEAS, "L1_FPC=%u ",
915 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
916 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
917 }
918
919 if (mr->flags & MEAS_REP_F_UL_DTX)
920 DEBUGPC(DMEAS, "DTXu ");
921 if (mr->flags & MEAS_REP_F_BA1)
922 DEBUGPC(DMEAS, "BA1 ");
923 if (!(mr->flags & MEAS_REP_F_DL_VALID))
924 DEBUGPC(DMEAS, "NOT VALID ");
925 else
926 print_meas_rep_uni(&mr->dl, "dl");
927
928 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100929 if (mr->num_cell == 7)
930 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100931 for (i = 0; i < mr->num_cell; i++) {
932 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100933 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
934 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100935 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100936}
937
Harald Welte440fed02009-05-01 18:43:47 +0000938static int rsl_rx_meas_res(struct msgb *msg)
939{
940 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
941 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100942 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200943 uint8_t len;
944 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100945 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000946
Harald Welteb8bfc562009-12-21 13:27:11 +0100947 /* check if this channel is actually active */
948 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100949 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800950 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100951 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100952 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100953 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100954
Harald Welted12b0fd2009-12-15 21:36:05 +0100955 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100956 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100957
Harald Welte440fed02009-05-01 18:43:47 +0000958 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
959
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100960 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
961 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
962 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
963 return -EIO;
964
965 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100966 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100967
968 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
969 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
970 if (len >= 3) {
971 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100972 mr->flags |= MEAS_REP_F_DL_DTX;
973 mr->ul.full.rx_lev = val[0] & 0x3f;
974 mr->ul.sub.rx_lev = val[1] & 0x3f;
975 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
976 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000977 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100978
Harald Welted12b0fd2009-12-15 21:36:05 +0100979 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100980
981 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000982 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100983 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100984 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
985
Harald Weltefe9af262009-06-20 18:44:35 +0200986 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100987 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100988 mr->flags |= MEAS_REP_F_MS_L1;
989 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100990 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100991 mr->flags |= MEAS_REP_F_FPC;
992 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200993 }
Harald Weltef7c43522009-06-09 20:24:21 +0000994 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200995 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100996 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100997 if (rc < 0)
998 return rc;
999 }
1000
Harald Welted12b0fd2009-12-15 21:36:05 +01001001 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001002
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001003 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001004
Harald Welte75d34a82009-05-23 06:11:13 +00001005 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001006}
1007
Harald Welted011e8b2009-11-29 22:45:52 +01001008/* Chapter 8.4.7 */
1009static int rsl_rx_hando_det(struct msgb *msg)
1010{
1011 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1012 struct tlv_parsed tp;
1013
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001014 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001015
1016 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1017
1018 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1019 DEBUGPC(DRSL, "access delay = %u\n",
1020 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1021 else
1022 DEBUGPC(DRSL, "\n");
1023
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001024 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001025
1026 return 0;
1027}
1028
Harald Welte52b1f982008-12-23 20:25:15 +00001029static int abis_rsl_rx_dchan(struct msgb *msg)
1030{
Harald Welte8470bf22008-12-25 23:28:35 +00001031 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1032 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001033 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001034
Harald Welte8470bf22008-12-25 23:28:35 +00001035 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001036 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001037
Harald Welte8470bf22008-12-25 23:28:35 +00001038 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001039 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001040 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001041 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001042 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001043 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001044 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001045 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001046 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001047 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001048 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001049 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001050 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001051 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001052 case RSL_MT_HANDO_DET:
1053 rc = rsl_rx_hando_det(msg);
1054 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001055 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001056 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001057 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001058 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001059 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001060 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001061 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001062 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001063 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001064 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001065 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001066 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001067 break;
1068 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001069 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001070 break;
1071 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001072 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001073 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001074 break;
1075 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001076 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001077 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001078 case RSL_MT_PHY_CONTEXT_CONF:
1079 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001080 case RSL_MT_TALKER_DET:
1081 case RSL_MT_LISTENER_DET:
1082 case RSL_MT_REMOTE_CODEC_CONF_REP:
1083 case RSL_MT_MR_CODEC_MOD_ACK:
1084 case RSL_MT_MR_CODEC_MOD_NACK:
1085 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001086 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1087 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001088 break;
1089 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001090 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1091 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001092 return -EINVAL;
1093 }
Harald Weltef325eb42009-02-19 17:07:39 +00001094
Harald Welte8470bf22008-12-25 23:28:35 +00001095 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001096}
1097
Harald Welte702d8702008-12-26 20:25:35 +00001098static int rsl_rx_error_rep(struct msgb *msg)
1099{
1100 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001101 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001102
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001103 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001104
1105 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1106
1107 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001108 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001109 TLVP_LEN(&tp, RSL_IE_CAUSE));
1110
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001111 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001112
1113 return 0;
1114}
1115
Harald Welte52b1f982008-12-23 20:25:15 +00001116static int abis_rsl_rx_trx(struct msgb *msg)
1117{
Harald Welte702d8702008-12-26 20:25:35 +00001118 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001119 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001120
1121 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001122 case RSL_MT_ERROR_REPORT:
1123 rc = rsl_rx_error_rep(msg);
1124 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001125 case RSL_MT_RF_RES_IND:
1126 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001127 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001128 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001129 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001130 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001131 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1132 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001133 break;
1134 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001135 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1136 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001137 return -EINVAL;
1138 }
Harald Welte8470bf22008-12-25 23:28:35 +00001139 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001140}
1141
Harald Welteb7e81162009-08-10 00:26:10 +02001142/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1143static void t3101_expired(void *data)
1144{
1145 struct gsm_lchan *lchan = data;
1146
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001147 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001148}
1149
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001150/* If T3111 expires, we will send the RF Channel Request */
1151static void t3111_expired(void *data)
1152{
1153 struct gsm_lchan *lchan = data;
1154
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001155 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001156}
1157
laforgecfa4a012010-06-21 12:08:52 +02001158#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1159
Harald Welte2862dca2010-12-23 14:39:29 +01001160/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1161static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1162 unsigned int num_req_refs,
1163 struct gsm48_req_ref *rqd_refs,
1164 uint8_t wait_ind)
1165{
1166 uint8_t buf[GSM_MACBLOCK_LEN];
1167 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1168
1169 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1170 memset(iar, 0, sizeof(*iar));
1171 iar->proto_discr = GSM48_PDISC_RR;
1172 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1173 iar->page_mode = GSM48_PM_SAME;
1174
1175 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1176 iar->wait_ind1 = wait_ind;
1177
1178 if (num_req_refs >= 2)
1179 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1180 else
1181 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1182 iar->wait_ind2 = wait_ind;
1183
1184 if (num_req_refs >= 3)
1185 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1186 else
1187 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1188 iar->wait_ind3 = wait_ind;
1189
1190 if (num_req_refs >= 4)
1191 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1192 else
1193 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1194 iar->wait_ind4 = wait_ind;
1195
1196 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1197}
1198
Harald Welte8470bf22008-12-25 23:28:35 +00001199/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001200static int rsl_rx_chan_rqd(struct msgb *msg)
1201{
Harald Welte702d8702008-12-26 20:25:35 +00001202 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001203 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1204 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001205 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001206 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001207 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001208 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001209 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001210
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001211 uint16_t arfcn;
1212 uint8_t ts_number, subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001213
Harald Welte8470bf22008-12-25 23:28:35 +00001214 /* parse request reference to be used in immediate assign */
1215 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1216 return -EINVAL;
1217
1218 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1219
1220 /* parse access delay and use as TA */
1221 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1222 return -EINVAL;
1223 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1224
1225 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1226 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001227 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1228 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001229
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001230 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001231
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001232 /*
1233 * We want LOCATION UPDATES to succeed and will assign a TCH
1234 * if we have no SDCCH available.
1235 */
1236 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1237
Harald Welte8470bf22008-12-25 23:28:35 +00001238 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001239 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001240 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001241 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001242 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001243 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001244 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1245 if (bts->network->T3122)
1246 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001247 return -ENOMEM;
1248 }
1249
Harald Welte8e93b792009-12-29 10:44:17 +01001250 if (lchan->state != LCHAN_S_NONE)
1251 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001252 "in state %s\n", gsm_lchan_name(lchan),
1253 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001254 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001255
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001256 /* save the RACH data as we need it after the CHAN ACT ACK */
1257 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1258 if (!lchan->rqd_ref) {
1259 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1260 lchan_free(lchan);
1261 return -ENOMEM;
1262 }
1263
1264 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1265 lchan->rqd_ta = rqd_ta;
1266
Harald Welte8470bf22008-12-25 23:28:35 +00001267 ts_number = lchan->ts->nr;
1268 arfcn = lchan->ts->trx->arfcn;
1269 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001270
Harald Welte08d91a52009-08-30 15:37:11 +09001271 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001272 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001273 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001274 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001275 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001276
1277 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001278 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001279
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001280 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1281 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1282 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1283 rqd_ref->ra);
1284 return 0;
1285}
1286
1287static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1288{
1289 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001290 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001291 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1292
Harald Welte52b1f982008-12-23 20:25:15 +00001293 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001294 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001295 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001296 ia->proto_discr = GSM48_PDISC_RR;
1297 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1298 ia->page_mode = GSM48_PM_SAME;
1299 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001300
Harald Welte8470bf22008-12-25 23:28:35 +00001301 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001302 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1303 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001304 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001305 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001306 } else {
laforge09108bf2010-06-20 15:18:46 +02001307 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1308 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001309 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001310 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1311 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001312
Harald Welteb7e81162009-08-10 00:26:10 +02001313 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1314 lchan->T3101.cb = t3101_expired;
1315 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001316 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001317
Harald Welte52b1f982008-12-23 20:25:15 +00001318 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001319 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001320}
1321
Harald Welteea280442009-02-02 22:29:56 +00001322/* MS has requested a channel on the RACH */
1323static int rsl_rx_ccch_load(struct msgb *msg)
1324{
1325 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001326 uint16_t pg_buf_space;
1327 uint16_t rach_slot_count = -1;
1328 uint16_t rach_busy_count = -1;
1329 uint16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001330
1331 switch (rslh->data[0]) {
1332 case RSL_IE_PAGING_LOAD:
1333 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001334 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1335 /* paging load below configured threshold, use 50 as default */
1336 pg_buf_space = 50;
1337 }
Holger Freyther392209c2009-02-10 00:06:19 +00001338 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001339 break;
1340 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001341 if (msg->data_len >= 7) {
1342 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1343 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1344 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1345 }
Harald Welteea280442009-02-02 22:29:56 +00001346 break;
1347 default:
1348 break;
1349 }
1350
1351 return 0;
1352}
1353
Harald Welte52b1f982008-12-23 20:25:15 +00001354static int abis_rsl_rx_cchan(struct msgb *msg)
1355{
Harald Welteea280442009-02-02 22:29:56 +00001356 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001357 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001358
Harald Welte8470bf22008-12-25 23:28:35 +00001359 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1360
1361 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001362 case RSL_MT_CHAN_RQD:
1363 /* MS has requested a channel on the RACH */
1364 rc = rsl_rx_chan_rqd(msg);
1365 break;
Harald Welteea280442009-02-02 22:29:56 +00001366 case RSL_MT_CCCH_LOAD_IND:
1367 /* current load on the CCCH */
1368 rc = rsl_rx_ccch_load(msg);
1369 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001370 case RSL_MT_DELETE_IND:
1371 /* CCCH overloaded, IMM_ASSIGN was dropped */
1372 case RSL_MT_CBCH_LOAD_IND:
1373 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001374 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1375 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001376 break;
1377 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001378 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1379 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001380 return -EINVAL;
1381 }
Harald Welte8470bf22008-12-25 23:28:35 +00001382
1383 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001384}
1385
Harald Welte4b634542008-12-27 01:55:51 +00001386static int rsl_rx_rll_err_ind(struct msgb *msg)
1387{
1388 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001389 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001390
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001391 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001392 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001393 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001394
1395 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001396
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001397 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001398 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001399 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001400 }
Harald Welte81543bc2009-07-04 09:40:05 +02001401
Harald Welte4b634542008-12-27 01:55:51 +00001402 return 0;
1403}
Harald Weltef325eb42009-02-19 17:07:39 +00001404
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001405static void rsl_handle_release(struct gsm_lchan *lchan)
1406{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001407 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001408 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001409
1410 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001411 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001412 return;
1413
1414 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1415 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1416 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001417 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001418 gsm_lchan_name(lchan), sapi);
1419 return;
1420 }
1421
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001422
1423
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001424 /* wait a bit to send the RF Channel Release */
1425 lchan->T3111.cb = t3111_expired;
1426 lchan->T3111.data = lchan;
1427 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001428 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001429}
1430
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001431/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001432 0x02, 0x06,
1433 0x01, 0x20,
1434 0x02, 0x00,
1435 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1436
1437static int abis_rsl_rx_rll(struct msgb *msg)
1438{
1439 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001440 int rc = 0;
1441 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001442 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001443
1444 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001445 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001446 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001447
1448 switch (rllh->c.msg_type) {
1449 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001450 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001451 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001452 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1453 rllh->data[0] == RSL_IE_L3_INFO) {
1454 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001455 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001456 }
Harald Welte52b1f982008-12-23 20:25:15 +00001457 break;
1458 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001459 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001460 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001461 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001462 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001463 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001464 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1465 rllh->data[0] == RSL_IE_L3_INFO) {
1466 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001467 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001468 }
Harald Welte52b1f982008-12-23 20:25:15 +00001469 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001470 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001471 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001472 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001473 rll_indication(msg->lchan, rllh->link_id,
1474 BSC_RLLR_IND_EST_CONF);
1475 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001476 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001477 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001478 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001479 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001480 rll_indication(msg->lchan, rllh->link_id,
1481 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001482 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001483 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001484 break;
1485 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001486 /* BTS informs us of having received UA from MS,
1487 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001488 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001489 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001490 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001491 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001492 break;
1493 case RSL_MT_ERROR_IND:
1494 rc = rsl_rx_rll_err_ind(msg);
1495 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001496 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001497 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1498 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001499 break;
1500 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001501 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1502 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001503 }
Harald Welte8470bf22008-12-25 23:28:35 +00001504 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001505}
1506
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001507static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001508{
Harald Welte0603c9d2009-12-02 01:58:23 +05301509 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001510 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301511 switch (lchan->type) {
1512 case GSM_LCHAN_TCH_F:
1513 return 0x00;
1514 case GSM_LCHAN_TCH_H:
1515 return 0x03;
1516 default:
1517 break;
1518 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001519 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301520 switch (lchan->type) {
1521 case GSM_LCHAN_TCH_F:
1522 return 0x01;
1523 /* there's no half-rate EFR */
1524 default:
1525 break;
1526 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001527 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301528 switch (lchan->type) {
1529 case GSM_LCHAN_TCH_F:
1530 return 0x02;
1531 case GSM_LCHAN_TCH_H:
1532 return 0x05;
1533 default:
1534 break;
1535 }
1536 default:
1537 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001538 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001539 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301540 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001541 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001542}
1543
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001544static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001545{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001546 struct gsm_network *net = lchan->ts->trx->bts->network;
1547
1548 /* allow to hardcode the rtp payload */
1549 if (net->hardcoded_rtp_payload != 0)
1550 return net->hardcoded_rtp_payload;
1551
Sylvain Munautb54dda42009-12-20 22:06:40 +01001552 switch (lchan->tch_mode) {
1553 case GSM48_CMODE_SPEECH_V1:
1554 switch (lchan->type) {
1555 case GSM_LCHAN_TCH_F:
1556 return RTP_PT_GSM_FULL;
1557 case GSM_LCHAN_TCH_H:
1558 return RTP_PT_GSM_HALF;
1559 default:
1560 break;
1561 }
1562 case GSM48_CMODE_SPEECH_EFR:
1563 switch (lchan->type) {
1564 case GSM_LCHAN_TCH_F:
1565 return RTP_PT_GSM_EFR;
1566 /* there's no half-rate EFR */
1567 default:
1568 break;
1569 }
1570 case GSM48_CMODE_SPEECH_AMR:
1571 switch (lchan->type) {
1572 case GSM_LCHAN_TCH_F:
1573 return RTP_PT_AMR_FULL;
1574 case GSM_LCHAN_TCH_H:
1575 return RTP_PT_AMR_HALF;
1576 default:
1577 break;
1578 }
1579 default:
1580 break;
1581 }
1582 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1583 "tch_mode == 0x%02x\n & lchan_type == %d",
1584 lchan->tch_mode, lchan->type);
1585 return 0;
1586}
1587
Harald Welte75099262009-02-16 21:12:08 +00001588/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001589static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1590{
1591 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001592 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001593
1594 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001595 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001596 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1597 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1598 }
1599
1600 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001601 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001602 port = ntohs(port);
1603 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1604 lchan->abis_ip.bound_port = port;
1605 }
1606
1607 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001608 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001609 conn_id = ntohs(conn_id);
1610 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1611 lchan->abis_ip.conn_id = conn_id;
1612 }
1613
1614 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1615 lchan->abis_ip.rtp_payload2 =
1616 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1617 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1618 lchan->abis_ip.rtp_payload2);
1619 }
1620
1621 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1622 lchan->abis_ip.speech_mode =
1623 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1624 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1625 lchan->abis_ip.speech_mode);
1626 }
1627
1628 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001629 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001630 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1631 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1632 }
1633
1634 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001635 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001636 port = ntohs(port);
1637 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1638 lchan->abis_ip.connect_port = port;
1639 }
1640}
1641
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001642int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001643{
1644 struct msgb *msg = rsl_msgb_alloc();
1645 struct abis_rsl_dchan_hdr *dh;
1646
1647 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001648 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001649 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001650 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001651
Harald Weltef4e79f22009-07-28 18:11:56 +02001652 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001653 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001654 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001655 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001656 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001657
Sylvain Munautb54dda42009-12-20 22:06:40 +01001658 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1659 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1660 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001661
Harald Welte75099262009-02-16 21:12:08 +00001662 msg->trx = lchan->ts->trx;
1663
1664 return abis_rsl_sendmsg(msg);
1665}
1666
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001667int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1668 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001669{
1670 struct msgb *msg = rsl_msgb_alloc();
1671 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001672 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001673 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001674
1675 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001676 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001677 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001678 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001679
Harald Welte5e3d91b2009-12-19 16:42:06 +01001680 /* we need to store these now as MDCX_ACK does not return them :( */
1681 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1682 lchan->abis_ip.connect_port = port;
1683 lchan->abis_ip.connect_ip = ip;
1684
Harald Welte58ca5b72009-07-29 12:12:18 +02001685 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001686 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001687 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001688
Harald Weltef4e79f22009-07-28 18:11:56 +02001689 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001690 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1691 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1692 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1693 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001694
Harald Welte5e3d91b2009-12-19 16:42:06 +01001695 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1696 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001697 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001698 *att_ip = ia.s_addr;
1699 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1700 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001701 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001702 if (rtp_payload2)
1703 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1704
Harald Welte75099262009-02-16 21:12:08 +00001705 msg->trx = lchan->ts->trx;
1706
1707 return abis_rsl_sendmsg(msg);
1708}
1709
Harald Weltea72273e2009-12-20 16:51:09 +01001710/* tell BTS to connect RTP stream to our local RTP socket */
1711int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1712{
1713 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1714 int rc;
1715
1716 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1717 ntohs(rs->rtp.sin_local.sin_port),
1718 /* FIXME: use RTP payload of bound socket, not BTS*/
1719 lchan->abis_ip.rtp_payload2);
1720
1721 return rc;
1722}
1723
Harald Welte53cd7ac2010-12-23 12:59:52 +01001724int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001725{
1726 struct msgb *msg = rsl_msgb_alloc();
1727 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001728 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001729
1730 if (act)
1731 msg_type = RSL_MT_IPAC_PDCH_ACT;
1732 else
1733 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001734
1735 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001736 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001737 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001738 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001739
Harald Welte53cd7ac2010-12-23 12:59:52 +01001740 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001741 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001742
Harald Welte53cd7ac2010-12-23 12:59:52 +01001743 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001744
1745 return abis_rsl_sendmsg(msg);
1746}
1747
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001748static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001749{
1750 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1751 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301752 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001753
1754 /* the BTS has acknowledged a local bind, it now tells us the IP
1755 * address and port number to which it has bound the given logical
1756 * channel */
1757
1758 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1759 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1760 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001761 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001762 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001763 return -EINVAL;
1764 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001765
Harald Welte5e3d91b2009-12-19 16:42:06 +01001766 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001767
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001768 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001769
Harald Welte75099262009-02-16 21:12:08 +00001770 return 0;
1771}
1772
Harald Welte5e3d91b2009-12-19 16:42:06 +01001773static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1774{
1775 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1776 struct tlv_parsed tv;
1777 struct gsm_lchan *lchan = msg->lchan;
1778
1779 /* the BTS has acknowledged a remote connect request and
1780 * it now tells us the IP address and port number to which it has
1781 * connected the given logical channel */
1782
1783 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1784 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001785 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001786
1787 return 0;
1788}
1789
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001790static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001791{
1792 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1793 struct tlv_parsed tv;
1794
1795 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001796
Harald Welte8830e072009-07-28 17:58:09 +02001797 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001798 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001799 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001800
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001801 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001802
Harald Welte75099262009-02-16 21:12:08 +00001803 return 0;
1804}
1805
1806static int abis_rsl_rx_ipacc(struct msgb *msg)
1807{
1808 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001809 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001810 int rc = 0;
1811
1812 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001813 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001814
1815 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001816 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001817 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001818 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001819 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001820 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001821 /* somehow the BTS was unable to bind the lchan to its local
1822 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001823 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001824 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001825 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001826 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001827 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001828 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001829 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001830 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001831 /* somehow the BTS was unable to connect the lchan to a remote
1832 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001833 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001834 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001835 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001836 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001837 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001838 break;
1839 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001840 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001841 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001842 break;
1843 }
Harald Welte6dab0552009-05-01 17:21:37 +00001844 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001845
1846 return rc;
1847}
1848
1849
Harald Welte52b1f982008-12-23 20:25:15 +00001850/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001851int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001852{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001853 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001854 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001855
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001856 if (!msg) {
1857 DEBUGP(DRSL, "Empty RSL msg?..\n");
1858 return -1;
1859 }
1860
1861 if (msgb_l2len(msg) < sizeof(*rslh)) {
1862 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1863 return -1;
1864 }
1865
1866 rslh = msgb_l2(msg);
1867
Harald Welte52b1f982008-12-23 20:25:15 +00001868 switch (rslh->msg_discr & 0xfe) {
1869 case ABIS_RSL_MDISC_RLL:
1870 rc = abis_rsl_rx_rll(msg);
1871 break;
1872 case ABIS_RSL_MDISC_DED_CHAN:
1873 rc = abis_rsl_rx_dchan(msg);
1874 break;
1875 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001876 rc = abis_rsl_rx_cchan(msg);
1877 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001878 case ABIS_RSL_MDISC_TRX:
1879 rc = abis_rsl_rx_trx(msg);
1880 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001881 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001882 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001883 rslh->msg_discr);
1884 break;
Harald Welte75099262009-02-16 21:12:08 +00001885 case ABIS_RSL_MDISC_IPACCESS:
1886 rc = abis_rsl_rx_ipacc(msg);
1887 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001888 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001889 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1890 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001891 return -EINVAL;
1892 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001893 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001894 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001895}
Holger Freyther3b72a892009-02-04 00:31:39 +00001896
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001897int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1898 uint8_t cb_command, const uint8_t *data, int len)
1899{
1900 struct abis_rsl_dchan_hdr *dh;
1901 struct msgb *cb_cmd;
1902
1903 cb_cmd = rsl_msgb_alloc();
1904 if (!cb_cmd)
1905 return -1;
1906
1907 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1908 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1909 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1910
1911 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1912 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1913
1914 cb_cmd->trx = bts->c0;
1915
1916 return abis_rsl_sendmsg(cb_cmd);
1917}