blob: 41289ddd81a9da394cb467fd36c56f73c0ea96b8 [file] [log] [blame]
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte59b04682009-06-10 05:40:52 +08002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Weltea22d36b2010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freythere38af682011-12-27 22:24:17 +01005 * (C) 2012 by Holger Hans Peter Freyther
Harald Welte59b04682009-06-10 05:40:52 +08006 *
7 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
Harald Welte0e3e88e2011-01-01 15:25:50 +010010 * it under the terms of the GNU Affero General Public License as published by
11 * the Free Software Foundation; either version 3 of the License, or
Harald Welte59b04682009-06-10 05:40:52 +080012 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte0e3e88e2011-01-01 15:25:50 +010017 * GNU Affero General Public License for more details.
Harald Welte59b04682009-06-10 05:40:52 +080018 *
Harald Welte0e3e88e2011-01-01 15:25:50 +010019 * You should have received a copy of the GNU Affero General Public License
20 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte59b04682009-06-10 05:40:52 +080021 *
22 */
23
24#include <stdio.h>
25#include <stdlib.h>
26#include <errno.h>
Harald Welte59b04682009-06-10 05:40:52 +080027#include <netinet/in.h>
28#include <arpa/inet.h>
29
30#include <openbsc/gsm_data.h>
31#include <openbsc/gsm_04_08.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010032#include <osmocom/gsm/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080033#include <openbsc/abis_rsl.h>
34#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020035#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080036#include <openbsc/debug.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010037#include <osmocom/gsm/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080038#include <openbsc/paging.h>
39#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010040#include <openbsc/meas_rep.h>
Harald Welte50517742009-12-20 15:42:44 +010041#include <openbsc/rtp_proxy.h>
Pablo Neira Ayuso42e41df2011-08-17 22:44:07 +020042#include <osmocom/abis/e1_input.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010043#include <osmocom/gsm/rsl.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010044#include <osmocom/core/talloc.h>
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080045
Harald Welte59b04682009-06-10 05:40:52 +080046#define RSL_ALLOC_SIZE 1024
47#define RSL_ALLOC_HEADROOM 128
48
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +010049enum sacch_deact {
50 SACCH_NONE,
51 SACCH_DEACTIVATE,
52};
53
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080054static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
Holger Hans Peter Freytherda9fb8c2014-04-06 12:21:05 +020055static void error_timeout_cb(void *data);
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080056
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010057static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
58 struct gsm_meas_rep *resp)
59{
60 struct lchan_signal_data sig;
61 sig.lchan = lchan;
62 sig.mr = resp;
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +020063 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010064}
65
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +010066static void do_lchan_free(struct gsm_lchan *lchan)
67{
Holger Hans Peter Freytherda9fb8c2014-04-06 12:21:05 +020068 /* We start the error timer to make the channel available again */
69 if (lchan->state == LCHAN_S_REL_ERR) {
70 lchan->error_timer.data = lchan;
71 lchan->error_timer.cb = error_timeout_cb;
72 osmo_timer_schedule(&lchan->error_timer,
73 lchan->ts->trx->bts->network->T3111 + 2, 0);
74 } else {
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +010075 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freytherda9fb8c2014-04-06 12:21:05 +020076 }
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +010077 lchan_free(lchan);
78}
79
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020080static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080081{
82 /* mask off the transparent bit ? */
83 msg_type &= 0xfe;
84
85 if ((msg_type & 0xf0) == 0x00)
86 return ABIS_RSL_MDISC_RLL;
87 if ((msg_type & 0xf0) == 0x10) {
88 if (msg_type >= 0x19 && msg_type <= 0x22)
89 return ABIS_RSL_MDISC_TRX;
90 else
91 return ABIS_RSL_MDISC_COM_CHAN;
92 }
93 if ((msg_type & 0xe0) == 0x20)
94 return ABIS_RSL_MDISC_DED_CHAN;
95
96 return ABIS_RSL_MDISC_LOC;
97}
98
99static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200100 uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +0800101{
102 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
103 dh->c.msg_type = msg_type;
104 dh->ie_chan = RSL_IE_CHAN_NR;
105}
106
Harald Welte59b04682009-06-10 05:40:52 +0800107/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200108struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte59b04682009-06-10 05:40:52 +0800109{
110 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200111 uint8_t ts_nr = chan_nr & 0x07;
112 uint8_t cbits = chan_nr >> 3;
113 uint8_t lch_idx;
Harald Welte59b04682009-06-10 05:40:52 +0800114 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
115
116 if (cbits == 0x01) {
117 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +0200118 if (ts->pchan != GSM_PCHAN_TCH_F &&
119 ts->pchan != GSM_PCHAN_PDCH &&
120 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800122 chan_nr, ts->pchan);
123 } else if ((cbits & 0x1e) == 0x02) {
124 lch_idx = cbits & 0x1; /* TCH/H */
125 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100126 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800127 chan_nr, ts->pchan);
128 } else if ((cbits & 0x1c) == 0x04) {
129 lch_idx = cbits & 0x3; /* SDCCH/4 */
Harald Weltebf4ba722014-12-28 15:00:45 +0100130 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4 &&
131 ts->pchan != GSM_PCHAN_CCCH_SDCCH4_CBCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100132 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800133 chan_nr, ts->pchan);
134 } else if ((cbits & 0x18) == 0x08) {
135 lch_idx = cbits & 0x7; /* SDCCH/8 */
Harald Weltebf4ba722014-12-28 15:00:45 +0100136 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C &&
137 ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C_CBCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100138 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800139 chan_nr, ts->pchan);
140 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
141 lch_idx = 0;
142 if (ts->pchan != GSM_PCHAN_CCCH &&
Harald Weltebf4ba722014-12-28 15:00:45 +0100143 ts->pchan != GSM_PCHAN_CCCH_SDCCH4 &&
144 ts->pchan != GSM_PCHAN_CCCH_SDCCH4_CBCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100145 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800146 chan_nr, ts->pchan);
147 /* FIXME: we should not return first sdcch4 !!! */
148 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100149 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800150 return NULL;
151 }
152
153 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800154 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800155 if (lchan->conn)
156 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800157
158 return lchan;
159}
160
Harald Welte59b04682009-06-10 05:40:52 +0800161/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200162uint64_t str_to_imsi(const char *imsi_str)
Harald Welte59b04682009-06-10 05:40:52 +0800163{
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200164 uint64_t ret;
Harald Welte59b04682009-06-10 05:40:52 +0800165
166 ret = strtoull(imsi_str, NULL, 10);
167
168 return ret;
169}
170
Harald Welte59b04682009-06-10 05:40:52 +0800171static struct msgb *rsl_msgb_alloc(void)
172{
Harald Welte9cfc9352009-06-26 19:39:35 +0200173 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
174 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800175}
176
177#define MACBLOCK_SIZE 23
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200178static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800179{
180 memcpy(out, in, len);
181
182 if (len < MACBLOCK_SIZE)
183 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
184}
185
Harald Welted2dd9de2009-08-30 15:37:11 +0900186/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200187static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welted2dd9de2009-08-30 15:37:11 +0900188{
189 *out++ = lchan->encr.alg_id & 0xff;
190 if (lchan->encr.key_len)
191 memcpy(out, lchan->encr.key, lchan->encr.key_len);
192 return lchan->encr.key_len + 1;
193}
194
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200195static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200196{
Harald Welte59b04682009-06-10 05:40:52 +0800197 int i;
198
Harald Weltede4477a2009-12-24 12:20:20 +0100199 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200200 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200201 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100202 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800203}
204
Harald Welte32951ea2011-08-10 23:26:33 +0200205static void lchan_act_tmr_cb(void *data)
206{
207 struct gsm_lchan *lchan = data;
208
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200209 LOGP(DRSL, LOGL_ERROR,
210 "%s Timeout during activation. Marked as broken.\n",
Harald Welte32951ea2011-08-10 23:26:33 +0200211 gsm_lchan_name(lchan));
212
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +0100213 rsl_lchan_mark_broken(lchan, "activation timeout");
Daniel Willmann2731e732011-08-11 04:44:12 +0200214 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200215}
216
217static void lchan_deact_tmr_cb(void *data)
218{
219 struct gsm_lchan *lchan = data;
220
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200221 LOGP(DRSL, LOGL_ERROR,
222 "%s Timeout during deactivation! Marked as broken.\n",
Harald Welte32951ea2011-08-10 23:26:33 +0200223 gsm_lchan_name(lchan));
224
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +0100225 rsl_lchan_mark_broken(lchan, "de-activation timeout");
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200226 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200227}
228
229
Harald Welte59b04682009-06-10 05:40:52 +0800230/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200231int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
232 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800233{
234 struct abis_rsl_dchan_hdr *dh;
235 struct msgb *msg = rsl_msgb_alloc();
236
237 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
238 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
239 dh->chan_nr = RSL_CHAN_BCCH;
240
241 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
242 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
243
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200244 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800245
246 return abis_rsl_sendmsg(msg);
247}
248
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200249int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
250 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800251{
252 struct abis_rsl_common_hdr *ch;
253 struct msgb *msg = rsl_msgb_alloc();
254
255 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
256 ch->msg_discr = ABIS_RSL_MDISC_TRX;
257 ch->msg_type = RSL_MT_SACCH_FILL;
258
259 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
260 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
261
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200262 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800263
264 return abis_rsl_sendmsg(msg);
265}
266
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200267int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
268 const uint8_t *data, int len)
Harald Welte10b7d8f2011-01-13 23:16:03 +0100269{
270 struct abis_rsl_dchan_hdr *dh;
271 struct msgb *msg = rsl_msgb_alloc();
Harald Weltee6d51f92011-06-25 10:02:33 +0200272 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte10b7d8f2011-01-13 23:16:03 +0100273
274 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
275 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
276 dh->chan_nr = chan_nr;
277
278 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
279 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
280
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200281 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte10b7d8f2011-01-13 23:16:03 +0100282
283 return abis_rsl_sendmsg(msg);
284}
285
Harald Welte91afe4c2009-06-20 18:15:19 +0200286int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
287{
288 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200289 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200290 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200291
292 db = abs(db);
293 if (db > 30)
294 return -EINVAL;
295
Harald Welteed831842009-06-27 03:09:08 +0200296 msg = rsl_msgb_alloc();
297
Harald Welte91afe4c2009-06-20 18:15:19 +0200298 lchan->bs_power = db/2;
299 if (fpc)
300 lchan->bs_power |= 0x10;
301
302 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
303 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
304 dh->chan_nr = chan_nr;
305
306 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
307
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200308 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200309
310 return abis_rsl_sendmsg(msg);
311}
312
Harald Welte91afe4c2009-06-20 18:15:19 +0200313int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
314{
315 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200316 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200317 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200318 int ctl_lvl;
319
Harald Weltec4dcda02009-08-09 14:45:18 +0200320 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200321 if (ctl_lvl < 0)
322 return ctl_lvl;
323
Harald Welteed831842009-06-27 03:09:08 +0200324 msg = rsl_msgb_alloc();
325
Harald Welte91afe4c2009-06-20 18:15:19 +0200326 lchan->ms_power = ctl_lvl;
327
328 if (fpc)
329 lchan->ms_power |= 0x20;
330
331 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
332 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
333 dh->chan_nr = chan_nr;
334
335 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
336
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200337 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200338
339 return abis_rsl_sendmsg(msg);
340}
341
Harald Welte39274f42009-07-29 15:41:29 +0200342static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
343 struct gsm_lchan *lchan)
344{
Holger Hans Peter Freytherfad73652013-03-09 17:50:10 +0100345 memset(cm, 0, sizeof(*cm));
Harald Welte39274f42009-07-29 15:41:29 +0200346
347 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800348 if (lchan->ts->trx->bts->network->dtx_enabled)
349 cm->dtx_dtu = 0x03;
350 else
351 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200352
353 /* set TCH Speech/Data */
354 cm->spd_ind = lchan->rsl_cmode;
355
Harald Welte951e3512009-11-27 08:55:16 +0100356 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
357 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100358 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100359 "but tch_mode != signalling\n");
360
Harald Welte39274f42009-07-29 15:41:29 +0200361 switch (lchan->type) {
362 case GSM_LCHAN_SDCCH:
363 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
364 break;
365 case GSM_LCHAN_TCH_F:
366 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
367 break;
368 case GSM_LCHAN_TCH_H:
369 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
370 break;
371 case GSM_LCHAN_NONE:
372 case GSM_LCHAN_UNKNOWN:
373 default:
374 return -EINVAL;
375 }
376
377 switch (lchan->tch_mode) {
378 case GSM48_CMODE_SIGN:
379 cm->chan_rate = 0;
380 break;
381 case GSM48_CMODE_SPEECH_V1:
382 cm->chan_rate = RSL_CMOD_SP_GSM1;
383 break;
384 case GSM48_CMODE_SPEECH_EFR:
385 cm->chan_rate = RSL_CMOD_SP_GSM2;
386 break;
387 case GSM48_CMODE_SPEECH_AMR:
388 cm->chan_rate = RSL_CMOD_SP_GSM3;
389 break;
390 case GSM48_CMODE_DATA_14k5:
Harald Welte39274f42009-07-29 15:41:29 +0200391 case GSM48_CMODE_DATA_12k0:
Harald Welte39274f42009-07-29 15:41:29 +0200392 case GSM48_CMODE_DATA_6k0:
Harald Weltee75a47d2012-08-24 15:33:56 +0200393 switch (lchan->csd_mode) {
394 case LCHAN_CSD_M_NT:
395 /* non-transparent CSD with RLP */
396 switch (lchan->tch_mode) {
397 case GSM48_CMODE_DATA_14k5:
398 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
399 break;
400 case GSM48_CMODE_DATA_12k0:
401 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
402 break;
403 case GSM48_CMODE_DATA_6k0:
404 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
405 break;
406 default:
407 return -EINVAL;
408 }
409 break;
410 /* transparent data services below */
411 case LCHAN_CSD_M_T_1200_75:
412 cm->chan_rate = RSL_CMOD_CSD_T_1200_75;
413 break;
414 case LCHAN_CSD_M_T_600:
415 cm->chan_rate = RSL_CMOD_CSD_T_600;
416 break;
417 case LCHAN_CSD_M_T_1200:
418 cm->chan_rate = RSL_CMOD_CSD_T_1200;
419 break;
420 case LCHAN_CSD_M_T_2400:
421 cm->chan_rate = RSL_CMOD_CSD_T_2400;
422 break;
423 case LCHAN_CSD_M_T_9600:
424 cm->chan_rate = RSL_CMOD_CSD_T_9600;
425 break;
426 case LCHAN_CSD_M_T_14400:
427 cm->chan_rate = RSL_CMOD_CSD_T_14400;
428 break;
429 case LCHAN_CSD_M_T_29000:
430 cm->chan_rate = RSL_CMOD_CSD_T_29000;
431 break;
432 case LCHAN_CSD_M_T_32000:
433 cm->chan_rate = RSL_CMOD_CSD_T_32000;
434 break;
435 default:
436 return -EINVAL;
437 }
Harald Welte39274f42009-07-29 15:41:29 +0200438 default:
439 return -EINVAL;
440 }
441
442 return 0;
443}
444
Harald Welte59b04682009-06-10 05:40:52 +0800445/* Chapter 8.4.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200446int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200447 uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800448{
449 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200450 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200451 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200452 uint8_t *len;
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200453 uint8_t ta;
Harald Welte59b04682009-06-10 05:40:52 +0800454
Harald Weltee6d51f92011-06-25 10:02:33 +0200455 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800456 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200457 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800458
Harald Welte39274f42009-07-29 15:41:29 +0200459 rc = channel_mode_from_lchan(&cm, lchan);
460 if (rc < 0)
461 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800462
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200463 ta = lchan->rqd_ta;
464
465 /* BS11 requires TA shifted by 2 bits */
466 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11)
467 ta <<= 2;
468
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800469 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200470 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800471
Harald Welteed831842009-06-27 03:09:08 +0200472 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800473 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
474 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
475 dh->chan_nr = chan_nr;
476
477 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800478 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200479 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800480
481 /*
482 * The Channel Identification is needed for Phase1 phones
483 * and it contains the GSM48 Channel Description and the
484 * Mobile Allocation. The GSM 08.58 asks for the Mobile
485 * Allocation to have a length of zero. We are using the
486 * msgb_l3len to calculate the length of both messages.
487 */
laforgef723cf02010-06-20 21:38:19 +0200488 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200489 len = msgb_put(msg, 1);
Dieter Spaar18a55f62011-07-27 23:40:33 +0200490 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800491
492 if (lchan->ts->hopping.enabled)
493 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
494 lchan->ts->hopping.ma_data);
495 else
496 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800497
498 /* update the calculated size */
499 msg->l3h = len + 1;
500 *len = msgb_l3len(msg);
501
Harald Welted2dd9de2009-08-30 15:37:11 +0900502 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200503 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900504 rc = build_encr_info(encr_info, lchan);
505 if (rc > 0)
506 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
507 }
508
Harald Welteb90d7bd2009-12-17 00:31:10 +0100509 switch (act_type) {
510 case RSL_ACT_INTER_ASYNC:
511 case RSL_ACT_INTER_SYNC:
512 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
513 break;
514 default:
515 break;
516 }
517
Harald Welte59b04682009-06-10 05:40:52 +0800518 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
519 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
520 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
521
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100522 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
523 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200524 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100525
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200526 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800527
528 return abis_rsl_sendmsg(msg);
529}
530
Harald Welte8e770492009-07-29 11:38:15 +0200531/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800532int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
533{
534 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200535 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200536 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800537
Harald Weltee6d51f92011-06-25 10:02:33 +0200538 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800539 struct rsl_ie_chan_mode cm;
540
Harald Welte39274f42009-07-29 15:41:29 +0200541 rc = channel_mode_from_lchan(&cm, lchan);
542 if (rc < 0)
543 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800544
Harald Welteed831842009-06-27 03:09:08 +0200545 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800546 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
547 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
548 dh->chan_nr = chan_nr;
549
550 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200551 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900552
553 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200554 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900555 rc = build_encr_info(encr_info, lchan);
556 if (rc > 0)
557 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
558 }
559
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100560 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
561 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200562 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100563 }
564
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200565 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dd9de2009-08-30 15:37:11 +0900566
567 return abis_rsl_sendmsg(msg);
568}
569
570/* Chapter 8.4.6: Send the encryption command with given L3 info */
571int rsl_encryption_cmd(struct msgb *msg)
572{
573 struct abis_rsl_dchan_hdr *dh;
574 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200575 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200576 uint8_t encr_info[MAX_A5_KEY_LEN+2];
577 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900578 int rc;
579
580 /* First push the L3 IE tag and length */
581 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
582
583 /* then the link identifier (SAPI0, main sign link) */
584 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
585
586 /* then encryption information */
587 rc = build_encr_info(encr_info, lchan);
588 if (rc <= 0)
589 return rc;
590 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
591
592 /* and finally the DCHAN header */
593 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
594 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
595 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800596
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200597 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800598
599 return abis_rsl_sendmsg(msg);
600}
601
Harald Welte85a163c2009-08-10 11:43:22 +0200602/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200603int rsl_deact_sacch(struct gsm_lchan *lchan)
604{
605 struct abis_rsl_dchan_hdr *dh;
606 struct msgb *msg = rsl_msgb_alloc();
607
608 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
609 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200610 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200611
612 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200613 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteafe3c232009-07-19 18:36:49 +0200614
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100615 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200616
617 return abis_rsl_sendmsg(msg);
618}
619
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800620static void error_timeout_cb(void *data)
621{
622 struct gsm_lchan *lchan = data;
623 if (lchan->state != LCHAN_S_REL_ERR) {
624 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
625 gsm_lchan_name(lchan), lchan->state);
626 return;
627 }
628
629 /* go back to the none state */
Harald Weltefddaba52012-11-13 04:26:22 +0100630 LOGP(DRSL, LOGL_INFO, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800631 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800632}
633
Harald Welte08011e22011-03-04 13:41:31 +0100634static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
635
Harald Welte85a163c2009-08-10 11:43:22 +0200636/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100637static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error,
638 enum sacch_deact deact_sacch)
Harald Welte59b04682009-06-10 05:40:52 +0800639{
640 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800641 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100642 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800643
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100644 /* Stop timers that should lead to a channel release */
645 osmo_timer_del(&lchan->T3109);
646
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800647 if (lchan->state == LCHAN_S_REL_ERR) {
648 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
649 gsm_lchan_name(lchan));
650 return -1;
651 }
652
653 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800654 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
655 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200656 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800657
658 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200659 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800660
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800661 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
662
663 if (error) {
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100664 /*
665 * FIXME: GSM 04.08 gives us two options for the abnormal
666 * chanel release. This can be either like in the non-existent
667 * sub-lcuase 3.5.1 or for the main signalling link deactivate
668 * the SACCH, start timer T3109 and consider the channel as
669 * released.
670 *
671 * This code is doing the later for all raido links and not
672 * only the main link. Right now all SAPIs are released on the
673 * local end, the SACCH will be de-activated and right now the
674 * T3111 will be started. First T3109 should be started and then
675 * the T3111.
676 *
677 * TODO: Move this out of the function.
678 */
679
680 /*
681 * sacch de-activate and "local end release"
682 */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100683 if (deact_sacch == SACCH_DEACTIVATE)
684 rsl_deact_sacch(lchan);
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100685 rsl_release_sapis_from(lchan, 0, RSL_REL_LOCAL_END);
686
687 /*
688 * TODO: start T3109 now.
689 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800690 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800691 }
Harald Welte59b04682009-06-10 05:40:52 +0800692
Harald Welte32951ea2011-08-10 23:26:33 +0200693 /* Start another timer or assume the BTS sends a ACK/NACK? */
694 lchan->act_timer.cb = lchan_deact_tmr_cb;
695 lchan->act_timer.data = lchan;
696 osmo_timer_schedule(&lchan->act_timer, 4, 0);
697
Harald Welte08011e22011-03-04 13:41:31 +0100698 rc = abis_rsl_sendmsg(msg);
699
Harald Welte85a163c2009-08-10 11:43:22 +0200700 /* BTS will respond by RF CHAN REL ACK */
Harald Welte08011e22011-03-04 13:41:31 +0100701 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800702}
703
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +0200704/*
705 * Special handling for channel releases in the error case.
706 */
707static int rsl_rf_chan_release_err(struct gsm_lchan *lchan)
708{
709 if (lchan->state != LCHAN_S_ACTIVE)
710 return 0;
711 return rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
712}
713
Harald Welte9773f6c2011-01-14 14:16:16 +0100714static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
715{
716
717 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
718
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100719 /* Stop all pending timers */
Harald Welte32951ea2011-08-10 23:26:33 +0200720 osmo_timer_del(&lchan->act_timer);
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100721 osmo_timer_del(&lchan->T3111);
Harald Welte32951ea2011-08-10 23:26:33 +0200722
Holger Hans Peter Freyther6f8ae692015-04-04 19:35:22 +0200723 /*
724 * The BTS didn't respond within the timeout to our channel
725 * release request and we have marked the channel as broken.
726 * Now we do receive an ACK and let's be conservative. If it
727 * is a sysmoBTS we know that only one RF Channel Release ACK
728 * will be sent. So let's "repair" the channel.
729 */
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200730 if (lchan->state == LCHAN_S_BROKEN) {
Holger Hans Peter Freyther6f8ae692015-04-04 19:35:22 +0200731 int do_free = is_sysmobts_v2(lchan->ts->trx->bts);
732 LOGP(DRSL, LOGL_NOTICE,
733 "%s CHAN REL ACK for broken channel. %s.\n",
734 gsm_lchan_name(lchan),
735 do_free ? "Releasing it" : "Keeping it broken");
736 if (do_free)
737 do_lchan_free(lchan);
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200738 return 0;
739 }
740
Harald Welte9773f6c2011-01-14 14:16:16 +0100741 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
742 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
743 gsm_lchan_name(lchan),
744 gsm_lchans_name(lchan->state));
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100745 do_lchan_free(lchan);
Harald Welte9773f6c2011-01-14 14:16:16 +0100746
747 return 0;
748}
749
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200750int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
751 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800752{
753 struct abis_rsl_dchan_hdr *dh;
754 struct msgb *msg = rsl_msgb_alloc();
755
756 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
757 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
758 dh->chan_nr = RSL_CHAN_PCH_AGCH;
759
760 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
761 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
762 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
763
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200764 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800765
766 return abis_rsl_sendmsg(msg);
767}
768
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200769int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800770{
771 int i, len = strlen(str_in);
772
773 for (i = 0; i < len; i++) {
774 int num = str_in[i] - 0x30;
775 if (num < 0 || num > 9)
776 return -1;
777 if (i % 2 == 0)
778 bcd_out[i/2] = num;
779 else
780 bcd_out[i/2] |= (num << 4);
781 }
782
783 return 0;
784}
785
786/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200787int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800788{
789 struct msgb *msg = rsl_msgb_alloc();
790 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200791 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800792
793 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
794 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
795 dh->chan_nr = RSL_CHAN_PCH_AGCH;
796
797 switch (bts->type) {
798 case GSM_BTS_TYPE_BS11:
799 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
800 break;
801 default:
802 /* If phase 2, construct a FULL_IMM_ASS_INFO */
803 pad_macblock(buf, val, len);
804 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
805 break;
806 }
807
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200808 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800809
810 return abis_rsl_sendmsg(msg);
811}
812
Harald Welte4684e632009-08-10 09:51:40 +0200813/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200814int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200815{
816 struct msgb *msg = rsl_msgb_alloc();
817 struct abis_rsl_dchan_hdr *dh;
818
819 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
820 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200821 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200822 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200823 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200824
Harald Weltede4477a2009-12-24 12:20:20 +0100825 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200826 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200827
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200828 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte874a5b42009-08-10 11:26:14 +0200829
Harald Welte4684e632009-08-10 09:51:40 +0200830 return abis_rsl_sendmsg(msg);
831}
832
833
Harald Welte59b04682009-06-10 05:40:52 +0800834/* Send "DATA REQUEST" message with given L3 Info payload */
835/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200836int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800837{
Harald Welte59b04682009-06-10 05:40:52 +0800838 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100839 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800840 return -EINVAL;
841 }
842
Harald Weltee6d51f92011-06-25 10:02:33 +0200843 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100844 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800845
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200846 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800847
848 return abis_rsl_sendmsg(msg);
849}
850
Harald Welteed9a5ab2009-08-09 13:47:35 +0200851/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
852/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200853int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200854{
Harald Weltea22d36b2010-03-04 10:33:10 +0100855 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200856
Harald Weltee6d51f92011-06-25 10:02:33 +0200857 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100858 link_id, 0);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200859 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200860
Harald Welte17091bd2012-04-26 19:42:19 +0200861 DEBUGP(DRLL, "%s RSL RLL ESTABLISH REQ (link_id=0x%02x)\n",
862 gsm_lchan_name(lchan), link_id);
863
Harald Welteed9a5ab2009-08-09 13:47:35 +0200864 return abis_rsl_sendmsg(msg);
865}
866
Andreas Eversbergac27b952013-12-05 13:25:06 +0100867static void rsl_handle_release(struct gsm_lchan *lchan);
868
869/* Special work handler to handle missing RSL_MT_REL_CONF message from
870 * Nokia InSite BTS */
871static void lchan_rel_work_cb(void *data)
872{
873 struct gsm_lchan *lchan = data;
874 int sapi;
875
876 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
877 if (lchan->sapis[sapi] == LCHAN_SAPI_REL)
878 lchan->sapis[sapi] = LCHAN_SAPI_UNUSED;
879 }
880 rsl_handle_release(lchan);
881}
882
Harald Welte0f2e3c12009-08-08 13:15:07 +0200883/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
884 This is what higher layers should call. The BTS then responds with
885 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
886 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
887 lchan_free() */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100888int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id,
889 enum rsl_rel_mode release_mode)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200890{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200891
Harald Weltea22d36b2010-03-04 10:33:10 +0100892 struct msgb *msg;
893
Harald Weltee6d51f92011-06-25 10:02:33 +0200894 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100895 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800896 /* 0 is normal release, 1 is local end */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100897 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, release_mode);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200898
Harald Weltec88a4432009-12-29 10:44:17 +0100899 /* FIXME: start some timer in case we don't receive a REL ACK ? */
900
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200901 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200902
Harald Welte17091bd2012-04-26 19:42:19 +0200903 DEBUGP(DRLL, "%s RSL RLL RELEASE REQ (link_id=0x%02x, reason=%u)\n",
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100904 gsm_lchan_name(lchan), link_id, release_mode);
Harald Welte17091bd2012-04-26 19:42:19 +0200905
Andreas Eversbergac27b952013-12-05 13:25:06 +0100906 abis_rsl_sendmsg(msg);
907
908 /* Do not wait for Nokia BTS to send the confirm. */
909 if (is_nokia_bts(lchan->ts->trx->bts)
910 && lchan->ts->trx->bts->nokia.no_loc_rel_cnf
911 && release_mode == RSL_REL_LOCAL_END) {
912 DEBUGP(DRLL, "Scheduling release, becasuse Nokia InSite BTS does not send a RELease CONFirm.\n");
913 lchan->sapis[link_id & 0x7] = LCHAN_SAPI_REL;
914 lchan->rel_work.cb = lchan_rel_work_cb;
915 lchan->rel_work.data = lchan;
916 osmo_timer_schedule(&lchan->rel_work, 0, 0);
917 }
918
919 return 0;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200920}
921
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +0100922int rsl_lchan_mark_broken(struct gsm_lchan *lchan, const char *reason)
923{
924 lchan->state = LCHAN_S_BROKEN;
925 lchan->broken_reason = reason;
926 return 0;
927}
928
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200929int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
930{
931 lchan->state = state;
932 return 0;
933}
934
Harald Welte59b04682009-06-10 05:40:52 +0800935/* Chapter 8.4.2: Channel Activate Acknowledge */
936static int rsl_rx_chan_act_ack(struct msgb *msg)
937{
938 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
939
940 /* BTS has confirmed channel activation, we now need
941 * to assign the activated channel to the MS */
942 if (rslh->ie_chan != RSL_IE_CHAN_NR)
943 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100944
Harald Welte32951ea2011-08-10 23:26:33 +0200945 osmo_timer_del(&msg->lchan->act_timer);
946
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200947 if (msg->lchan->state == LCHAN_S_BROKEN) {
948 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK for broken channel.\n",
949 gsm_lchan_name(msg->lchan));
950 return 0;
951 }
952
Harald Weltec88a4432009-12-29 10:44:17 +0100953 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100954 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
955 gsm_lchan_name(msg->lchan),
956 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200957 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100958
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800959 if (msg->lchan->rqd_ref) {
960 rsl_send_imm_assignment(msg->lchan);
961 talloc_free(msg->lchan->rqd_ref);
962 msg->lchan->rqd_ref = NULL;
963 msg->lchan->rqd_ta = 0;
964 }
965
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100966 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100967
Harald Welte59b04682009-06-10 05:40:52 +0800968 return 0;
969}
970
971/* Chapter 8.4.3: Channel Activate NACK */
972static int rsl_rx_chan_act_nack(struct msgb *msg)
973{
974 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
975 struct tlv_parsed tp;
976
Harald Welte32951ea2011-08-10 23:26:33 +0200977 osmo_timer_del(&msg->lchan->act_timer);
978
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200979 if (msg->lchan->state == LCHAN_S_BROKEN) {
980 LOGP(DRSL, LOGL_ERROR,
981 "%s CHANNEL ACTIVATE NACK for broken channel.\n",
982 gsm_lchan_name(msg->lchan));
983 return -1;
984 }
985
Daniel Willmann9e9d44c2011-08-11 04:54:23 +0200986 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100987 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100988
Harald Welte59b04682009-06-10 05:40:52 +0800989 /* BTS has rejected channel activation ?!? */
990 if (dh->ie_chan != RSL_IE_CHAN_NR)
991 return -EINVAL;
992
993 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100994 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200995 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100996 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200997 TLVP_LEN(&tp, RSL_IE_CAUSE));
Holger Hans Peter Freyther5149c172012-12-06 19:25:06 +0100998 msg->lchan->error_cause = *cause;
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +0100999 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC) {
1000 rsl_lchan_mark_broken(msg->lchan, "NACK on activation");
1001 } else
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001002 rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Daniel Willmann245ee032011-08-11 04:47:11 +02001003
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +01001004 } else {
1005 rsl_lchan_mark_broken(msg->lchan, "NACK on activation no IE");
1006 }
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001007
Harald Welte (local)ed6d7622009-12-27 11:48:11 +01001008 LOGPC(DRSL, LOGL_ERROR, "\n");
1009
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001010 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte59b04682009-06-10 05:40:52 +08001011 return 0;
1012}
1013
1014/* Chapter 8.4.4: Connection Failure Indication */
1015static int rsl_rx_conn_fail(struct msgb *msg)
1016{
1017 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1018 struct tlv_parsed tp;
1019
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001020 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING state %s ",
1021 gsm_lchan_name(msg->lchan),
1022 gsm_lchans_name(msg->lchan->state));
1023
Harald Welte59b04682009-06-10 05:40:52 +08001024 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1025
Harald Weltef1a168d2009-07-28 17:58:09 +02001026 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001027 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001028 TLVP_LEN(&tp, RSL_IE_CAUSE));
1029
Harald Welte (local)4bd76642009-12-26 22:33:09 +01001030 LOGPC(DRSL, LOGL_NOTICE, "\n");
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001031 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +02001032 return rsl_rf_chan_release_err(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001033}
1034
Harald Weltec20bd1d2009-11-29 19:07:28 +01001035static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
1036 const char *prefix)
1037{
Harald Welte0e4fa782009-12-16 16:52:07 +01001038 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
1039 prefix, rxlev2dbm(mru->full.rx_lev),
1040 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +01001041 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
1042 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
1043}
1044
Harald Welte50290cc2012-07-02 17:12:08 +02001045static void print_meas_rep(struct gsm_lchan *lchan, struct gsm_meas_rep *mr)
Harald Weltec20bd1d2009-11-29 19:07:28 +01001046{
Harald Welte0e4fa782009-12-16 16:52:07 +01001047 int i;
Harald Welte50290cc2012-07-02 17:12:08 +02001048 char *name = "";
Harald Welte0e4fa782009-12-16 16:52:07 +01001049
Harald Welte50290cc2012-07-02 17:12:08 +02001050 if (lchan && lchan->conn && lchan->conn->subscr)
1051 name = subscr_name(lchan->conn->subscr);
1052
1053 DEBUGP(DMEAS, "[%s] MEASUREMENT RESULT NR=%d ", name, mr->nr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001054
1055 if (mr->flags & MEAS_REP_F_DL_DTX)
1056 DEBUGPC(DMEAS, "DTXd ");
1057
1058 print_meas_rep_uni(&mr->ul, "ul");
1059 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
1060 if (mr->flags & MEAS_REP_F_MS_TO)
1061 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
1062
1063 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +01001064 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001065 DEBUGPC(DMEAS, "L1_FPC=%u ",
1066 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1067 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1068 }
1069
1070 if (mr->flags & MEAS_REP_F_UL_DTX)
1071 DEBUGPC(DMEAS, "DTXu ");
1072 if (mr->flags & MEAS_REP_F_BA1)
1073 DEBUGPC(DMEAS, "BA1 ");
1074 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1075 DEBUGPC(DMEAS, "NOT VALID ");
1076 else
1077 print_meas_rep_uni(&mr->dl, "dl");
1078
1079 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001080 if (mr->num_cell == 7)
1081 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001082 for (i = 0; i < mr->num_cell; i++) {
1083 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +01001084 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1085 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +01001086 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001087}
1088
Harald Welte59b04682009-06-10 05:40:52 +08001089static int rsl_rx_meas_res(struct msgb *msg)
1090{
1091 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1092 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001093 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001094 uint8_t len;
1095 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +01001096 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001097
Harald Welte4baa9c52009-12-21 13:27:11 +01001098 /* check if this channel is actually active */
1099 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +01001100 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +08001101 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +01001102 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +01001103 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +01001104 }
Harald Welte4baa9c52009-12-21 13:27:11 +01001105
Harald Weltef9476812009-12-15 21:36:05 +01001106 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001107 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001108
Harald Welte59b04682009-06-10 05:40:52 +08001109 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1110
Harald Weltec20bd1d2009-11-29 19:07:28 +01001111 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1112 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1113 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1114 return -EIO;
1115
1116 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001117 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001118
1119 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1120 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1121 if (len >= 3) {
1122 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001123 mr->flags |= MEAS_REP_F_DL_DTX;
1124 mr->ul.full.rx_lev = val[0] & 0x3f;
1125 mr->ul.sub.rx_lev = val[1] & 0x3f;
1126 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1127 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001128 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001129
Harald Weltef9476812009-12-15 21:36:05 +01001130 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001131
1132 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001133 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001134 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001135 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1136
Harald Weltea1467eb2009-06-20 18:44:35 +02001137 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001138 struct e1inp_sign_link *sign_link = msg->dst;
1139
Harald Weltec20bd1d2009-11-29 19:07:28 +01001140 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001141 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001142 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001143 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001144 mr->flags |= MEAS_REP_F_FPC;
1145 mr->ms_l1.ta = val[1];
Andreas Eversbergfe56cf82011-12-24 11:49:05 +01001146 /* BS11 and Nokia reports TA shifted by 2 bits */
1147 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1148 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001149 mr->ms_l1.ta >>= 2;
Harald Weltea1467eb2009-06-20 18:44:35 +02001150 }
Harald Welte59b04682009-06-10 05:40:52 +08001151 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001152 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001153 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001154 if (rc < 0)
1155 return rc;
1156 }
1157
Harald Welte50290cc2012-07-02 17:12:08 +02001158 print_meas_rep(msg->lchan, mr);
Harald Welte59b04682009-06-10 05:40:52 +08001159
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001160 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001161
Harald Welte59b04682009-06-10 05:40:52 +08001162 return 0;
1163}
1164
Harald Welte6720a432009-11-29 22:45:52 +01001165/* Chapter 8.4.7 */
1166static int rsl_rx_hando_det(struct msgb *msg)
1167{
1168 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1169 struct tlv_parsed tp;
1170
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001171 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001172
1173 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1174
1175 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1176 DEBUGPC(DRSL, "access delay = %u\n",
1177 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1178 else
1179 DEBUGPC(DRSL, "\n");
1180
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001181 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001182
1183 return 0;
1184}
1185
Harald Welte59b04682009-06-10 05:40:52 +08001186static int abis_rsl_rx_dchan(struct msgb *msg)
1187{
1188 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1189 int rc = 0;
1190 char *ts_name;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001191 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001192
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001193 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001194 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001195
Harald Welte59b04682009-06-10 05:40:52 +08001196 switch (rslh->c.msg_type) {
1197 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001198 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001199 rc = rsl_rx_chan_act_ack(msg);
1200 break;
1201 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001202 rc = rsl_rx_chan_act_nack(msg);
1203 break;
1204 case RSL_MT_CONN_FAIL:
1205 rc = rsl_rx_conn_fail(msg);
1206 break;
1207 case RSL_MT_MEAS_RES:
1208 rc = rsl_rx_meas_res(msg);
1209 break;
Harald Welte6720a432009-11-29 22:45:52 +01001210 case RSL_MT_HANDO_DET:
1211 rc = rsl_rx_hando_det(msg);
1212 break;
Harald Welte59b04682009-06-10 05:40:52 +08001213 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001214 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001215 break;
1216 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001217 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001218 break;
1219 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001220 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001221 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001222 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001223 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001224 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001225 break;
1226 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001227 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001228 break;
1229 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001230 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001231 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001232 break;
1233 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001234 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001235 break;
Harald Welte59b04682009-06-10 05:40:52 +08001236 case RSL_MT_PHY_CONTEXT_CONF:
1237 case RSL_MT_PREPROC_MEAS_RES:
1238 case RSL_MT_TALKER_DET:
1239 case RSL_MT_LISTENER_DET:
1240 case RSL_MT_REMOTE_CODEC_CONF_REP:
1241 case RSL_MT_MR_CODEC_MOD_ACK:
1242 case RSL_MT_MR_CODEC_MOD_NACK:
1243 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001244 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1245 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001246 break;
1247 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001248 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1249 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001250 return -EINVAL;
1251 }
1252
1253 return rc;
1254}
1255
1256static int rsl_rx_error_rep(struct msgb *msg)
1257{
1258 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001259 struct tlv_parsed tp;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001260 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001261
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001262 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001263
1264 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1265
1266 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001267 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001268 TLVP_LEN(&tp, RSL_IE_CAUSE));
1269
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001270 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001271
1272 return 0;
1273}
1274
1275static int abis_rsl_rx_trx(struct msgb *msg)
1276{
1277 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001278 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001279 int rc = 0;
1280
1281 switch (rslh->msg_type) {
1282 case RSL_MT_ERROR_REPORT:
1283 rc = rsl_rx_error_rep(msg);
1284 break;
1285 case RSL_MT_RF_RES_IND:
1286 /* interference on idle channels of TRX */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001287 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001288 break;
1289 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001290 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001291 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001292 gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001293 break;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001294 case 0x42: /* Nokia specific: SI End ACK */
1295 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1296 break;
1297 case 0x43: /* Nokia specific: SI End NACK */
1298 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1299 break;
Harald Welte59b04682009-06-10 05:40:52 +08001300 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001301 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001302 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001303 return -EINVAL;
1304 }
1305 return rc;
1306}
1307
Harald Welte427dbc42009-08-10 00:26:10 +02001308/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1309static void t3101_expired(void *data)
1310{
1311 struct gsm_lchan *lchan = data;
1312
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001313 rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
Harald Welte427dbc42009-08-10 00:26:10 +02001314}
1315
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001316/* If T3111 expires, we will send the RF Channel Request */
1317static void t3111_expired(void *data)
1318{
1319 struct gsm_lchan *lchan = data;
1320
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001321 rsl_rf_chan_release(lchan, 0, SACCH_NONE);
1322}
1323
1324/* If T3109 expires the MS has not send a UA/UM do the error release */
1325static void t3109_expired(void *data)
1326{
1327 struct gsm_lchan *lchan = data;
1328
1329 LOGP(DRSL, LOGL_ERROR,
1330 "%s SACCH deactivation timeout.\n", gsm_lchan_name(lchan));
1331 rsl_rf_chan_release(lchan, 1, SACCH_NONE);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001332}
1333
laforge50312e82010-06-21 12:08:52 +02001334#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1335
Harald Weltea00fdd72010-12-23 14:39:29 +01001336/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1337static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1338 unsigned int num_req_refs,
1339 struct gsm48_req_ref *rqd_refs,
1340 uint8_t wait_ind)
1341{
1342 uint8_t buf[GSM_MACBLOCK_LEN];
1343 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1344
1345 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1346 memset(iar, 0, sizeof(*iar));
1347 iar->proto_discr = GSM48_PDISC_RR;
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001348 iar->msg_type = GSM48_MT_RR_IMM_ASS_REJ;
Harald Weltea00fdd72010-12-23 14:39:29 +01001349 iar->page_mode = GSM48_PM_SAME;
1350
1351 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1352 iar->wait_ind1 = wait_ind;
1353
1354 if (num_req_refs >= 2)
1355 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1356 else
1357 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1358 iar->wait_ind2 = wait_ind;
1359
1360 if (num_req_refs >= 3)
1361 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1362 else
1363 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1364 iar->wait_ind3 = wait_ind;
1365
1366 if (num_req_refs >= 4)
1367 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1368 else
1369 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1370 iar->wait_ind4 = wait_ind;
1371
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001372 /* we need to subtract 1 byte from sizeof(*iar) since ia includes the l2_plen field */
1373 iar->l2_plen = GSM48_LEN2PLEN((sizeof(*iar)-1));
1374
1375 return rsl_imm_assign_cmd(bts, sizeof(*iar), (uint8_t *) iar);
Harald Weltea00fdd72010-12-23 14:39:29 +01001376}
1377
Harald Welte59b04682009-06-10 05:40:52 +08001378/* MS has requested a channel on the RACH */
1379static int rsl_rx_chan_rqd(struct msgb *msg)
1380{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001381 struct e1inp_sign_link *sign_link = msg->dst;
1382 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001383 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1384 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001385 enum gsm_chan_t lctype;
1386 enum gsm_chreq_reason_t chreq_reason;
1387 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001388 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001389 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001390
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001391 uint16_t arfcn;
Holger Hans Peter Freytherefd75b52012-02-03 20:10:13 +01001392 uint8_t subch;
Harald Welte59b04682009-06-10 05:40:52 +08001393
1394 /* parse request reference to be used in immediate assign */
1395 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1396 return -EINVAL;
1397
1398 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1399
1400 /* parse access delay and use as TA */
1401 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1402 return -EINVAL;
1403 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1404
1405 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1406 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001407 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1408 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001409
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001410 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001411
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001412 /*
1413 * We want LOCATION UPDATES to succeed and will assign a TCH
1414 * if we have no SDCCH available.
1415 */
1416 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1417
Harald Welte59b04682009-06-10 05:40:52 +08001418 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001419 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001420 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001421 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001422 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001423 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001424 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1425 if (bts->network->T3122)
1426 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Weltecf7c90c2012-11-13 04:46:03 +01001427 return 0;
Harald Welte59b04682009-06-10 05:40:52 +08001428 }
1429
Harald Weltec88a4432009-12-29 10:44:17 +01001430 if (lchan->state != LCHAN_S_NONE)
1431 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001432 "in state %s\n", gsm_lchan_name(lchan),
1433 gsm_lchans_name(lchan->state));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001434
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001435 /* save the RACH data as we need it after the CHAN ACT ACK */
1436 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1437 if (!lchan->rqd_ref) {
1438 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1439 lchan_free(lchan);
1440 return -ENOMEM;
1441 }
1442
Holger Hans Peter Freyther161cec12011-12-29 23:33:04 +01001443 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001444 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1445 lchan->rqd_ta = rqd_ta;
1446
Harald Welte59b04682009-06-10 05:40:52 +08001447 arfcn = lchan->ts->trx->arfcn;
1448 subch = lchan->nr;
1449
Harald Welted2dd9de2009-08-30 15:37:11 +09001450 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001451 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001452 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001453 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001454 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001455
Harald Welte32951ea2011-08-10 23:26:33 +02001456 /* Start another timer or assume the BTS sends a ACK/NACK? */
1457 lchan->act_timer.cb = lchan_act_tmr_cb;
1458 lchan->act_timer.data = lchan;
1459 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1460
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001461 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1462 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1463 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1464 rqd_ref->ra, rqd_ta);
1465
Andreas Eversberg3ca9af32013-10-11 12:55:35 +02001466 rsl_chan_activate_lchan(lchan, 0x00, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001467
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001468 return 0;
1469}
1470
1471static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1472{
1473 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001474 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001475 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1476
Harald Welte59b04682009-06-10 05:40:52 +08001477 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001478 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001479 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001480 ia->proto_discr = GSM48_PDISC_RR;
1481 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1482 ia->page_mode = GSM48_PM_SAME;
1483 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001484
Harald Welte59b04682009-06-10 05:40:52 +08001485 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001486 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1487 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001488 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001489 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001490 } else {
laforgee06d5982010-06-20 15:18:46 +02001491 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1492 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001493 }
Harald Welte07f32182010-06-28 18:41:27 +02001494 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1495 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001496
Harald Welte427dbc42009-08-10 00:26:10 +02001497 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1498 lchan->T3101.cb = t3101_expired;
1499 lchan->T3101.data = lchan;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001500 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001501
1502 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001503 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001504}
1505
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001506/* current load on the CCCH */
Harald Welte59b04682009-06-10 05:40:52 +08001507static int rsl_rx_ccch_load(struct msgb *msg)
1508{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001509 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001510 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001511 struct ccch_signal_data sd;
1512
1513 sd.bts = sign_link->trx->bts;
1514 sd.rach_slot_count = -1;
1515 sd.rach_busy_count = -1;
1516 sd.rach_access_count = -1;
Harald Welte59b04682009-06-10 05:40:52 +08001517
1518 switch (rslh->data[0]) {
1519 case RSL_IE_PAGING_LOAD:
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001520 sd.pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1521 if (is_ipaccess_bts(sign_link->trx->bts) && sd.pg_buf_space == 0xffff) {
Harald Welte008a4922010-04-19 10:24:07 +02001522 /* paging load below configured threshold, use 50 as default */
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001523 sd.pg_buf_space = 50;
Harald Welte008a4922010-04-19 10:24:07 +02001524 }
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001525 paging_update_buffer_space(sign_link->trx->bts, sd.pg_buf_space);
1526 osmo_signal_dispatch(SS_CCCH, S_CCCH_PAGING_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001527 break;
1528 case RSL_IE_RACH_LOAD:
1529 if (msg->data_len >= 7) {
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001530 sd.rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1531 sd.rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1532 sd.rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1533 osmo_signal_dispatch(SS_CCCH, S_CCCH_RACH_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001534 }
1535 break;
1536 default:
1537 break;
1538 }
1539
1540 return 0;
1541}
1542
1543static int abis_rsl_rx_cchan(struct msgb *msg)
1544{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001545 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001546 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1547 int rc = 0;
1548
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001549 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +08001550
1551 switch (rslh->c.msg_type) {
1552 case RSL_MT_CHAN_RQD:
1553 /* MS has requested a channel on the RACH */
1554 rc = rsl_rx_chan_rqd(msg);
1555 break;
1556 case RSL_MT_CCCH_LOAD_IND:
1557 /* current load on the CCCH */
1558 rc = rsl_rx_ccch_load(msg);
1559 break;
1560 case RSL_MT_DELETE_IND:
1561 /* CCCH overloaded, IMM_ASSIGN was dropped */
1562 case RSL_MT_CBCH_LOAD_IND:
1563 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001564 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1565 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001566 break;
1567 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001568 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1569 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001570 return -EINVAL;
1571 }
1572
1573 return rc;
1574}
1575
1576static int rsl_rx_rll_err_ind(struct msgb *msg)
1577{
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001578 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001579 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001580 uint8_t rlm_cause;
Harald Welte59b04682009-06-10 05:40:52 +08001581
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001582 rsl_tlv_parse(&tp, rllh->data, msgb_l2len(msg) - sizeof(*rllh));
1583 if (!TLVP_PRESENT(&tp, RSL_IE_RLM_CAUSE)) {
1584 LOGP(DRLL, LOGL_ERROR,
1585 "%s ERROR INDICATION without mandantory cause.\n",
1586 gsm_lchan_name(msg->lchan));
1587 return -1;
1588 }
1589
1590 rlm_cause = *TLVP_VAL(&tp, RSL_IE_RLM_CAUSE);
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001591 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s in state=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001592 gsm_lchan_name(msg->lchan),
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001593 rsl_rlm_cause_name(rlm_cause),
1594 gsm_lchans_name(msg->lchan->state));
1595
Harald Welteed9a5ab2009-08-09 13:47:35 +02001596 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001597
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001598 if (rlm_cause == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001599 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +02001600 return rsl_rf_chan_release_err(msg->lchan);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001601 }
Harald Welte692f5852009-07-04 09:40:05 +02001602
Harald Welte59b04682009-06-10 05:40:52 +08001603 return 0;
1604}
1605
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001606static void rsl_handle_release(struct gsm_lchan *lchan)
1607{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001608 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001609 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001610
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +01001611 /*
1612 * Maybe only one link/SAPI was releasd or the error handling
1613 * was activated. Just return now and let the other code handle
1614 * it.
1615 */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001616 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001617 return;
1618
1619 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1620 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1621 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001622 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001623 gsm_lchan_name(lchan), sapi);
1624 return;
1625 }
1626
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001627
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001628 /* Stop T3109 and wait for T3111 before re-using the channel */
1629 osmo_timer_del(&lchan->T3109);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001630 lchan->T3111.cb = t3111_expired;
1631 lchan->T3111.data = lchan;
1632 bts = lchan->ts->trx->bts;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001633 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001634}
1635
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001636/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001637 0x02, 0x06,
1638 0x01, 0x20,
1639 0x02, 0x00,
1640 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1641
1642static int abis_rsl_rx_rll(struct msgb *msg)
1643{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001644 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001645 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1646 int rc = 0;
1647 char *ts_name;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001648 uint8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001649
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001650 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001651 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001652 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001653
1654 switch (rllh->c.msg_type) {
1655 case RSL_MT_DATA_IND:
1656 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001657 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001658 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1659 rllh->data[0] == RSL_IE_L3_INFO) {
1660 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001661 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001662 }
1663 break;
1664 case RSL_MT_EST_IND:
1665 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001666 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001667 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001668 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001669 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001670 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1671 rllh->data[0] == RSL_IE_L3_INFO) {
1672 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001673 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001674 }
1675 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001676 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001677 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001678 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001679 rll_indication(msg->lchan, rllh->link_id,
1680 BSC_RLLR_IND_EST_CONF);
1681 break;
Harald Welte59b04682009-06-10 05:40:52 +08001682 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001683 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001684 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001685 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001686 rll_indication(msg->lchan, rllh->link_id,
1687 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001688 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001689 break;
1690 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001691 /* BTS informs us of having received UA from MS,
1692 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001693 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001694 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001695 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001696 break;
1697 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001698 rc = rsl_rx_rll_err_ind(msg);
1699 break;
1700 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001701 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1702 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001703 break;
1704 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001705 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1706 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001707 }
Harald Welte59b04682009-06-10 05:40:52 +08001708 return rc;
1709}
1710
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001711static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001712{
Harald Welteb284b472009-12-02 01:58:23 +05301713 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001714 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301715 switch (lchan->type) {
1716 case GSM_LCHAN_TCH_F:
1717 return 0x00;
1718 case GSM_LCHAN_TCH_H:
1719 return 0x03;
1720 default:
1721 break;
1722 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001723 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001724 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301725 switch (lchan->type) {
1726 case GSM_LCHAN_TCH_F:
1727 return 0x01;
1728 /* there's no half-rate EFR */
1729 default:
1730 break;
1731 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001732 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001733 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301734 switch (lchan->type) {
1735 case GSM_LCHAN_TCH_F:
1736 return 0x02;
1737 case GSM_LCHAN_TCH_H:
1738 return 0x05;
1739 default:
1740 break;
1741 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001742 break;
Harald Welteb284b472009-12-02 01:58:23 +05301743 default:
1744 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001745 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001746 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301747 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001748 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001749}
1750
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001751static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munaut1338a552009-12-20 22:06:40 +01001752{
1753 switch (lchan->tch_mode) {
1754 case GSM48_CMODE_SPEECH_V1:
1755 switch (lchan->type) {
1756 case GSM_LCHAN_TCH_F:
1757 return RTP_PT_GSM_FULL;
1758 case GSM_LCHAN_TCH_H:
1759 return RTP_PT_GSM_HALF;
1760 default:
1761 break;
1762 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001763 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001764 case GSM48_CMODE_SPEECH_EFR:
1765 switch (lchan->type) {
1766 case GSM_LCHAN_TCH_F:
1767 return RTP_PT_GSM_EFR;
1768 /* there's no half-rate EFR */
1769 default:
1770 break;
1771 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001772 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001773 case GSM48_CMODE_SPEECH_AMR:
1774 switch (lchan->type) {
1775 case GSM_LCHAN_TCH_F:
Sylvain Munaut1338a552009-12-20 22:06:40 +01001776 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freytherd78bee82011-07-21 10:24:46 +02001777 return RTP_PT_AMR;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001778 default:
1779 break;
1780 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001781 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001782 default:
1783 break;
1784 }
1785 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1786 "tch_mode == 0x%02x\n & lchan_type == %d",
1787 lchan->tch_mode, lchan->type);
1788 return 0;
1789}
1790
Harald Welte59b04682009-06-10 05:40:52 +08001791/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001792static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1793{
1794 struct in_addr ip;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001795 uint16_t port, conn_id;
Harald Weltebffa4992009-12-19 16:42:06 +01001796
1797 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001798 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_LOCAL_IP);
Harald Weltebffa4992009-12-19 16:42:06 +01001799 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1800 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1801 }
1802
1803 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001804 port = tlvp_val16_unal(tv, RSL_IE_IPAC_LOCAL_PORT);
Harald Weltebffa4992009-12-19 16:42:06 +01001805 port = ntohs(port);
1806 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1807 lchan->abis_ip.bound_port = port;
1808 }
1809
1810 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001811 conn_id = tlvp_val16_unal(tv, RSL_IE_IPAC_CONN_ID);
Harald Weltebffa4992009-12-19 16:42:06 +01001812 conn_id = ntohs(conn_id);
1813 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1814 lchan->abis_ip.conn_id = conn_id;
1815 }
1816
1817 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1818 lchan->abis_ip.rtp_payload2 =
1819 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1820 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1821 lchan->abis_ip.rtp_payload2);
1822 }
1823
1824 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1825 lchan->abis_ip.speech_mode =
1826 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1827 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1828 lchan->abis_ip.speech_mode);
1829 }
1830
1831 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001832 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_REMOTE_IP);
Harald Weltebffa4992009-12-19 16:42:06 +01001833 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1834 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1835 }
1836
1837 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001838 port = tlvp_val16_unal(tv, RSL_IE_IPAC_REMOTE_PORT);
Harald Weltebffa4992009-12-19 16:42:06 +01001839 port = ntohs(port);
1840 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1841 lchan->abis_ip.connect_port = port;
1842 }
1843}
1844
Harald Welte9a696d72013-02-03 12:06:58 +01001845/*! \brief Issue IPA RSL CRCX to configure RTP on BTS side
1846 * \param[in] lchan Logical Channel for which we issue CRCX
1847 */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001848int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001849{
1850 struct msgb *msg = rsl_msgb_alloc();
1851 struct abis_rsl_dchan_hdr *dh;
1852
1853 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001854 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001855 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001856 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001857
Harald Welte98d79f92009-07-28 18:11:56 +02001858 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001859 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001860 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001861 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001862 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001863
Sylvain Munaut1338a552009-12-20 22:06:40 +01001864 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1865 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1866 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001867
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001868 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001869
1870 return abis_rsl_sendmsg(msg);
1871}
1872
Harald Welte9a696d72013-02-03 12:06:58 +01001873/*! \brief Issue IPA RSL MDCX to configure MGW-side of RTP
1874 * \param[in] lchan Logical Channel for which we issue MDCX
1875 * \param[in] ip Remote (MGW) IP address for RTP
1876 * \param[in] port Remote (MGW) UDP port number for RTP
1877 * \param[in] rtp_payload2 Contents of RTP PAYLOAD 2 IE
1878 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001879int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1880 uint8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001881{
1882 struct msgb *msg = rsl_msgb_alloc();
1883 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001884 uint32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001885 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001886
1887 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001888 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001889 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001890 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001891
Harald Weltebffa4992009-12-19 16:42:06 +01001892 /* we need to store these now as MDCX_ACK does not return them :( */
1893 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1894 lchan->abis_ip.connect_port = port;
1895 lchan->abis_ip.connect_ip = ip;
1896
Harald Weltefb4a9e92009-07-29 12:12:18 +02001897 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001898 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001899 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001900
Harald Welte98d79f92009-07-28 18:11:56 +02001901 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001902 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1903 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1904 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1905 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001906
Harald Weltebffa4992009-12-19 16:42:06 +01001907 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1908 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001909 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Weltebffa4992009-12-19 16:42:06 +01001910 *att_ip = ia.s_addr;
1911 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1912 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001913 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001914 if (rtp_payload2)
1915 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001916
1917 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001918
1919 return abis_rsl_sendmsg(msg);
1920}
1921
Harald Welte9947d9f2009-12-20 16:51:09 +01001922/* tell BTS to connect RTP stream to our local RTP socket */
1923int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1924{
1925 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1926 int rc;
1927
1928 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1929 ntohs(rs->rtp.sin_local.sin_port),
1930 /* FIXME: use RTP payload of bound socket, not BTS*/
1931 lchan->abis_ip.rtp_payload2);
1932
1933 return rc;
1934}
1935
Harald Welte6f40df02010-12-23 12:59:52 +01001936int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001937{
1938 struct msgb *msg = rsl_msgb_alloc();
1939 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001940 uint8_t msg_type;
Harald Welte2b361522010-03-28 14:42:09 +08001941
1942 if (act)
1943 msg_type = RSL_MT_IPAC_PDCH_ACT;
1944 else
1945 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001946
1947 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001948 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001949 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +02001950 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001951
Harald Welte6f40df02010-12-23 12:59:52 +01001952 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001953 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001954
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001955 msg->dst = ts->trx->rsl_link;
Harald Welteaed946e2009-10-24 10:29:22 +02001956
1957 return abis_rsl_sendmsg(msg);
1958}
1959
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001960static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001961{
1962 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1963 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301964 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001965
1966 /* the BTS has acknowledged a local bind, it now tells us the IP
1967 * address and port number to which it has bound the given logical
1968 * channel */
1969
1970 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1971 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1972 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001973 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001974 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001975 return -EINVAL;
1976 }
Harald Welte50517742009-12-20 15:42:44 +01001977
Harald Weltebffa4992009-12-19 16:42:06 +01001978 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001979
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001980 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001981
1982 return 0;
1983}
1984
Harald Weltebffa4992009-12-19 16:42:06 +01001985static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1986{
1987 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1988 struct tlv_parsed tv;
1989 struct gsm_lchan *lchan = msg->lchan;
1990
1991 /* the BTS has acknowledged a remote connect request and
1992 * it now tells us the IP address and port number to which it has
1993 * connected the given logical channel */
1994
1995 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1996 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001997 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001998
1999 return 0;
2000}
2001
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002002static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08002003{
2004 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
2005 struct tlv_parsed tv;
2006
2007 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08002008
Harald Weltef1a168d2009-07-28 17:58:09 +02002009 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01002010 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02002011 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08002012
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02002013 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02002014
Harald Welte59b04682009-06-10 05:40:52 +08002015 return 0;
2016}
2017
2018static int abis_rsl_rx_ipacc(struct msgb *msg)
2019{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002020 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08002021 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01002022 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08002023 int rc = 0;
2024
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002025 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01002026 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08002027
2028 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002029 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01002030 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002031 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002032 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002033 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08002034 /* somehow the BTS was unable to bind the lchan to its local
2035 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01002036 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002037 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002038 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08002039 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01002040 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01002041 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002042 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002043 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08002044 /* somehow the BTS was unable to connect the lchan to a remote
2045 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01002046 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002047 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002048 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01002049 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002050 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002051 break;
2052 default:
Harald Weltede4477a2009-12-24 12:20:20 +01002053 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002054 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08002055 break;
2056 }
2057 DEBUGPC(DRSL, "\n");
2058
2059 return rc;
2060}
2061
2062
2063/* Entry-point where L2 RSL from BTS enters */
2064int abis_rsl_rcvmsg(struct msgb *msg)
2065{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002066 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08002067 int rc = 0;
2068
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002069 if (!msg) {
2070 DEBUGP(DRSL, "Empty RSL msg?..\n");
2071 return -1;
2072 }
2073
2074 if (msgb_l2len(msg) < sizeof(*rslh)) {
2075 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
Harald Weltece807262012-05-31 20:22:34 +02002076 msgb_free(msg);
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002077 return -1;
2078 }
2079
2080 rslh = msgb_l2(msg);
2081
Harald Welte59b04682009-06-10 05:40:52 +08002082 switch (rslh->msg_discr & 0xfe) {
2083 case ABIS_RSL_MDISC_RLL:
2084 rc = abis_rsl_rx_rll(msg);
2085 break;
2086 case ABIS_RSL_MDISC_DED_CHAN:
2087 rc = abis_rsl_rx_dchan(msg);
2088 break;
2089 case ABIS_RSL_MDISC_COM_CHAN:
2090 rc = abis_rsl_rx_cchan(msg);
2091 break;
2092 case ABIS_RSL_MDISC_TRX:
2093 rc = abis_rsl_rx_trx(msg);
2094 break;
2095 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002096 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08002097 rslh->msg_discr);
2098 break;
2099 case ABIS_RSL_MDISC_IPACCESS:
2100 rc = abis_rsl_rx_ipacc(msg);
2101 break;
2102 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002103 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
2104 "0x%02x\n", rslh->msg_discr);
Harald Weltece807262012-05-31 20:22:34 +02002105 rc = -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08002106 }
2107 msgb_free(msg);
2108 return rc;
2109}
2110
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002111int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
Harald Weltebf4ba722014-12-28 15:00:45 +01002112 struct rsl_ie_cb_cmd_type cb_command,
2113 const uint8_t *data, int len)
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002114{
2115 struct abis_rsl_dchan_hdr *dh;
2116 struct msgb *cb_cmd;
2117
2118 cb_cmd = rsl_msgb_alloc();
2119 if (!cb_cmd)
2120 return -1;
2121
Harald Weltebf4ba722014-12-28 15:00:45 +01002122 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof(*dh));
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002123 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
Harald Weltebf4ba722014-12-28 15:00:45 +01002124 dh->c.msg_discr = ABIS_RSL_MDISC_COM_CHAN;
2125 dh->chan_nr = chan_number; /* TODO: check the chan config */
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002126
Harald Weltebf4ba722014-12-28 15:00:45 +01002127 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, *(uint8_t*)&cb_command);
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002128 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
2129
Harald Weltebf4ba722014-12-28 15:00:45 +01002130 cb_cmd->dst = bts->c0->rsl_link;
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002131
2132 return abis_rsl_sendmsg(cb_cmd);
2133}
Dieter Spaar49c843e2011-07-28 00:01:50 +02002134
2135int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
2136{
2137 struct abis_rsl_common_hdr *ch;
2138 struct msgb *msg = rsl_msgb_alloc();
2139
2140 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2141 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2142 ch->msg_type = 0x40; /* Nokia SI Begin */
2143
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002144 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002145
2146 return abis_rsl_sendmsg(msg);
2147}
2148
2149int rsl_nokia_si_end(struct gsm_bts_trx *trx)
2150{
2151 struct abis_rsl_common_hdr *ch;
2152 struct msgb *msg = rsl_msgb_alloc();
2153
2154 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2155 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2156 ch->msg_type = 0x41; /* Nokia SI End */
2157
2158 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
2159
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002160 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002161
2162 return abis_rsl_sendmsg(msg);
2163}
2164
2165int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
2166{
2167 struct abis_rsl_common_hdr *ch;
2168 struct msgb *msg = rsl_msgb_alloc();
2169
2170 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2171 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
2172 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
2173
2174 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
2175 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
2176
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002177 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002178
2179 return abis_rsl_sendmsg(msg);
2180}
Holger Hans Peter Freythere38af682011-12-27 22:24:17 +01002181
2182/**
2183 * Release all allocated SAPIs starting from @param start and
2184 * release them with the given release mode. Once the release
2185 * confirmation arrives it will be attempted to release the
2186 * the RF channel.
2187 */
2188int rsl_release_sapis_from(struct gsm_lchan *lchan, int start,
2189 enum rsl_rel_mode release_mode)
2190{
2191 int no_sapi = 1;
2192 int sapi;
2193
2194 for (sapi = start; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
2195 uint8_t link_id;
2196 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
2197 continue;
2198
2199 link_id = sapi;
2200 if (lchan->type == GSM_LCHAN_TCH_F || lchan->type == GSM_LCHAN_TCH_H)
2201 link_id |= 0x40;
2202 rsl_release_request(lchan, link_id, release_mode);
2203 no_sapi = 0;
2204 }
2205
2206 return no_sapi;
2207}
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01002208
2209int rsl_start_t3109(struct gsm_lchan *lchan)
2210{
2211 struct gsm_bts *bts = lchan->ts->trx->bts;
2212
2213 /* Disabled, mostly legacy code */
2214 if (bts->network->T3109 == 0)
2215 return -1;
2216
2217 lchan->T3109.cb = t3109_expired;
2218 lchan->T3109.data = lchan;
2219 osmo_timer_schedule(&lchan->T3109, bts->network->T3109, 0);
2220 return 0;
2221}
Holger Hans Peter Freytherc63cb862012-12-25 23:45:14 +01002222
2223/**
2224 * \brief directly RF Channel Release the lchan
2225 *
2226 * When no SAPI was allocated, directly release the logical channel. This
2227 * should only be called from chan_alloc.c on channel release handling. In
2228 * case no SAPI was established the RF Channel can be directly released,
2229 */
2230int rsl_direct_rf_release(struct gsm_lchan *lchan)
2231{
2232 int i;
2233 for (i = 0; i < ARRAY_SIZE(lchan->sapis); ++i) {
2234 if (lchan->sapis[i] != LCHAN_SAPI_UNUSED) {
2235 LOGP(DRSL, LOGL_ERROR, "%s SAPI(%d) still allocated.\n",
2236 gsm_lchan_name(lchan), i);
2237 return -1;
2238 }
2239 }
2240
2241 /* Now release it */
2242 return rsl_rf_chan_release(lchan, 0, SACCH_NONE);
2243}