blob: c246213d4d94fe1568ea024a2bda363ef91a1fb5 [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 Freyther3b72a892009-02-04 00:31:39 +000048#define MAX(a, b) (a) >= (b) ? (a) : (b)
49
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080050static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
51
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010052static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
53 struct gsm_meas_rep *resp)
54{
55 struct lchan_signal_data sig;
56 sig.lchan = lchan;
57 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020058 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010059}
60
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020061static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000062{
63 /* mask off the transparent bit ? */
64 msg_type &= 0xfe;
65
Harald Welte8470bf22008-12-25 23:28:35 +000066 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000067 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000068 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000069 if (msg_type >= 0x19 && msg_type <= 0x22)
70 return ABIS_RSL_MDISC_TRX;
71 else
72 return ABIS_RSL_MDISC_COM_CHAN;
73 }
Harald Welte2d5b6382008-12-27 19:46:06 +000074 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000075 return ABIS_RSL_MDISC_DED_CHAN;
76
77 return ABIS_RSL_MDISC_LOC;
78}
79
80static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020081 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000082{
83 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
84 dh->c.msg_type = msg_type;
85 dh->ie_chan = RSL_IE_CHAN_NR;
86}
87
Harald Welte8470bf22008-12-25 23:28:35 +000088/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020089struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +000090{
91 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020092 uint8_t ts_nr = chan_nr & 0x07;
93 uint8_t cbits = chan_nr >> 3;
94 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +000095 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
96
97 if (cbits == 0x01) {
98 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020099 if (ts->pchan != GSM_PCHAN_TCH_F &&
100 ts->pchan != GSM_PCHAN_PDCH &&
101 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100102 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000103 chan_nr, ts->pchan);
104 } else if ((cbits & 0x1e) == 0x02) {
105 lch_idx = cbits & 0x1; /* TCH/H */
106 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100107 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000108 chan_nr, ts->pchan);
109 } else if ((cbits & 0x1c) == 0x04) {
110 lch_idx = cbits & 0x3; /* SDCCH/4 */
111 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100112 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000113 chan_nr, ts->pchan);
114 } else if ((cbits & 0x18) == 0x08) {
115 lch_idx = cbits & 0x7; /* SDCCH/8 */
116 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100117 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000118 chan_nr, ts->pchan);
119 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
120 lch_idx = 0;
121 if (ts->pchan != GSM_PCHAN_CCCH &&
122 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100123 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000124 chan_nr, ts->pchan);
125 /* FIXME: we should not return first sdcch4 !!! */
126 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100127 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000128 return NULL;
129 }
130
131 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800132 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800133 if (lchan->conn)
134 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000135
136 return lchan;
137}
138
Harald Welte52b1f982008-12-23 20:25:15 +0000139/* 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 +0200140uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000141{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200142 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000143
144 ret = strtoull(imsi_str, NULL, 10);
145
146 return ret;
147}
148
149/* Table 5 Clause 7 TS 05.02 */
150unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
151{
152 if (!bs_ccch_sdcch_comb)
153 return 9 - bs_ag_blks_res;
154 else
155 return 3 - bs_ag_blks_res;
156}
157
158/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200159unsigned int get_ccch_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000160 unsigned int n_pag_blocks)
161{
162 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
163}
164
165/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200166unsigned int get_paging_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000167 int n_pag_blocks)
168{
169 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
170}
171
Harald Welte8470bf22008-12-25 23:28:35 +0000172static struct msgb *rsl_msgb_alloc(void)
173{
Harald Welte966636f2009-06-26 19:39:35 +0200174 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
175 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000176}
177
Harald Welte362322e2009-02-15 14:36:38 +0000178#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200179static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000180{
181 memcpy(out, in, len);
182
183 if (len < MACBLOCK_SIZE)
184 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
185}
186
Harald Welte08d91a52009-08-30 15:37:11 +0900187/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200188static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900189{
190 *out++ = lchan->encr.alg_id & 0xff;
191 if (lchan->encr.key_len)
192 memcpy(out, lchan->encr.key, lchan->encr.key_len);
193 return lchan->encr.key_len + 1;
194}
195
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200196static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200197{
Harald Welte7f93cea2009-02-23 00:02:59 +0000198 int i;
199
Harald Welte5b8ed432009-12-24 12:20:20 +0100200 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200201 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200202 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100203 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000204}
205
Harald Welte52b1f982008-12-23 20:25:15 +0000206/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200207int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
208 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000209{
210 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000211 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000212
213 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
214 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
215 dh->chan_nr = RSL_CHAN_BCCH;
216
217 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
218 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
219
Harald Weltee79769b2009-02-07 00:48:17 +0000220 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000221
222 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000223}
224
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200225int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
226 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000227{
228 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000229 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000230
231 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
232 ch->msg_discr = ABIS_RSL_MDISC_TRX;
233 ch->msg_type = RSL_MT_SACCH_FILL;
234
235 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000236 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000237
Harald Weltee79769b2009-02-07 00:48:17 +0000238 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000239
240 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000241}
242
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200243int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
244 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100245{
246 struct abis_rsl_dchan_hdr *dh;
247 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200248 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100249
250 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
251 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
252 dh->chan_nr = chan_nr;
253
254 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
255 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
256
257 msg->trx = lchan->ts->trx;
258
259 return abis_rsl_sendmsg(msg);
260}
261
Harald Weltefcd24452009-06-20 18:15:19 +0200262int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
263{
264 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200265 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200266 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200267
268 db = abs(db);
269 if (db > 30)
270 return -EINVAL;
271
Harald Welteeab33352009-06-27 03:09:08 +0200272 msg = rsl_msgb_alloc();
273
Harald Weltefcd24452009-06-20 18:15:19 +0200274 lchan->bs_power = db/2;
275 if (fpc)
276 lchan->bs_power |= 0x10;
277
278 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
279 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
280 dh->chan_nr = chan_nr;
281
282 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
283
284 msg->trx = lchan->ts->trx;
285
286 return abis_rsl_sendmsg(msg);
287}
288
Harald Weltefcd24452009-06-20 18:15:19 +0200289int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
290{
291 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200292 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200293 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200294 int ctl_lvl;
295
Harald Welte66b6a8d2009-08-09 14:45:18 +0200296 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200297 if (ctl_lvl < 0)
298 return ctl_lvl;
299
Harald Welteeab33352009-06-27 03:09:08 +0200300 msg = rsl_msgb_alloc();
301
Harald Weltefcd24452009-06-20 18:15:19 +0200302 lchan->ms_power = ctl_lvl;
303
304 if (fpc)
305 lchan->ms_power |= 0x20;
306
307 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
308 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
309 dh->chan_nr = chan_nr;
310
311 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
312
313 msg->trx = lchan->ts->trx;
314
315 return abis_rsl_sendmsg(msg);
316}
317
Harald Welte9943c5b2009-07-29 15:41:29 +0200318static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
319 struct gsm_lchan *lchan)
320{
321 memset(cm, 0, sizeof(cm));
322
323 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800324 if (lchan->ts->trx->bts->network->dtx_enabled)
325 cm->dtx_dtu = 0x03;
326 else
327 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200328
329 /* set TCH Speech/Data */
330 cm->spd_ind = lchan->rsl_cmode;
331
Harald Welte1a79d362009-11-27 08:55:16 +0100332 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
333 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100334 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100335 "but tch_mode != signalling\n");
336
Harald Welte9943c5b2009-07-29 15:41:29 +0200337 switch (lchan->type) {
338 case GSM_LCHAN_SDCCH:
339 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
340 break;
341 case GSM_LCHAN_TCH_F:
342 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
343 break;
344 case GSM_LCHAN_TCH_H:
345 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
346 break;
347 case GSM_LCHAN_NONE:
348 case GSM_LCHAN_UNKNOWN:
349 default:
350 return -EINVAL;
351 }
352
353 switch (lchan->tch_mode) {
354 case GSM48_CMODE_SIGN:
355 cm->chan_rate = 0;
356 break;
357 case GSM48_CMODE_SPEECH_V1:
358 cm->chan_rate = RSL_CMOD_SP_GSM1;
359 break;
360 case GSM48_CMODE_SPEECH_EFR:
361 cm->chan_rate = RSL_CMOD_SP_GSM2;
362 break;
363 case GSM48_CMODE_SPEECH_AMR:
364 cm->chan_rate = RSL_CMOD_SP_GSM3;
365 break;
366 case GSM48_CMODE_DATA_14k5:
367 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
368 break;
369 case GSM48_CMODE_DATA_12k0:
370 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
371 break;
372 case GSM48_CMODE_DATA_6k0:
373 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
374 break;
375 default:
376 return -EINVAL;
377 }
378
379 return 0;
380}
381
Harald Welte52b1f982008-12-23 20:25:15 +0000382/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000383#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200384int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
385 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000386 struct rsl_ie_chan_mode *chan_mode,
387 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200388 uint8_t bs_power, uint8_t ms_power,
389 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000390{
391 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000392 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000393
394 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
395 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
396 dh->chan_nr = chan_nr;
397
398 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
399 /* For compatibility with Phase 1 */
400 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200401 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000402 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200403 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000404#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000405 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200406 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000407#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000408 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000409 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
410 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
411
Harald Weltee79769b2009-02-07 00:48:17 +0000412 msg->trx = trx;
413
Harald Welte8470bf22008-12-25 23:28:35 +0000414 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000415}
Harald Welteddab3c72009-02-28 13:19:15 +0000416#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000417
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200418int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
419 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000420{
421 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200422 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200423 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200424 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000425
Harald Weltef6093a42011-06-25 10:02:33 +0200426 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000427 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200428 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000429
Harald Welte9943c5b2009-07-29 15:41:29 +0200430 rc = channel_mode_from_lchan(&cm, lchan);
431 if (rc < 0)
432 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000433
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800434 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200435 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000436
Harald Welteeab33352009-06-27 03:09:08 +0200437 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000438 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
439 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
440 dh->chan_nr = chan_nr;
441
442 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000443 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200444 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800445
446 /*
447 * The Channel Identification is needed for Phase1 phones
448 * and it contains the GSM48 Channel Description and the
449 * Mobile Allocation. The GSM 08.58 asks for the Mobile
450 * Allocation to have a length of zero. We are using the
451 * msgb_l3len to calculate the length of both messages.
452 */
laforge694a5cf2010-06-20 21:38:19 +0200453 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200454 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800455 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800456
457 if (lchan->ts->hopping.enabled)
458 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
459 lchan->ts->hopping.ma_data);
460 else
461 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800462
463 /* update the calculated size */
464 msg->l3h = len + 1;
465 *len = msgb_l3len(msg);
466
Harald Welte08d91a52009-08-30 15:37:11 +0900467 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200468 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900469 rc = build_encr_info(encr_info, lchan);
470 if (rc > 0)
471 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
472 }
473
Harald Welte8d77b952009-12-17 00:31:10 +0100474 switch (act_type) {
475 case RSL_ACT_INTER_ASYNC:
476 case RSL_ACT_INTER_SYNC:
477 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
478 break;
479 default:
480 break;
481 }
482
Harald Welted4c9bf32009-02-15 16:56:18 +0000483 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
484 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000485 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
486
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100487 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
488 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200489 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100490
Harald Weltee79769b2009-02-07 00:48:17 +0000491 msg->trx = lchan->ts->trx;
492
Harald Welte4b634542008-12-27 01:55:51 +0000493 return abis_rsl_sendmsg(msg);
494}
495
Harald Welte470abb72009-07-29 11:38:15 +0200496/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000497int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
498{
499 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200500 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200501 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000502
Harald Weltef6093a42011-06-25 10:02:33 +0200503 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000504 struct rsl_ie_chan_mode cm;
505
Harald Welte9943c5b2009-07-29 15:41:29 +0200506 rc = channel_mode_from_lchan(&cm, lchan);
507 if (rc < 0)
508 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000509
Harald Welteeab33352009-06-27 03:09:08 +0200510 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000511 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
512 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
513 dh->chan_nr = chan_nr;
514
515 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200516 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900517
518 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200519 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900520 rc = build_encr_info(encr_info, lchan);
521 if (rc > 0)
522 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
523 }
524
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100525 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
526 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200527 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100528 }
529
Harald Welte08d91a52009-08-30 15:37:11 +0900530 msg->trx = lchan->ts->trx;
531
532 return abis_rsl_sendmsg(msg);
533}
534
535/* Chapter 8.4.6: Send the encryption command with given L3 info */
536int rsl_encryption_cmd(struct msgb *msg)
537{
538 struct abis_rsl_dchan_hdr *dh;
539 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200540 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200541 uint8_t encr_info[MAX_A5_KEY_LEN+2];
542 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900543 int rc;
544
545 /* First push the L3 IE tag and length */
546 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
547
548 /* then the link identifier (SAPI0, main sign link) */
549 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
550
551 /* then encryption information */
552 rc = build_encr_info(encr_info, lchan);
553 if (rc <= 0)
554 return rc;
555 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
556
557 /* and finally the DCHAN header */
558 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
559 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
560 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000561
562 msg->trx = lchan->ts->trx;
563
564 return abis_rsl_sendmsg(msg);
565}
566
Harald Welte115d1032009-08-10 11:43:22 +0200567/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200568int rsl_deact_sacch(struct gsm_lchan *lchan)
569{
570 struct abis_rsl_dchan_hdr *dh;
571 struct msgb *msg = rsl_msgb_alloc();
572
573 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
574 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200575 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200576
577 msg->lchan = lchan;
578 msg->trx = lchan->ts->trx;
579
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100580 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200581
582 return abis_rsl_sendmsg(msg);
583}
584
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800585static void error_timeout_cb(void *data)
586{
587 struct gsm_lchan *lchan = data;
588 if (lchan->state != LCHAN_S_REL_ERR) {
589 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
590 gsm_lchan_name(lchan), lchan->state);
591 return;
592 }
593
594 /* go back to the none state */
595 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800596 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800597}
598
Harald Weltefd355a32011-03-04 13:41:31 +0100599static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
600
Harald Welte115d1032009-08-10 11:43:22 +0200601/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800602static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000603{
604 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800605 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100606 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000607
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800608 if (lchan->state == LCHAN_S_REL_ERR) {
609 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
610 gsm_lchan_name(lchan));
611 return -1;
612 }
613
614 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000615 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
616 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200617 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000618
Harald Welte8470bf22008-12-25 23:28:35 +0000619 msg->lchan = lchan;
620 msg->trx = lchan->ts->trx;
621
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800622 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
623
624 if (error) {
625 /*
626 * the nanoBTS sends RLL release indications after the channel release. This can
627 * be a problem when we have reassigned the channel to someone else and then can
628 * not figure out who used this channel.
629 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800630 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800631 lchan->error_timer.data = lchan;
632 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200633 osmo_timer_schedule(&lchan->error_timer,
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800634 msg->trx->bts->network->T3111 + 2, 0);
635 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000636
Harald Weltefd355a32011-03-04 13:41:31 +0100637 rc = abis_rsl_sendmsg(msg);
638
Harald Welte115d1032009-08-10 11:43:22 +0200639 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100640#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100641 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
642 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
643 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100644#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100645
646 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000647}
648
Harald Welte64bb7542011-01-14 14:16:16 +0100649static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
650{
651
652 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
653
654 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
655 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
656 gsm_lchan_name(lchan),
657 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200658 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100659 /* we have an error timer pending to release that */
660 if (lchan->state != LCHAN_S_REL_ERR)
661 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
662 lchan_free(lchan);
663
664 return 0;
665}
666
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200667int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
668 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000669{
670 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000671 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000672
673 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
674 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
675 dh->chan_nr = RSL_CHAN_PCH_AGCH;
676
677 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000678 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000679 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
680
Harald Welte8470bf22008-12-25 23:28:35 +0000681 msg->trx = bts->c0;
682
683 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000684}
685
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200686int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000687{
688 int i, len = strlen(str_in);
689
690 for (i = 0; i < len; i++) {
691 int num = str_in[i] - 0x30;
692 if (num < 0 || num > 9)
693 return -1;
694 if (i % 2 == 0)
695 bcd_out[i/2] = num;
696 else
697 bcd_out[i/2] |= (num << 4);
698 }
699
700 return 0;
701}
702
Harald Welte702d8702008-12-26 20:25:35 +0000703/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200704int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000705{
Harald Welte8470bf22008-12-25 23:28:35 +0000706 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000707 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200708 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000709
710 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
711 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
712 dh->chan_nr = RSL_CHAN_PCH_AGCH;
713
Harald Welte362322e2009-02-15 14:36:38 +0000714 switch (bts->type) {
715 case GSM_BTS_TYPE_BS11:
716 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
717 break;
718 default:
719 /* If phase 2, construct a FULL_IMM_ASS_INFO */
720 pad_macblock(buf, val, len);
721 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
722 break;
723 }
Harald Welte52b1f982008-12-23 20:25:15 +0000724
Harald Welte8470bf22008-12-25 23:28:35 +0000725 msg->trx = bts->c0;
726
727 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000728}
729
Harald Welte67fa91b2009-08-10 09:51:40 +0200730/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200731int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200732{
733 struct msgb *msg = rsl_msgb_alloc();
734 struct abis_rsl_dchan_hdr *dh;
735
736 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
737 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200738 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200739 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200740 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200741
Harald Welte5b8ed432009-12-24 12:20:20 +0100742 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200743 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200744
745 msg->trx = lchan->ts->trx;
746
Harald Welte67fa91b2009-08-10 09:51:40 +0200747 return abis_rsl_sendmsg(msg);
748}
749
750
Harald Welte8470bf22008-12-25 23:28:35 +0000751/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000752/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200753int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000754{
Harald Welte8470bf22008-12-25 23:28:35 +0000755 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100756 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000757 return -EINVAL;
758 }
Harald Welte52b1f982008-12-23 20:25:15 +0000759
Harald Weltef6093a42011-06-25 10:02:33 +0200760 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100761 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000762
Harald Welte8470bf22008-12-25 23:28:35 +0000763 msg->trx = msg->lchan->ts->trx;
764
765 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000766}
767
Harald Welteedcc5272009-08-09 13:47:35 +0200768/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
769/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200770int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200771{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100772 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200773
Harald Weltef6093a42011-06-25 10:02:33 +0200774 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100775 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200776 msg->trx = lchan->ts->trx;
777
778 return abis_rsl_sendmsg(msg);
779}
780
Harald Welted2dc1de2009-08-08 13:15:07 +0200781/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
782 This is what higher layers should call. The BTS then responds with
783 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
784 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
785 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200786int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200787{
Harald Welted2dc1de2009-08-08 13:15:07 +0200788
Harald Welte3c9c5f92010-03-04 10:33:10 +0100789 struct msgb *msg;
790
Harald Weltef6093a42011-06-25 10:02:33 +0200791 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100792 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800793 /* 0 is normal release, 1 is local end */
794 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200795
Harald Welte8e93b792009-12-29 10:44:17 +0100796 /* FIXME: start some timer in case we don't receive a REL ACK ? */
797
Harald Welted2dc1de2009-08-08 13:15:07 +0200798 msg->trx = lchan->ts->trx;
799
800 return abis_rsl_sendmsg(msg);
801}
802
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200803int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
804{
805 lchan->state = state;
806 return 0;
807}
808
Harald Welte702d8702008-12-26 20:25:35 +0000809/* Chapter 8.4.2: Channel Activate Acknowledge */
810static int rsl_rx_chan_act_ack(struct msgb *msg)
811{
812 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
813
814 /* BTS has confirmed channel activation, we now need
815 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000816 if (rslh->ie_chan != RSL_IE_CHAN_NR)
817 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100818
Harald Welte8e93b792009-12-29 10:44:17 +0100819 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100820 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
821 gsm_lchan_name(msg->lchan),
822 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200823 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100824
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800825 if (msg->lchan->rqd_ref) {
826 rsl_send_imm_assignment(msg->lchan);
827 talloc_free(msg->lchan->rqd_ref);
828 msg->lchan->rqd_ref = NULL;
829 msg->lchan->rqd_ta = 0;
830 }
831
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100832 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100833
Harald Welte4b634542008-12-27 01:55:51 +0000834 return 0;
835}
Harald Welte702d8702008-12-26 20:25:35 +0000836
Harald Welte4b634542008-12-27 01:55:51 +0000837/* Chapter 8.4.3: Channel Activate NACK */
838static int rsl_rx_chan_act_nack(struct msgb *msg)
839{
Harald Welte6dab0552009-05-01 17:21:37 +0000840 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
841 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000842
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100843 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100844 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100845
Harald Welte6dab0552009-05-01 17:21:37 +0000846 /* BTS has rejected channel activation ?!? */
847 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000848 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000849
850 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100851 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200852 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100853 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200854 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100855 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200856 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100857 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200858 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200859
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100860 LOGPC(DRSL, LOGL_ERROR, "\n");
861
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100862 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100863
Harald Welte3073a9f2009-08-09 19:50:08 +0200864 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000865 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000866}
867
Harald Welte7f93cea2009-02-23 00:02:59 +0000868/* Chapter 8.4.4: Connection Failure Indication */
869static int rsl_rx_conn_fail(struct msgb *msg)
870{
871 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
872 struct tlv_parsed tp;
873
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100874 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100875 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100876 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000877
878 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
879
Harald Welte8830e072009-07-28 17:58:09 +0200880 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100881 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200882 TLVP_LEN(&tp, RSL_IE_CAUSE));
883
Harald Welte (local)fc057502009-12-26 22:33:09 +0100884 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000885 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200886 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800887 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000888}
889
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100890static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
891 const char *prefix)
892{
Harald Welte6739dfb2009-12-16 16:52:07 +0100893 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
894 prefix, rxlev2dbm(mru->full.rx_lev),
895 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100896 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
897 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
898}
899
900static void print_meas_rep(struct gsm_meas_rep *mr)
901{
Harald Welte6739dfb2009-12-16 16:52:07 +0100902 int i;
903
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100904 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
905
906 if (mr->flags & MEAS_REP_F_DL_DTX)
907 DEBUGPC(DMEAS, "DTXd ");
908
909 print_meas_rep_uni(&mr->ul, "ul");
910 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
911 if (mr->flags & MEAS_REP_F_MS_TO)
912 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
913
914 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100915 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100916 DEBUGPC(DMEAS, "L1_FPC=%u ",
917 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
918 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
919 }
920
921 if (mr->flags & MEAS_REP_F_UL_DTX)
922 DEBUGPC(DMEAS, "DTXu ");
923 if (mr->flags & MEAS_REP_F_BA1)
924 DEBUGPC(DMEAS, "BA1 ");
925 if (!(mr->flags & MEAS_REP_F_DL_VALID))
926 DEBUGPC(DMEAS, "NOT VALID ");
927 else
928 print_meas_rep_uni(&mr->dl, "dl");
929
930 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100931 if (mr->num_cell == 7)
932 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100933 for (i = 0; i < mr->num_cell; i++) {
934 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100935 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
936 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100937 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100938}
939
Harald Welte440fed02009-05-01 18:43:47 +0000940static int rsl_rx_meas_res(struct msgb *msg)
941{
942 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
943 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100944 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200945 uint8_t len;
946 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100947 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000948
Harald Welteb8bfc562009-12-21 13:27:11 +0100949 /* check if this channel is actually active */
950 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100951 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800952 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100953 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100954 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100955 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100956
Harald Welted12b0fd2009-12-15 21:36:05 +0100957 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100958 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100959
Harald Welte440fed02009-05-01 18:43:47 +0000960 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
961
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100962 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
963 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
964 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
965 return -EIO;
966
967 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100968 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100969
970 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
971 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
972 if (len >= 3) {
973 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100974 mr->flags |= MEAS_REP_F_DL_DTX;
975 mr->ul.full.rx_lev = val[0] & 0x3f;
976 mr->ul.sub.rx_lev = val[1] & 0x3f;
977 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
978 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000979 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100980
Harald Welted12b0fd2009-12-15 21:36:05 +0100981 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100982
983 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000984 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100985 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100986 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
987
Harald Weltefe9af262009-06-20 18:44:35 +0200988 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100989 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100990 mr->flags |= MEAS_REP_F_MS_L1;
991 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100992 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100993 mr->flags |= MEAS_REP_F_FPC;
994 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200995 }
Harald Weltef7c43522009-06-09 20:24:21 +0000996 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200997 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100998 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100999 if (rc < 0)
1000 return rc;
1001 }
1002
Harald Welted12b0fd2009-12-15 21:36:05 +01001003 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001004
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001005 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001006
Harald Welte75d34a82009-05-23 06:11:13 +00001007 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001008}
1009
Harald Welted011e8b2009-11-29 22:45:52 +01001010/* Chapter 8.4.7 */
1011static int rsl_rx_hando_det(struct msgb *msg)
1012{
1013 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1014 struct tlv_parsed tp;
1015
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001016 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001017
1018 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1019
1020 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1021 DEBUGPC(DRSL, "access delay = %u\n",
1022 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1023 else
1024 DEBUGPC(DRSL, "\n");
1025
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001026 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001027
1028 return 0;
1029}
1030
Harald Welte52b1f982008-12-23 20:25:15 +00001031static int abis_rsl_rx_dchan(struct msgb *msg)
1032{
Harald Welte8470bf22008-12-25 23:28:35 +00001033 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1034 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001035 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001036
Harald Welte8470bf22008-12-25 23:28:35 +00001037 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001038 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001039
Harald Welte8470bf22008-12-25 23:28:35 +00001040 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001041 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001042 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001043 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001044 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001045 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001046 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001047 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001048 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001049 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001050 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001051 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001052 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001053 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001054 case RSL_MT_HANDO_DET:
1055 rc = rsl_rx_hando_det(msg);
1056 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001057 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001058 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001059 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001060 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001061 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001062 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001063 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001064 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001065 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001066 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001067 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001068 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001069 break;
1070 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001071 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001072 break;
1073 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001074 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001075 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001076 break;
1077 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001078 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001079 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001080 case RSL_MT_PHY_CONTEXT_CONF:
1081 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001082 case RSL_MT_TALKER_DET:
1083 case RSL_MT_LISTENER_DET:
1084 case RSL_MT_REMOTE_CODEC_CONF_REP:
1085 case RSL_MT_MR_CODEC_MOD_ACK:
1086 case RSL_MT_MR_CODEC_MOD_NACK:
1087 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001088 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1089 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001090 break;
1091 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001092 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1093 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001094 return -EINVAL;
1095 }
Harald Weltef325eb42009-02-19 17:07:39 +00001096
Harald Welte8470bf22008-12-25 23:28:35 +00001097 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001098}
1099
Harald Welte702d8702008-12-26 20:25:35 +00001100static int rsl_rx_error_rep(struct msgb *msg)
1101{
1102 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001103 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001104
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001105 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001106
1107 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1108
1109 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001110 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001111 TLVP_LEN(&tp, RSL_IE_CAUSE));
1112
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001113 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001114
1115 return 0;
1116}
1117
Harald Welte52b1f982008-12-23 20:25:15 +00001118static int abis_rsl_rx_trx(struct msgb *msg)
1119{
Harald Welte702d8702008-12-26 20:25:35 +00001120 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001121 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001122
1123 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001124 case RSL_MT_ERROR_REPORT:
1125 rc = rsl_rx_error_rep(msg);
1126 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001127 case RSL_MT_RF_RES_IND:
1128 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001129 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001130 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001131 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001132 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001133 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1134 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001135 break;
1136 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001137 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1138 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001139 return -EINVAL;
1140 }
Harald Welte8470bf22008-12-25 23:28:35 +00001141 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001142}
1143
Harald Welteb7e81162009-08-10 00:26:10 +02001144/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1145static void t3101_expired(void *data)
1146{
1147 struct gsm_lchan *lchan = data;
1148
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001149 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001150}
1151
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001152/* If T3111 expires, we will send the RF Channel Request */
1153static void t3111_expired(void *data)
1154{
1155 struct gsm_lchan *lchan = data;
1156
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001157 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001158}
1159
laforgecfa4a012010-06-21 12:08:52 +02001160#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1161
Harald Welte2862dca2010-12-23 14:39:29 +01001162/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1163static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1164 unsigned int num_req_refs,
1165 struct gsm48_req_ref *rqd_refs,
1166 uint8_t wait_ind)
1167{
1168 uint8_t buf[GSM_MACBLOCK_LEN];
1169 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1170
1171 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1172 memset(iar, 0, sizeof(*iar));
1173 iar->proto_discr = GSM48_PDISC_RR;
1174 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1175 iar->page_mode = GSM48_PM_SAME;
1176
1177 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1178 iar->wait_ind1 = wait_ind;
1179
1180 if (num_req_refs >= 2)
1181 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1182 else
1183 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1184 iar->wait_ind2 = wait_ind;
1185
1186 if (num_req_refs >= 3)
1187 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1188 else
1189 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1190 iar->wait_ind3 = wait_ind;
1191
1192 if (num_req_refs >= 4)
1193 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1194 else
1195 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1196 iar->wait_ind4 = wait_ind;
1197
1198 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1199}
1200
Harald Welte8470bf22008-12-25 23:28:35 +00001201/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001202static int rsl_rx_chan_rqd(struct msgb *msg)
1203{
Harald Welte702d8702008-12-26 20:25:35 +00001204 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001205 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1206 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001207 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001208 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001209 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001210 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001211 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001212
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001213 uint16_t arfcn;
1214 uint8_t ts_number, subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001215
Harald Welte8470bf22008-12-25 23:28:35 +00001216 /* parse request reference to be used in immediate assign */
1217 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1218 return -EINVAL;
1219
1220 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1221
1222 /* parse access delay and use as TA */
1223 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1224 return -EINVAL;
1225 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1226
1227 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1228 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001229 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1230 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001231
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001232 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001233
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001234 /*
1235 * We want LOCATION UPDATES to succeed and will assign a TCH
1236 * if we have no SDCCH available.
1237 */
1238 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1239
Harald Welte8470bf22008-12-25 23:28:35 +00001240 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001241 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001242 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001243 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001244 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001245 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001246 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1247 if (bts->network->T3122)
1248 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001249 return -ENOMEM;
1250 }
1251
Harald Welte8e93b792009-12-29 10:44:17 +01001252 if (lchan->state != LCHAN_S_NONE)
1253 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001254 "in state %s\n", gsm_lchan_name(lchan),
1255 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001256 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001257
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001258 /* save the RACH data as we need it after the CHAN ACT ACK */
1259 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1260 if (!lchan->rqd_ref) {
1261 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1262 lchan_free(lchan);
1263 return -ENOMEM;
1264 }
1265
1266 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1267 lchan->rqd_ta = rqd_ta;
1268
Harald Welte8470bf22008-12-25 23:28:35 +00001269 ts_number = lchan->ts->nr;
1270 arfcn = lchan->ts->trx->arfcn;
1271 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001272
Harald Welte08d91a52009-08-30 15:37:11 +09001273 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001274 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001275 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001276 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001277 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001278
1279 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001280 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001281
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001282 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1283 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1284 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1285 rqd_ref->ra);
1286 return 0;
1287}
1288
1289static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1290{
1291 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001292 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001293 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1294
Harald Welte52b1f982008-12-23 20:25:15 +00001295 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001296 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001297 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001298 ia->proto_discr = GSM48_PDISC_RR;
1299 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1300 ia->page_mode = GSM48_PM_SAME;
1301 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001302
Harald Welte8470bf22008-12-25 23:28:35 +00001303 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001304 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1305 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001306 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001307 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001308 } else {
laforge09108bf2010-06-20 15:18:46 +02001309 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1310 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001311 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001312 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1313 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001314
Harald Welteb7e81162009-08-10 00:26:10 +02001315 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1316 lchan->T3101.cb = t3101_expired;
1317 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001318 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001319
Harald Welte52b1f982008-12-23 20:25:15 +00001320 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001321 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001322}
1323
Harald Welteea280442009-02-02 22:29:56 +00001324/* MS has requested a channel on the RACH */
1325static int rsl_rx_ccch_load(struct msgb *msg)
1326{
1327 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001328 uint16_t pg_buf_space;
1329 uint16_t rach_slot_count = -1;
1330 uint16_t rach_busy_count = -1;
1331 uint16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001332
1333 switch (rslh->data[0]) {
1334 case RSL_IE_PAGING_LOAD:
1335 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001336 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1337 /* paging load below configured threshold, use 50 as default */
1338 pg_buf_space = 50;
1339 }
Holger Freyther392209c2009-02-10 00:06:19 +00001340 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001341 break;
1342 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001343 if (msg->data_len >= 7) {
1344 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1345 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1346 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1347 }
Harald Welteea280442009-02-02 22:29:56 +00001348 break;
1349 default:
1350 break;
1351 }
1352
1353 return 0;
1354}
1355
Harald Welte52b1f982008-12-23 20:25:15 +00001356static int abis_rsl_rx_cchan(struct msgb *msg)
1357{
Harald Welteea280442009-02-02 22:29:56 +00001358 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001359 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001360
Harald Welte8470bf22008-12-25 23:28:35 +00001361 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1362
1363 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001364 case RSL_MT_CHAN_RQD:
1365 /* MS has requested a channel on the RACH */
1366 rc = rsl_rx_chan_rqd(msg);
1367 break;
Harald Welteea280442009-02-02 22:29:56 +00001368 case RSL_MT_CCCH_LOAD_IND:
1369 /* current load on the CCCH */
1370 rc = rsl_rx_ccch_load(msg);
1371 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001372 case RSL_MT_DELETE_IND:
1373 /* CCCH overloaded, IMM_ASSIGN was dropped */
1374 case RSL_MT_CBCH_LOAD_IND:
1375 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001376 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1377 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001378 break;
1379 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001380 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1381 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001382 return -EINVAL;
1383 }
Harald Welte8470bf22008-12-25 23:28:35 +00001384
1385 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001386}
1387
Harald Welte4b634542008-12-27 01:55:51 +00001388static int rsl_rx_rll_err_ind(struct msgb *msg)
1389{
1390 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001391 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001392
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001393 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001394 gsm_lchan_name(msg->lchan),
Harald Weltee95daf192010-03-25 12:13:02 +08001395 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001396
1397 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001398
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001399 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001400 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001401 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001402 }
Harald Welte81543bc2009-07-04 09:40:05 +02001403
Harald Welte4b634542008-12-27 01:55:51 +00001404 return 0;
1405}
Harald Weltef325eb42009-02-19 17:07:39 +00001406
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001407static void rsl_handle_release(struct gsm_lchan *lchan)
1408{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001409 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001410 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001411
1412 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001413 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001414 return;
1415
1416 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1417 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1418 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001419 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001420 gsm_lchan_name(lchan), sapi);
1421 return;
1422 }
1423
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001424
1425
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001426 /* wait a bit to send the RF Channel Release */
1427 lchan->T3111.cb = t3111_expired;
1428 lchan->T3111.data = lchan;
1429 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001430 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001431}
1432
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001433/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001434 0x02, 0x06,
1435 0x01, 0x20,
1436 0x02, 0x00,
1437 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1438
1439static int abis_rsl_rx_rll(struct msgb *msg)
1440{
1441 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001442 int rc = 0;
1443 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001444 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001445
1446 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001447 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001448 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001449
1450 switch (rllh->c.msg_type) {
1451 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001452 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001453 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001454 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1455 rllh->data[0] == RSL_IE_L3_INFO) {
1456 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001457 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001458 }
Harald Welte52b1f982008-12-23 20:25:15 +00001459 break;
1460 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001461 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001462 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001463 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001464 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001465 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001466 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1467 rllh->data[0] == RSL_IE_L3_INFO) {
1468 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001469 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001470 }
Harald Welte52b1f982008-12-23 20:25:15 +00001471 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001472 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001473 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001474 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001475 rll_indication(msg->lchan, rllh->link_id,
1476 BSC_RLLR_IND_EST_CONF);
1477 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001478 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001479 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001480 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001481 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001482 rll_indication(msg->lchan, rllh->link_id,
1483 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001484 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001485 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001486 break;
1487 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001488 /* BTS informs us of having received UA from MS,
1489 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001490 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001491 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001492 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001493 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001494 break;
1495 case RSL_MT_ERROR_IND:
1496 rc = rsl_rx_rll_err_ind(msg);
1497 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001498 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001499 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1500 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001501 break;
1502 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001503 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1504 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001505 }
Harald Welte8470bf22008-12-25 23:28:35 +00001506 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001507}
1508
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001509static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001510{
Harald Welte0603c9d2009-12-02 01:58:23 +05301511 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001512 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301513 switch (lchan->type) {
1514 case GSM_LCHAN_TCH_F:
1515 return 0x00;
1516 case GSM_LCHAN_TCH_H:
1517 return 0x03;
1518 default:
1519 break;
1520 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001521 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301522 switch (lchan->type) {
1523 case GSM_LCHAN_TCH_F:
1524 return 0x01;
1525 /* there's no half-rate EFR */
1526 default:
1527 break;
1528 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001529 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301530 switch (lchan->type) {
1531 case GSM_LCHAN_TCH_F:
1532 return 0x02;
1533 case GSM_LCHAN_TCH_H:
1534 return 0x05;
1535 default:
1536 break;
1537 }
1538 default:
1539 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001540 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001541 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301542 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001543 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001544}
1545
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001546static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001547{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001548 struct gsm_network *net = lchan->ts->trx->bts->network;
1549
1550 /* allow to hardcode the rtp payload */
1551 if (net->hardcoded_rtp_payload != 0)
1552 return net->hardcoded_rtp_payload;
1553
Sylvain Munautb54dda42009-12-20 22:06:40 +01001554 switch (lchan->tch_mode) {
1555 case GSM48_CMODE_SPEECH_V1:
1556 switch (lchan->type) {
1557 case GSM_LCHAN_TCH_F:
1558 return RTP_PT_GSM_FULL;
1559 case GSM_LCHAN_TCH_H:
1560 return RTP_PT_GSM_HALF;
1561 default:
1562 break;
1563 }
1564 case GSM48_CMODE_SPEECH_EFR:
1565 switch (lchan->type) {
1566 case GSM_LCHAN_TCH_F:
1567 return RTP_PT_GSM_EFR;
1568 /* there's no half-rate EFR */
1569 default:
1570 break;
1571 }
1572 case GSM48_CMODE_SPEECH_AMR:
1573 switch (lchan->type) {
1574 case GSM_LCHAN_TCH_F:
1575 return RTP_PT_AMR_FULL;
1576 case GSM_LCHAN_TCH_H:
1577 return RTP_PT_AMR_HALF;
1578 default:
1579 break;
1580 }
1581 default:
1582 break;
1583 }
1584 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1585 "tch_mode == 0x%02x\n & lchan_type == %d",
1586 lchan->tch_mode, lchan->type);
1587 return 0;
1588}
1589
Harald Welte75099262009-02-16 21:12:08 +00001590/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001591static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1592{
1593 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001594 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001595
1596 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001597 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001598 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1599 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1600 }
1601
1602 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001603 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001604 port = ntohs(port);
1605 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1606 lchan->abis_ip.bound_port = port;
1607 }
1608
1609 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001610 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001611 conn_id = ntohs(conn_id);
1612 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1613 lchan->abis_ip.conn_id = conn_id;
1614 }
1615
1616 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1617 lchan->abis_ip.rtp_payload2 =
1618 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1619 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1620 lchan->abis_ip.rtp_payload2);
1621 }
1622
1623 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1624 lchan->abis_ip.speech_mode =
1625 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1626 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1627 lchan->abis_ip.speech_mode);
1628 }
1629
1630 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001631 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001632 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1633 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1634 }
1635
1636 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001637 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001638 port = ntohs(port);
1639 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1640 lchan->abis_ip.connect_port = port;
1641 }
1642}
1643
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001644int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001645{
1646 struct msgb *msg = rsl_msgb_alloc();
1647 struct abis_rsl_dchan_hdr *dh;
1648
1649 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001650 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001651 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001652 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001653
Harald Weltef4e79f22009-07-28 18:11:56 +02001654 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001655 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001656 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001657 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001658 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001659
Sylvain Munautb54dda42009-12-20 22:06:40 +01001660 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1661 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1662 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001663
Harald Welte75099262009-02-16 21:12:08 +00001664 msg->trx = lchan->ts->trx;
1665
1666 return abis_rsl_sendmsg(msg);
1667}
1668
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001669int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1670 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001671{
1672 struct msgb *msg = rsl_msgb_alloc();
1673 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001674 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001675 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001676
1677 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001678 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001679 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001680 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001681
Harald Welte5e3d91b2009-12-19 16:42:06 +01001682 /* we need to store these now as MDCX_ACK does not return them :( */
1683 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1684 lchan->abis_ip.connect_port = port;
1685 lchan->abis_ip.connect_ip = ip;
1686
Harald Welte58ca5b72009-07-29 12:12:18 +02001687 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001688 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001689 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001690
Harald Weltef4e79f22009-07-28 18:11:56 +02001691 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001692 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1693 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1694 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1695 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001696
Harald Welte5e3d91b2009-12-19 16:42:06 +01001697 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1698 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001699 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001700 *att_ip = ia.s_addr;
1701 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1702 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001703 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001704 if (rtp_payload2)
1705 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1706
Harald Welte75099262009-02-16 21:12:08 +00001707 msg->trx = lchan->ts->trx;
1708
1709 return abis_rsl_sendmsg(msg);
1710}
1711
Harald Weltea72273e2009-12-20 16:51:09 +01001712/* tell BTS to connect RTP stream to our local RTP socket */
1713int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1714{
1715 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1716 int rc;
1717
1718 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1719 ntohs(rs->rtp.sin_local.sin_port),
1720 /* FIXME: use RTP payload of bound socket, not BTS*/
1721 lchan->abis_ip.rtp_payload2);
1722
1723 return rc;
1724}
1725
Harald Welte53cd7ac2010-12-23 12:59:52 +01001726int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001727{
1728 struct msgb *msg = rsl_msgb_alloc();
1729 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001730 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001731
1732 if (act)
1733 msg_type = RSL_MT_IPAC_PDCH_ACT;
1734 else
1735 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001736
1737 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001738 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001739 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001740 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001741
Harald Welte53cd7ac2010-12-23 12:59:52 +01001742 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001743 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001744
Harald Welte53cd7ac2010-12-23 12:59:52 +01001745 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001746
1747 return abis_rsl_sendmsg(msg);
1748}
1749
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001750static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001751{
1752 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1753 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301754 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001755
1756 /* the BTS has acknowledged a local bind, it now tells us the IP
1757 * address and port number to which it has bound the given logical
1758 * channel */
1759
1760 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1761 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1762 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001763 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001764 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001765 return -EINVAL;
1766 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001767
Harald Welte5e3d91b2009-12-19 16:42:06 +01001768 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001769
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001770 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001771
Harald Welte75099262009-02-16 21:12:08 +00001772 return 0;
1773}
1774
Harald Welte5e3d91b2009-12-19 16:42:06 +01001775static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1776{
1777 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1778 struct tlv_parsed tv;
1779 struct gsm_lchan *lchan = msg->lchan;
1780
1781 /* the BTS has acknowledged a remote connect request and
1782 * it now tells us the IP address and port number to which it has
1783 * connected the given logical channel */
1784
1785 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1786 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001787 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001788
1789 return 0;
1790}
1791
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001792static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001793{
1794 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1795 struct tlv_parsed tv;
1796
1797 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001798
Harald Welte8830e072009-07-28 17:58:09 +02001799 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001800 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001801 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001802
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001803 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001804
Harald Welte75099262009-02-16 21:12:08 +00001805 return 0;
1806}
1807
1808static int abis_rsl_rx_ipacc(struct msgb *msg)
1809{
1810 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001811 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001812 int rc = 0;
1813
1814 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001815 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001816
1817 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001818 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001819 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001820 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001821 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001822 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001823 /* somehow the BTS was unable to bind the lchan to its local
1824 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001825 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001826 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001827 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001828 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001829 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001830 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001831 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001832 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001833 /* somehow the BTS was unable to connect the lchan to a remote
1834 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001835 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001836 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001837 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001838 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001839 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001840 break;
1841 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001842 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001843 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001844 break;
1845 }
Harald Welte6dab0552009-05-01 17:21:37 +00001846 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001847
1848 return rc;
1849}
1850
1851
Harald Welte52b1f982008-12-23 20:25:15 +00001852/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001853int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001854{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001855 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001856 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001857
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001858 if (!msg) {
1859 DEBUGP(DRSL, "Empty RSL msg?..\n");
1860 return -1;
1861 }
1862
1863 if (msgb_l2len(msg) < sizeof(*rslh)) {
1864 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1865 return -1;
1866 }
1867
1868 rslh = msgb_l2(msg);
1869
Harald Welte52b1f982008-12-23 20:25:15 +00001870 switch (rslh->msg_discr & 0xfe) {
1871 case ABIS_RSL_MDISC_RLL:
1872 rc = abis_rsl_rx_rll(msg);
1873 break;
1874 case ABIS_RSL_MDISC_DED_CHAN:
1875 rc = abis_rsl_rx_dchan(msg);
1876 break;
1877 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001878 rc = abis_rsl_rx_cchan(msg);
1879 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001880 case ABIS_RSL_MDISC_TRX:
1881 rc = abis_rsl_rx_trx(msg);
1882 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001883 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001884 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001885 rslh->msg_discr);
1886 break;
Harald Welte75099262009-02-16 21:12:08 +00001887 case ABIS_RSL_MDISC_IPACCESS:
1888 rc = abis_rsl_rx_ipacc(msg);
1889 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001890 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001891 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1892 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001893 return -EINVAL;
1894 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001895 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001896 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001897}
Holger Freyther3b72a892009-02-04 00:31:39 +00001898
Holger Freyther3b72a892009-02-04 00:31:39 +00001899/* From Table 10.5.33 of GSM 04.08 */
1900int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1901{
Harald Weltea43f7892009-12-01 18:04:30 +05301902 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1903 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1904 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001905 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301906 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1907 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001908 }
1909}
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001910
1911int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1912 uint8_t cb_command, const uint8_t *data, int len)
1913{
1914 struct abis_rsl_dchan_hdr *dh;
1915 struct msgb *cb_cmd;
1916
1917 cb_cmd = rsl_msgb_alloc();
1918 if (!cb_cmd)
1919 return -1;
1920
1921 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1922 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1923 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1924
1925 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1926 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1927
1928 cb_cmd->trx = bts->c0;
1929
1930 return abis_rsl_sendmsg(cb_cmd);
1931}