blob: df7678832059e16c1777331b3fe73c20801d1e67 [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
Holger Hans Peter Freytherae27c1b2015-08-20 19:32:46 +0200445static void mr_config_for_bts(struct gsm_lchan *lchan, struct msgb *msg)
446{
447 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
448 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, lchan->mr_bts_lv[0],
449 lchan->mr_bts_lv + 1);
450}
451
Harald Welte59b04682009-06-10 05:40:52 +0800452/* Chapter 8.4.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200453int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200454 uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800455{
456 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200457 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200458 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200459 uint8_t *len;
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200460 uint8_t ta;
Harald Welte59b04682009-06-10 05:40:52 +0800461
Harald Weltee6d51f92011-06-25 10:02:33 +0200462 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800463 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200464 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800465
Harald Welte39274f42009-07-29 15:41:29 +0200466 rc = channel_mode_from_lchan(&cm, lchan);
467 if (rc < 0)
468 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800469
Andreas Eversberg3ca9af32013-10-11 12:55:35 +0200470 ta = lchan->rqd_ta;
471
472 /* BS11 requires TA shifted by 2 bits */
473 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11)
474 ta <<= 2;
475
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800476 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200477 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800478
Harald Welteed831842009-06-27 03:09:08 +0200479 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800480 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
481 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
482 dh->chan_nr = chan_nr;
483
484 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800485 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200486 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800487
488 /*
489 * The Channel Identification is needed for Phase1 phones
490 * and it contains the GSM48 Channel Description and the
491 * Mobile Allocation. The GSM 08.58 asks for the Mobile
492 * Allocation to have a length of zero. We are using the
493 * msgb_l3len to calculate the length of both messages.
494 */
laforgef723cf02010-06-20 21:38:19 +0200495 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200496 len = msgb_put(msg, 1);
Dieter Spaar18a55f62011-07-27 23:40:33 +0200497 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800498
499 if (lchan->ts->hopping.enabled)
500 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
501 lchan->ts->hopping.ma_data);
502 else
503 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800504
505 /* update the calculated size */
506 msg->l3h = len + 1;
507 *len = msgb_l3len(msg);
508
Harald Welted2dd9de2009-08-30 15:37:11 +0900509 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200510 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900511 rc = build_encr_info(encr_info, lchan);
512 if (rc > 0)
513 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
514 }
515
Harald Welteb90d7bd2009-12-17 00:31:10 +0100516 switch (act_type) {
517 case RSL_ACT_INTER_ASYNC:
518 case RSL_ACT_INTER_SYNC:
519 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
520 break;
521 default:
522 break;
523 }
524
Harald Welte59b04682009-06-10 05:40:52 +0800525 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
526 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
527 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
Holger Hans Peter Freytherae27c1b2015-08-20 19:32:46 +0200528 mr_config_for_bts(lchan, msg);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100529
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200530 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800531
532 return abis_rsl_sendmsg(msg);
533}
534
Harald Welte8e770492009-07-29 11:38:15 +0200535/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800536int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
537{
538 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200539 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200540 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800541
Harald Weltee6d51f92011-06-25 10:02:33 +0200542 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800543 struct rsl_ie_chan_mode cm;
544
Harald Welte39274f42009-07-29 15:41:29 +0200545 rc = channel_mode_from_lchan(&cm, lchan);
546 if (rc < 0)
547 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800548
Harald Welteed831842009-06-27 03:09:08 +0200549 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800550 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
551 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
552 dh->chan_nr = chan_nr;
553
554 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200555 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900556
557 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200558 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900559 rc = build_encr_info(encr_info, lchan);
560 if (rc > 0)
561 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
562 }
563
Holger Hans Peter Freytherae27c1b2015-08-20 19:32:46 +0200564 mr_config_for_bts(lchan, msg);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100565
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200566 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dd9de2009-08-30 15:37:11 +0900567
568 return abis_rsl_sendmsg(msg);
569}
570
571/* Chapter 8.4.6: Send the encryption command with given L3 info */
572int rsl_encryption_cmd(struct msgb *msg)
573{
574 struct abis_rsl_dchan_hdr *dh;
575 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200576 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200577 uint8_t encr_info[MAX_A5_KEY_LEN+2];
578 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900579 int rc;
580
581 /* First push the L3 IE tag and length */
582 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
583
584 /* then the link identifier (SAPI0, main sign link) */
585 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
586
587 /* then encryption information */
588 rc = build_encr_info(encr_info, lchan);
589 if (rc <= 0)
590 return rc;
591 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
592
593 /* and finally the DCHAN header */
594 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
595 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
596 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800597
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200598 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800599
600 return abis_rsl_sendmsg(msg);
601}
602
Harald Welte85a163c2009-08-10 11:43:22 +0200603/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200604int rsl_deact_sacch(struct gsm_lchan *lchan)
605{
606 struct abis_rsl_dchan_hdr *dh;
607 struct msgb *msg = rsl_msgb_alloc();
608
609 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
610 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200611 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200612
613 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200614 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteafe3c232009-07-19 18:36:49 +0200615
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100616 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200617
618 return abis_rsl_sendmsg(msg);
619}
620
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800621static void error_timeout_cb(void *data)
622{
623 struct gsm_lchan *lchan = data;
624 if (lchan->state != LCHAN_S_REL_ERR) {
625 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
626 gsm_lchan_name(lchan), lchan->state);
627 return;
628 }
629
630 /* go back to the none state */
Harald Weltefddaba52012-11-13 04:26:22 +0100631 LOGP(DRSL, LOGL_INFO, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800632 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800633}
634
Harald Welte08011e22011-03-04 13:41:31 +0100635static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
636
Harald Welte85a163c2009-08-10 11:43:22 +0200637/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100638static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error,
639 enum sacch_deact deact_sacch)
Harald Welte59b04682009-06-10 05:40:52 +0800640{
641 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800642 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100643 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800644
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100645 /* Stop timers that should lead to a channel release */
646 osmo_timer_del(&lchan->T3109);
647
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800648 if (lchan->state == LCHAN_S_REL_ERR) {
649 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
650 gsm_lchan_name(lchan));
651 return -1;
652 }
653
654 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800655 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
656 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200657 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800658
659 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200660 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800661
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800662 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
663
664 if (error) {
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100665 /*
666 * FIXME: GSM 04.08 gives us two options for the abnormal
667 * chanel release. This can be either like in the non-existent
668 * sub-lcuase 3.5.1 or for the main signalling link deactivate
669 * the SACCH, start timer T3109 and consider the channel as
670 * released.
671 *
672 * This code is doing the later for all raido links and not
673 * only the main link. Right now all SAPIs are released on the
674 * local end, the SACCH will be de-activated and right now the
675 * T3111 will be started. First T3109 should be started and then
676 * the T3111.
677 *
678 * TODO: Move this out of the function.
679 */
680
681 /*
682 * sacch de-activate and "local end release"
683 */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100684 if (deact_sacch == SACCH_DEACTIVATE)
685 rsl_deact_sacch(lchan);
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100686 rsl_release_sapis_from(lchan, 0, RSL_REL_LOCAL_END);
687
688 /*
689 * TODO: start T3109 now.
690 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800691 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800692 }
Harald Welte59b04682009-06-10 05:40:52 +0800693
Harald Welte32951ea2011-08-10 23:26:33 +0200694 /* Start another timer or assume the BTS sends a ACK/NACK? */
695 lchan->act_timer.cb = lchan_deact_tmr_cb;
696 lchan->act_timer.data = lchan;
697 osmo_timer_schedule(&lchan->act_timer, 4, 0);
698
Harald Welte08011e22011-03-04 13:41:31 +0100699 rc = abis_rsl_sendmsg(msg);
700
Harald Welte85a163c2009-08-10 11:43:22 +0200701 /* BTS will respond by RF CHAN REL ACK */
Harald Welte08011e22011-03-04 13:41:31 +0100702 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800703}
704
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +0200705/*
706 * Special handling for channel releases in the error case.
707 */
708static int rsl_rf_chan_release_err(struct gsm_lchan *lchan)
709{
710 if (lchan->state != LCHAN_S_ACTIVE)
711 return 0;
712 return rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
713}
714
Harald Welte9773f6c2011-01-14 14:16:16 +0100715static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
716{
717
718 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
719
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100720 /* Stop all pending timers */
Harald Welte32951ea2011-08-10 23:26:33 +0200721 osmo_timer_del(&lchan->act_timer);
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100722 osmo_timer_del(&lchan->T3111);
Harald Welte32951ea2011-08-10 23:26:33 +0200723
Holger Hans Peter Freyther6f8ae692015-04-04 19:35:22 +0200724 /*
725 * The BTS didn't respond within the timeout to our channel
726 * release request and we have marked the channel as broken.
727 * Now we do receive an ACK and let's be conservative. If it
728 * is a sysmoBTS we know that only one RF Channel Release ACK
729 * will be sent. So let's "repair" the channel.
730 */
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200731 if (lchan->state == LCHAN_S_BROKEN) {
Holger Hans Peter Freyther6f8ae692015-04-04 19:35:22 +0200732 int do_free = is_sysmobts_v2(lchan->ts->trx->bts);
733 LOGP(DRSL, LOGL_NOTICE,
734 "%s CHAN REL ACK for broken channel. %s.\n",
735 gsm_lchan_name(lchan),
736 do_free ? "Releasing it" : "Keeping it broken");
737 if (do_free)
738 do_lchan_free(lchan);
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200739 return 0;
740 }
741
Harald Welte9773f6c2011-01-14 14:16:16 +0100742 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
743 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
744 gsm_lchan_name(lchan),
745 gsm_lchans_name(lchan->state));
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100746 do_lchan_free(lchan);
Harald Welte9773f6c2011-01-14 14:16:16 +0100747
748 return 0;
749}
750
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200751int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
752 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800753{
754 struct abis_rsl_dchan_hdr *dh;
755 struct msgb *msg = rsl_msgb_alloc();
756
757 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
758 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
759 dh->chan_nr = RSL_CHAN_PCH_AGCH;
760
761 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
762 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
763 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
764
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200765 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800766
767 return abis_rsl_sendmsg(msg);
768}
769
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200770int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800771{
772 int i, len = strlen(str_in);
773
774 for (i = 0; i < len; i++) {
775 int num = str_in[i] - 0x30;
776 if (num < 0 || num > 9)
777 return -1;
778 if (i % 2 == 0)
779 bcd_out[i/2] = num;
780 else
781 bcd_out[i/2] |= (num << 4);
782 }
783
784 return 0;
785}
786
787/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200788int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800789{
790 struct msgb *msg = rsl_msgb_alloc();
791 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200792 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800793
794 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
795 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
796 dh->chan_nr = RSL_CHAN_PCH_AGCH;
797
798 switch (bts->type) {
799 case GSM_BTS_TYPE_BS11:
800 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
801 break;
802 default:
803 /* If phase 2, construct a FULL_IMM_ASS_INFO */
804 pad_macblock(buf, val, len);
805 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
806 break;
807 }
808
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200809 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800810
811 return abis_rsl_sendmsg(msg);
812}
813
Harald Welte4684e632009-08-10 09:51:40 +0200814/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200815int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200816{
817 struct msgb *msg = rsl_msgb_alloc();
818 struct abis_rsl_dchan_hdr *dh;
819
820 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
821 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200822 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200823 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200824 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200825
Harald Weltede4477a2009-12-24 12:20:20 +0100826 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200827 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200828
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200829 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte874a5b42009-08-10 11:26:14 +0200830
Harald Welte4684e632009-08-10 09:51:40 +0200831 return abis_rsl_sendmsg(msg);
832}
833
834
Harald Welte59b04682009-06-10 05:40:52 +0800835/* Send "DATA REQUEST" message with given L3 Info payload */
836/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200837int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800838{
Harald Welte59b04682009-06-10 05:40:52 +0800839 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100840 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800841 return -EINVAL;
842 }
843
Harald Weltee6d51f92011-06-25 10:02:33 +0200844 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100845 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800846
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200847 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800848
849 return abis_rsl_sendmsg(msg);
850}
851
Harald Welteed9a5ab2009-08-09 13:47:35 +0200852/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
853/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200854int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200855{
Harald Weltea22d36b2010-03-04 10:33:10 +0100856 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200857
Harald Weltee6d51f92011-06-25 10:02:33 +0200858 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100859 link_id, 0);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200860 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200861
Harald Welte17091bd2012-04-26 19:42:19 +0200862 DEBUGP(DRLL, "%s RSL RLL ESTABLISH REQ (link_id=0x%02x)\n",
863 gsm_lchan_name(lchan), link_id);
864
Harald Welteed9a5ab2009-08-09 13:47:35 +0200865 return abis_rsl_sendmsg(msg);
866}
867
Andreas Eversbergac27b952013-12-05 13:25:06 +0100868static void rsl_handle_release(struct gsm_lchan *lchan);
869
870/* Special work handler to handle missing RSL_MT_REL_CONF message from
871 * Nokia InSite BTS */
872static void lchan_rel_work_cb(void *data)
873{
874 struct gsm_lchan *lchan = data;
875 int sapi;
876
877 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
878 if (lchan->sapis[sapi] == LCHAN_SAPI_REL)
879 lchan->sapis[sapi] = LCHAN_SAPI_UNUSED;
880 }
881 rsl_handle_release(lchan);
882}
883
Harald Welte0f2e3c12009-08-08 13:15:07 +0200884/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
885 This is what higher layers should call. The BTS then responds with
886 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
887 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
888 lchan_free() */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100889int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id,
890 enum rsl_rel_mode release_mode)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200891{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200892
Harald Weltea22d36b2010-03-04 10:33:10 +0100893 struct msgb *msg;
894
Harald Weltee6d51f92011-06-25 10:02:33 +0200895 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100896 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800897 /* 0 is normal release, 1 is local end */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100898 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, release_mode);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200899
Harald Weltec88a4432009-12-29 10:44:17 +0100900 /* FIXME: start some timer in case we don't receive a REL ACK ? */
901
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200902 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200903
Harald Welte17091bd2012-04-26 19:42:19 +0200904 DEBUGP(DRLL, "%s RSL RLL RELEASE REQ (link_id=0x%02x, reason=%u)\n",
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100905 gsm_lchan_name(lchan), link_id, release_mode);
Harald Welte17091bd2012-04-26 19:42:19 +0200906
Andreas Eversbergac27b952013-12-05 13:25:06 +0100907 abis_rsl_sendmsg(msg);
908
909 /* Do not wait for Nokia BTS to send the confirm. */
910 if (is_nokia_bts(lchan->ts->trx->bts)
911 && lchan->ts->trx->bts->nokia.no_loc_rel_cnf
912 && release_mode == RSL_REL_LOCAL_END) {
913 DEBUGP(DRLL, "Scheduling release, becasuse Nokia InSite BTS does not send a RELease CONFirm.\n");
914 lchan->sapis[link_id & 0x7] = LCHAN_SAPI_REL;
915 lchan->rel_work.cb = lchan_rel_work_cb;
916 lchan->rel_work.data = lchan;
917 osmo_timer_schedule(&lchan->rel_work, 0, 0);
918 }
919
920 return 0;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200921}
922
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +0100923int rsl_lchan_mark_broken(struct gsm_lchan *lchan, const char *reason)
924{
925 lchan->state = LCHAN_S_BROKEN;
926 lchan->broken_reason = reason;
927 return 0;
928}
929
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200930int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
931{
932 lchan->state = state;
933 return 0;
934}
935
Harald Welte59b04682009-06-10 05:40:52 +0800936/* Chapter 8.4.2: Channel Activate Acknowledge */
937static int rsl_rx_chan_act_ack(struct msgb *msg)
938{
939 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
940
941 /* BTS has confirmed channel activation, we now need
942 * to assign the activated channel to the MS */
943 if (rslh->ie_chan != RSL_IE_CHAN_NR)
944 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100945
Harald Welte32951ea2011-08-10 23:26:33 +0200946 osmo_timer_del(&msg->lchan->act_timer);
947
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200948 if (msg->lchan->state == LCHAN_S_BROKEN) {
949 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK for broken channel.\n",
950 gsm_lchan_name(msg->lchan));
951 return 0;
952 }
953
Harald Weltec88a4432009-12-29 10:44:17 +0100954 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100955 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
956 gsm_lchan_name(msg->lchan),
957 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200958 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100959
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800960 if (msg->lchan->rqd_ref) {
961 rsl_send_imm_assignment(msg->lchan);
962 talloc_free(msg->lchan->rqd_ref);
963 msg->lchan->rqd_ref = NULL;
964 msg->lchan->rqd_ta = 0;
965 }
966
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100967 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100968
Harald Welte59b04682009-06-10 05:40:52 +0800969 return 0;
970}
971
972/* Chapter 8.4.3: Channel Activate NACK */
973static int rsl_rx_chan_act_nack(struct msgb *msg)
974{
975 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
976 struct tlv_parsed tp;
977
Harald Welte32951ea2011-08-10 23:26:33 +0200978 osmo_timer_del(&msg->lchan->act_timer);
979
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200980 if (msg->lchan->state == LCHAN_S_BROKEN) {
981 LOGP(DRSL, LOGL_ERROR,
982 "%s CHANNEL ACTIVATE NACK for broken channel.\n",
983 gsm_lchan_name(msg->lchan));
984 return -1;
985 }
986
Daniel Willmann9e9d44c2011-08-11 04:54:23 +0200987 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100988 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100989
Harald Welte59b04682009-06-10 05:40:52 +0800990 /* BTS has rejected channel activation ?!? */
991 if (dh->ie_chan != RSL_IE_CHAN_NR)
992 return -EINVAL;
993
994 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100995 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200996 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100997 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200998 TLVP_LEN(&tp, RSL_IE_CAUSE));
Holger Hans Peter Freyther5149c172012-12-06 19:25:06 +0100999 msg->lchan->error_cause = *cause;
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +01001000 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC) {
1001 rsl_lchan_mark_broken(msg->lchan, "NACK on activation");
1002 } else
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001003 rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Daniel Willmann245ee032011-08-11 04:47:11 +02001004
Holger Hans Peter Freyther960adfe2014-12-28 12:08:28 +01001005 } else {
1006 rsl_lchan_mark_broken(msg->lchan, "NACK on activation no IE");
1007 }
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001008
Harald Welte (local)ed6d7622009-12-27 11:48:11 +01001009 LOGPC(DRSL, LOGL_ERROR, "\n");
1010
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001011 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte59b04682009-06-10 05:40:52 +08001012 return 0;
1013}
1014
1015/* Chapter 8.4.4: Connection Failure Indication */
1016static int rsl_rx_conn_fail(struct msgb *msg)
1017{
1018 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1019 struct tlv_parsed tp;
1020
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001021 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING state %s ",
1022 gsm_lchan_name(msg->lchan),
1023 gsm_lchans_name(msg->lchan->state));
1024
Harald Welte59b04682009-06-10 05:40:52 +08001025 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1026
Harald Weltef1a168d2009-07-28 17:58:09 +02001027 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001028 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001029 TLVP_LEN(&tp, RSL_IE_CAUSE));
1030
Harald Welte (local)4bd76642009-12-26 22:33:09 +01001031 LOGPC(DRSL, LOGL_NOTICE, "\n");
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001032 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +02001033 return rsl_rf_chan_release_err(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001034}
1035
Harald Weltec20bd1d2009-11-29 19:07:28 +01001036static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
1037 const char *prefix)
1038{
Harald Welte0e4fa782009-12-16 16:52:07 +01001039 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
1040 prefix, rxlev2dbm(mru->full.rx_lev),
1041 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +01001042 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
1043 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
1044}
1045
Harald Welte50290cc2012-07-02 17:12:08 +02001046static void print_meas_rep(struct gsm_lchan *lchan, struct gsm_meas_rep *mr)
Harald Weltec20bd1d2009-11-29 19:07:28 +01001047{
Harald Welte0e4fa782009-12-16 16:52:07 +01001048 int i;
Harald Welte50290cc2012-07-02 17:12:08 +02001049 char *name = "";
Harald Welte0e4fa782009-12-16 16:52:07 +01001050
Harald Welte50290cc2012-07-02 17:12:08 +02001051 if (lchan && lchan->conn && lchan->conn->subscr)
1052 name = subscr_name(lchan->conn->subscr);
1053
1054 DEBUGP(DMEAS, "[%s] MEASUREMENT RESULT NR=%d ", name, mr->nr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001055
1056 if (mr->flags & MEAS_REP_F_DL_DTX)
1057 DEBUGPC(DMEAS, "DTXd ");
1058
1059 print_meas_rep_uni(&mr->ul, "ul");
1060 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
1061 if (mr->flags & MEAS_REP_F_MS_TO)
1062 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
1063
1064 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +01001065 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001066 DEBUGPC(DMEAS, "L1_FPC=%u ",
1067 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1068 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1069 }
1070
1071 if (mr->flags & MEAS_REP_F_UL_DTX)
1072 DEBUGPC(DMEAS, "DTXu ");
1073 if (mr->flags & MEAS_REP_F_BA1)
1074 DEBUGPC(DMEAS, "BA1 ");
1075 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1076 DEBUGPC(DMEAS, "NOT VALID ");
1077 else
1078 print_meas_rep_uni(&mr->dl, "dl");
1079
1080 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001081 if (mr->num_cell == 7)
1082 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001083 for (i = 0; i < mr->num_cell; i++) {
1084 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +01001085 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1086 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +01001087 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001088}
1089
Harald Welte59b04682009-06-10 05:40:52 +08001090static int rsl_rx_meas_res(struct msgb *msg)
1091{
1092 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1093 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001094 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001095 uint8_t len;
1096 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +01001097 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001098
Harald Welte4baa9c52009-12-21 13:27:11 +01001099 /* check if this channel is actually active */
1100 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +01001101 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +08001102 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +01001103 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +01001104 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +01001105 }
Harald Welte4baa9c52009-12-21 13:27:11 +01001106
Harald Weltef9476812009-12-15 21:36:05 +01001107 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001108 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001109
Harald Welte59b04682009-06-10 05:40:52 +08001110 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1111
Harald Weltec20bd1d2009-11-29 19:07:28 +01001112 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1113 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1114 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1115 return -EIO;
1116
1117 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001118 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001119
1120 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1121 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1122 if (len >= 3) {
1123 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001124 mr->flags |= MEAS_REP_F_DL_DTX;
1125 mr->ul.full.rx_lev = val[0] & 0x3f;
1126 mr->ul.sub.rx_lev = val[1] & 0x3f;
1127 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1128 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001129 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001130
Harald Weltef9476812009-12-15 21:36:05 +01001131 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001132
1133 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001134 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001135 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001136 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1137
Harald Weltea1467eb2009-06-20 18:44:35 +02001138 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001139 struct e1inp_sign_link *sign_link = msg->dst;
1140
Harald Weltec20bd1d2009-11-29 19:07:28 +01001141 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001142 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001143 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001144 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001145 mr->flags |= MEAS_REP_F_FPC;
1146 mr->ms_l1.ta = val[1];
Andreas Eversbergfe56cf82011-12-24 11:49:05 +01001147 /* BS11 and Nokia reports TA shifted by 2 bits */
1148 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1149 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001150 mr->ms_l1.ta >>= 2;
Harald Weltea1467eb2009-06-20 18:44:35 +02001151 }
Harald Welte59b04682009-06-10 05:40:52 +08001152 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001153 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001154 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001155 if (rc < 0)
1156 return rc;
1157 }
1158
Harald Welte50290cc2012-07-02 17:12:08 +02001159 print_meas_rep(msg->lchan, mr);
Harald Welte59b04682009-06-10 05:40:52 +08001160
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001161 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001162
Harald Welte59b04682009-06-10 05:40:52 +08001163 return 0;
1164}
1165
Harald Welte6720a432009-11-29 22:45:52 +01001166/* Chapter 8.4.7 */
1167static int rsl_rx_hando_det(struct msgb *msg)
1168{
1169 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1170 struct tlv_parsed tp;
1171
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001172 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001173
1174 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1175
1176 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1177 DEBUGPC(DRSL, "access delay = %u\n",
1178 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1179 else
1180 DEBUGPC(DRSL, "\n");
1181
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001182 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001183
1184 return 0;
1185}
1186
Harald Welte59b04682009-06-10 05:40:52 +08001187static int abis_rsl_rx_dchan(struct msgb *msg)
1188{
1189 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1190 int rc = 0;
1191 char *ts_name;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001192 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001193
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001194 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001195 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001196
Harald Welte59b04682009-06-10 05:40:52 +08001197 switch (rslh->c.msg_type) {
1198 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001199 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001200 rc = rsl_rx_chan_act_ack(msg);
1201 break;
1202 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001203 rc = rsl_rx_chan_act_nack(msg);
1204 break;
1205 case RSL_MT_CONN_FAIL:
1206 rc = rsl_rx_conn_fail(msg);
1207 break;
1208 case RSL_MT_MEAS_RES:
1209 rc = rsl_rx_meas_res(msg);
1210 break;
Harald Welte6720a432009-11-29 22:45:52 +01001211 case RSL_MT_HANDO_DET:
1212 rc = rsl_rx_hando_det(msg);
1213 break;
Harald Welte59b04682009-06-10 05:40:52 +08001214 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001215 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001216 break;
1217 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001218 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001219 break;
1220 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001221 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001222 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001223 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001224 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001225 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001226 break;
1227 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001228 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001229 break;
1230 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001231 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001232 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001233 break;
1234 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001235 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001236 break;
Harald Welte59b04682009-06-10 05:40:52 +08001237 case RSL_MT_PHY_CONTEXT_CONF:
1238 case RSL_MT_PREPROC_MEAS_RES:
1239 case RSL_MT_TALKER_DET:
1240 case RSL_MT_LISTENER_DET:
1241 case RSL_MT_REMOTE_CODEC_CONF_REP:
1242 case RSL_MT_MR_CODEC_MOD_ACK:
1243 case RSL_MT_MR_CODEC_MOD_NACK:
1244 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001245 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1246 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001247 break;
1248 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001249 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1250 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001251 return -EINVAL;
1252 }
1253
1254 return rc;
1255}
1256
1257static int rsl_rx_error_rep(struct msgb *msg)
1258{
1259 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001260 struct tlv_parsed tp;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001261 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001262
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001263 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001264
1265 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1266
1267 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001268 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001269 TLVP_LEN(&tp, RSL_IE_CAUSE));
1270
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001271 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001272
1273 return 0;
1274}
1275
1276static int abis_rsl_rx_trx(struct msgb *msg)
1277{
1278 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001279 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001280 int rc = 0;
1281
1282 switch (rslh->msg_type) {
1283 case RSL_MT_ERROR_REPORT:
1284 rc = rsl_rx_error_rep(msg);
1285 break;
1286 case RSL_MT_RF_RES_IND:
1287 /* interference on idle channels of TRX */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001288 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001289 break;
1290 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001291 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001292 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001293 gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001294 break;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001295 case 0x42: /* Nokia specific: SI End ACK */
1296 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1297 break;
1298 case 0x43: /* Nokia specific: SI End NACK */
1299 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1300 break;
Harald Welte59b04682009-06-10 05:40:52 +08001301 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001302 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001303 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001304 return -EINVAL;
1305 }
1306 return rc;
1307}
1308
Harald Welte427dbc42009-08-10 00:26:10 +02001309/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1310static void t3101_expired(void *data)
1311{
1312 struct gsm_lchan *lchan = data;
1313
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001314 rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
Harald Welte427dbc42009-08-10 00:26:10 +02001315}
1316
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001317/* If T3111 expires, we will send the RF Channel Request */
1318static void t3111_expired(void *data)
1319{
1320 struct gsm_lchan *lchan = data;
1321
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001322 rsl_rf_chan_release(lchan, 0, SACCH_NONE);
1323}
1324
1325/* If T3109 expires the MS has not send a UA/UM do the error release */
1326static void t3109_expired(void *data)
1327{
1328 struct gsm_lchan *lchan = data;
1329
1330 LOGP(DRSL, LOGL_ERROR,
1331 "%s SACCH deactivation timeout.\n", gsm_lchan_name(lchan));
1332 rsl_rf_chan_release(lchan, 1, SACCH_NONE);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001333}
1334
Harald Weltea00fdd72010-12-23 14:39:29 +01001335/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1336static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1337 unsigned int num_req_refs,
1338 struct gsm48_req_ref *rqd_refs,
1339 uint8_t wait_ind)
1340{
1341 uint8_t buf[GSM_MACBLOCK_LEN];
1342 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1343
1344 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1345 memset(iar, 0, sizeof(*iar));
1346 iar->proto_discr = GSM48_PDISC_RR;
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001347 iar->msg_type = GSM48_MT_RR_IMM_ASS_REJ;
Harald Weltea00fdd72010-12-23 14:39:29 +01001348 iar->page_mode = GSM48_PM_SAME;
1349
1350 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1351 iar->wait_ind1 = wait_ind;
1352
1353 if (num_req_refs >= 2)
1354 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1355 else
1356 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1357 iar->wait_ind2 = wait_ind;
1358
1359 if (num_req_refs >= 3)
1360 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1361 else
1362 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1363 iar->wait_ind3 = wait_ind;
1364
1365 if (num_req_refs >= 4)
1366 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1367 else
1368 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1369 iar->wait_ind4 = wait_ind;
1370
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001371 /* we need to subtract 1 byte from sizeof(*iar) since ia includes the l2_plen field */
1372 iar->l2_plen = GSM48_LEN2PLEN((sizeof(*iar)-1));
1373
1374 return rsl_imm_assign_cmd(bts, sizeof(*iar), (uint8_t *) iar);
Harald Weltea00fdd72010-12-23 14:39:29 +01001375}
1376
Harald Welte59b04682009-06-10 05:40:52 +08001377/* MS has requested a channel on the RACH */
1378static int rsl_rx_chan_rqd(struct msgb *msg)
1379{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001380 struct e1inp_sign_link *sign_link = msg->dst;
1381 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001382 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1383 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001384 enum gsm_chan_t lctype;
1385 enum gsm_chreq_reason_t chreq_reason;
1386 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001387 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001388 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001389
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001390 uint16_t arfcn;
Holger Hans Peter Freytherefd75b52012-02-03 20:10:13 +01001391 uint8_t subch;
Harald Welte59b04682009-06-10 05:40:52 +08001392
1393 /* parse request reference to be used in immediate assign */
1394 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1395 return -EINVAL;
1396
1397 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1398
1399 /* parse access delay and use as TA */
1400 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1401 return -EINVAL;
1402 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1403
1404 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1405 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001406 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1407 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001408
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001409 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001410
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001411 /*
1412 * We want LOCATION UPDATES to succeed and will assign a TCH
1413 * if we have no SDCCH available.
1414 */
1415 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1416
Harald Welte59b04682009-06-10 05:40:52 +08001417 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001418 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001419 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001420 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001421 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001422 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001423 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1424 if (bts->network->T3122)
1425 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Weltecf7c90c2012-11-13 04:46:03 +01001426 return 0;
Harald Welte59b04682009-06-10 05:40:52 +08001427 }
1428
Harald Weltec88a4432009-12-29 10:44:17 +01001429 if (lchan->state != LCHAN_S_NONE)
1430 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001431 "in state %s\n", gsm_lchan_name(lchan),
1432 gsm_lchans_name(lchan->state));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001433
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001434 /* save the RACH data as we need it after the CHAN ACT ACK */
1435 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1436 if (!lchan->rqd_ref) {
1437 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1438 lchan_free(lchan);
1439 return -ENOMEM;
1440 }
1441
Holger Hans Peter Freyther161cec12011-12-29 23:33:04 +01001442 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001443 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1444 lchan->rqd_ta = rqd_ta;
1445
Harald Welte59b04682009-06-10 05:40:52 +08001446 arfcn = lchan->ts->trx->arfcn;
1447 subch = lchan->nr;
1448
Harald Welted2dd9de2009-08-30 15:37:11 +09001449 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001450 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001451 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001452 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001453 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001454
Harald Welte32951ea2011-08-10 23:26:33 +02001455 /* Start another timer or assume the BTS sends a ACK/NACK? */
1456 lchan->act_timer.cb = lchan_act_tmr_cb;
1457 lchan->act_timer.data = lchan;
1458 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1459
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001460 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1461 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1462 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1463 rqd_ref->ra, rqd_ta);
1464
Andreas Eversberg3ca9af32013-10-11 12:55:35 +02001465 rsl_chan_activate_lchan(lchan, 0x00, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001466
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001467 return 0;
1468}
1469
1470static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1471{
1472 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001473 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001474 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1475
Harald Welte59b04682009-06-10 05:40:52 +08001476 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001477 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001478 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001479 ia->proto_discr = GSM48_PDISC_RR;
1480 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1481 ia->page_mode = GSM48_PM_SAME;
1482 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001483
Harald Welte59b04682009-06-10 05:40:52 +08001484 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001485 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1486 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001487 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001488 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001489 } else {
laforgee06d5982010-06-20 15:18:46 +02001490 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1491 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001492 }
Harald Welte07f32182010-06-28 18:41:27 +02001493 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1494 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001495
Harald Welte427dbc42009-08-10 00:26:10 +02001496 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1497 lchan->T3101.cb = t3101_expired;
1498 lchan->T3101.data = lchan;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001499 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001500
1501 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001502 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001503}
1504
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001505/* current load on the CCCH */
Harald Welte59b04682009-06-10 05:40:52 +08001506static int rsl_rx_ccch_load(struct msgb *msg)
1507{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001508 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001509 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001510 struct ccch_signal_data sd;
1511
1512 sd.bts = sign_link->trx->bts;
1513 sd.rach_slot_count = -1;
1514 sd.rach_busy_count = -1;
1515 sd.rach_access_count = -1;
Harald Welte59b04682009-06-10 05:40:52 +08001516
1517 switch (rslh->data[0]) {
1518 case RSL_IE_PAGING_LOAD:
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001519 sd.pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1520 if (is_ipaccess_bts(sign_link->trx->bts) && sd.pg_buf_space == 0xffff) {
Harald Welte008a4922010-04-19 10:24:07 +02001521 /* paging load below configured threshold, use 50 as default */
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001522 sd.pg_buf_space = 50;
Harald Welte008a4922010-04-19 10:24:07 +02001523 }
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001524 paging_update_buffer_space(sign_link->trx->bts, sd.pg_buf_space);
1525 osmo_signal_dispatch(SS_CCCH, S_CCCH_PAGING_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001526 break;
1527 case RSL_IE_RACH_LOAD:
1528 if (msg->data_len >= 7) {
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001529 sd.rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1530 sd.rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1531 sd.rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1532 osmo_signal_dispatch(SS_CCCH, S_CCCH_RACH_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001533 }
1534 break;
1535 default:
1536 break;
1537 }
1538
1539 return 0;
1540}
1541
1542static int abis_rsl_rx_cchan(struct msgb *msg)
1543{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001544 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001545 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1546 int rc = 0;
1547
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001548 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +08001549
1550 switch (rslh->c.msg_type) {
1551 case RSL_MT_CHAN_RQD:
1552 /* MS has requested a channel on the RACH */
1553 rc = rsl_rx_chan_rqd(msg);
1554 break;
1555 case RSL_MT_CCCH_LOAD_IND:
1556 /* current load on the CCCH */
1557 rc = rsl_rx_ccch_load(msg);
1558 break;
1559 case RSL_MT_DELETE_IND:
1560 /* CCCH overloaded, IMM_ASSIGN was dropped */
1561 case RSL_MT_CBCH_LOAD_IND:
1562 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001563 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1564 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001565 break;
1566 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001567 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1568 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001569 return -EINVAL;
1570 }
1571
1572 return rc;
1573}
1574
1575static int rsl_rx_rll_err_ind(struct msgb *msg)
1576{
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001577 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001578 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001579 uint8_t rlm_cause;
Harald Welte59b04682009-06-10 05:40:52 +08001580
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001581 rsl_tlv_parse(&tp, rllh->data, msgb_l2len(msg) - sizeof(*rllh));
1582 if (!TLVP_PRESENT(&tp, RSL_IE_RLM_CAUSE)) {
1583 LOGP(DRLL, LOGL_ERROR,
1584 "%s ERROR INDICATION without mandantory cause.\n",
1585 gsm_lchan_name(msg->lchan));
1586 return -1;
1587 }
1588
1589 rlm_cause = *TLVP_VAL(&tp, RSL_IE_RLM_CAUSE);
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001590 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s in state=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001591 gsm_lchan_name(msg->lchan),
Holger Hans Peter Freytherde4da292014-04-19 16:45:36 +02001592 rsl_rlm_cause_name(rlm_cause),
1593 gsm_lchans_name(msg->lchan->state));
1594
Harald Welteed9a5ab2009-08-09 13:47:35 +02001595 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001596
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001597 if (rlm_cause == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001598 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther29eb19b2014-04-19 17:38:33 +02001599 return rsl_rf_chan_release_err(msg->lchan);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001600 }
Harald Welte692f5852009-07-04 09:40:05 +02001601
Harald Welte59b04682009-06-10 05:40:52 +08001602 return 0;
1603}
1604
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001605static void rsl_handle_release(struct gsm_lchan *lchan)
1606{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001607 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001608 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001609
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +01001610 /*
1611 * Maybe only one link/SAPI was releasd or the error handling
1612 * was activated. Just return now and let the other code handle
1613 * it.
1614 */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001615 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001616 return;
1617
1618 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1619 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1620 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001621 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001622 gsm_lchan_name(lchan), sapi);
1623 return;
1624 }
1625
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001626
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001627 /* Stop T3109 and wait for T3111 before re-using the channel */
1628 osmo_timer_del(&lchan->T3109);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001629 lchan->T3111.cb = t3111_expired;
1630 lchan->T3111.data = lchan;
1631 bts = lchan->ts->trx->bts;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001632 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001633}
1634
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001635/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001636 0x02, 0x06,
1637 0x01, 0x20,
1638 0x02, 0x00,
1639 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1640
1641static int abis_rsl_rx_rll(struct msgb *msg)
1642{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001643 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001644 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1645 int rc = 0;
1646 char *ts_name;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001647 uint8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001648
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001649 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001650 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001651 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001652
1653 switch (rllh->c.msg_type) {
1654 case RSL_MT_DATA_IND:
1655 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001656 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001657 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1658 rllh->data[0] == RSL_IE_L3_INFO) {
1659 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001660 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001661 }
1662 break;
1663 case RSL_MT_EST_IND:
1664 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001665 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001666 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001667 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001668 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001669 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1670 rllh->data[0] == RSL_IE_L3_INFO) {
1671 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001672 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001673 }
1674 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001675 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001676 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001677 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001678 rll_indication(msg->lchan, rllh->link_id,
1679 BSC_RLLR_IND_EST_CONF);
1680 break;
Harald Welte59b04682009-06-10 05:40:52 +08001681 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001682 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001683 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001684 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001685 rll_indication(msg->lchan, rllh->link_id,
1686 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001687 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001688 break;
1689 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001690 /* BTS informs us of having received UA from MS,
1691 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001692 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001693 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001694 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001695 break;
1696 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001697 rc = rsl_rx_rll_err_ind(msg);
1698 break;
1699 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001700 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1701 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001702 break;
1703 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001704 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1705 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001706 }
Harald Welte59b04682009-06-10 05:40:52 +08001707 return rc;
1708}
1709
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001710static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001711{
Harald Welteb284b472009-12-02 01:58:23 +05301712 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001713 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301714 switch (lchan->type) {
1715 case GSM_LCHAN_TCH_F:
1716 return 0x00;
1717 case GSM_LCHAN_TCH_H:
1718 return 0x03;
1719 default:
1720 break;
1721 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001722 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001723 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301724 switch (lchan->type) {
1725 case GSM_LCHAN_TCH_F:
1726 return 0x01;
1727 /* there's no half-rate EFR */
1728 default:
1729 break;
1730 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001731 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001732 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301733 switch (lchan->type) {
1734 case GSM_LCHAN_TCH_F:
1735 return 0x02;
1736 case GSM_LCHAN_TCH_H:
1737 return 0x05;
1738 default:
1739 break;
1740 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001741 break;
Harald Welteb284b472009-12-02 01:58:23 +05301742 default:
1743 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001744 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001745 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301746 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001747 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001748}
1749
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001750static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munaut1338a552009-12-20 22:06:40 +01001751{
1752 switch (lchan->tch_mode) {
1753 case GSM48_CMODE_SPEECH_V1:
1754 switch (lchan->type) {
1755 case GSM_LCHAN_TCH_F:
1756 return RTP_PT_GSM_FULL;
1757 case GSM_LCHAN_TCH_H:
1758 return RTP_PT_GSM_HALF;
1759 default:
1760 break;
1761 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001762 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001763 case GSM48_CMODE_SPEECH_EFR:
1764 switch (lchan->type) {
1765 case GSM_LCHAN_TCH_F:
1766 return RTP_PT_GSM_EFR;
1767 /* there's no half-rate EFR */
1768 default:
1769 break;
1770 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001771 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001772 case GSM48_CMODE_SPEECH_AMR:
1773 switch (lchan->type) {
1774 case GSM_LCHAN_TCH_F:
Sylvain Munaut1338a552009-12-20 22:06:40 +01001775 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freytherd78bee82011-07-21 10:24:46 +02001776 return RTP_PT_AMR;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001777 default:
1778 break;
1779 }
Holger Hans Peter Freythere5236092014-04-04 12:14:55 +02001780 break;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001781 default:
1782 break;
1783 }
1784 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1785 "tch_mode == 0x%02x\n & lchan_type == %d",
1786 lchan->tch_mode, lchan->type);
1787 return 0;
1788}
1789
Harald Welte59b04682009-06-10 05:40:52 +08001790/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001791static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1792{
1793 struct in_addr ip;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001794 uint16_t port, conn_id;
Harald Weltebffa4992009-12-19 16:42:06 +01001795
1796 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001797 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_LOCAL_IP);
Harald Weltebffa4992009-12-19 16:42:06 +01001798 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1799 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1800 }
1801
1802 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001803 port = tlvp_val16_unal(tv, RSL_IE_IPAC_LOCAL_PORT);
Harald Weltebffa4992009-12-19 16:42:06 +01001804 port = ntohs(port);
1805 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1806 lchan->abis_ip.bound_port = port;
1807 }
1808
1809 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001810 conn_id = tlvp_val16_unal(tv, RSL_IE_IPAC_CONN_ID);
Harald Weltebffa4992009-12-19 16:42:06 +01001811 conn_id = ntohs(conn_id);
1812 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1813 lchan->abis_ip.conn_id = conn_id;
1814 }
1815
1816 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1817 lchan->abis_ip.rtp_payload2 =
1818 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1819 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1820 lchan->abis_ip.rtp_payload2);
1821 }
1822
1823 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1824 lchan->abis_ip.speech_mode =
1825 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1826 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1827 lchan->abis_ip.speech_mode);
1828 }
1829
1830 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001831 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_REMOTE_IP);
Harald Weltebffa4992009-12-19 16:42:06 +01001832 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1833 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1834 }
1835
1836 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Daniel Willmannb97c9d12014-06-27 17:05:47 +02001837 port = tlvp_val16_unal(tv, RSL_IE_IPAC_REMOTE_PORT);
Harald Weltebffa4992009-12-19 16:42:06 +01001838 port = ntohs(port);
1839 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1840 lchan->abis_ip.connect_port = port;
1841 }
1842}
1843
Harald Welte9a696d72013-02-03 12:06:58 +01001844/*! \brief Issue IPA RSL CRCX to configure RTP on BTS side
1845 * \param[in] lchan Logical Channel for which we issue CRCX
1846 */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001847int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001848{
1849 struct msgb *msg = rsl_msgb_alloc();
1850 struct abis_rsl_dchan_hdr *dh;
1851
1852 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001853 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001854 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001855 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001856
Harald Welte98d79f92009-07-28 18:11:56 +02001857 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001858 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001859 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001860 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001861 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001862
Sylvain Munaut1338a552009-12-20 22:06:40 +01001863 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1864 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1865 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001866
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001867 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001868
1869 return abis_rsl_sendmsg(msg);
1870}
1871
Harald Welte9a696d72013-02-03 12:06:58 +01001872/*! \brief Issue IPA RSL MDCX to configure MGW-side of RTP
1873 * \param[in] lchan Logical Channel for which we issue MDCX
1874 * \param[in] ip Remote (MGW) IP address for RTP
1875 * \param[in] port Remote (MGW) UDP port number for RTP
1876 * \param[in] rtp_payload2 Contents of RTP PAYLOAD 2 IE
1877 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001878int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1879 uint8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001880{
1881 struct msgb *msg = rsl_msgb_alloc();
1882 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001883 uint32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001884 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001885
1886 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001887 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001888 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001889 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001890
Harald Weltebffa4992009-12-19 16:42:06 +01001891 /* we need to store these now as MDCX_ACK does not return them :( */
1892 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1893 lchan->abis_ip.connect_port = port;
1894 lchan->abis_ip.connect_ip = ip;
1895
Harald Weltefb4a9e92009-07-29 12:12:18 +02001896 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001897 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001898 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001899
Harald Welte98d79f92009-07-28 18:11:56 +02001900 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001901 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1902 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1903 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1904 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001905
Harald Weltebffa4992009-12-19 16:42:06 +01001906 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1907 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001908 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Weltebffa4992009-12-19 16:42:06 +01001909 *att_ip = ia.s_addr;
1910 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1911 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001912 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001913 if (rtp_payload2)
1914 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001915
1916 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001917
1918 return abis_rsl_sendmsg(msg);
1919}
1920
Harald Welte9947d9f2009-12-20 16:51:09 +01001921/* tell BTS to connect RTP stream to our local RTP socket */
1922int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1923{
1924 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1925 int rc;
1926
1927 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1928 ntohs(rs->rtp.sin_local.sin_port),
1929 /* FIXME: use RTP payload of bound socket, not BTS*/
1930 lchan->abis_ip.rtp_payload2);
1931
1932 return rc;
1933}
1934
Harald Welte6f40df02010-12-23 12:59:52 +01001935int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001936{
1937 struct msgb *msg = rsl_msgb_alloc();
1938 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001939 uint8_t msg_type;
Harald Welte2b361522010-03-28 14:42:09 +08001940
1941 if (act)
1942 msg_type = RSL_MT_IPAC_PDCH_ACT;
1943 else
1944 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001945
1946 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001947 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001948 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +02001949 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001950
Harald Welte6f40df02010-12-23 12:59:52 +01001951 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001952 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001953
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001954 msg->dst = ts->trx->rsl_link;
Harald Welteaed946e2009-10-24 10:29:22 +02001955
1956 return abis_rsl_sendmsg(msg);
1957}
1958
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001959static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001960{
1961 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1962 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301963 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001964
1965 /* the BTS has acknowledged a local bind, it now tells us the IP
1966 * address and port number to which it has bound the given logical
1967 * channel */
1968
1969 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1970 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1971 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001972 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001973 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001974 return -EINVAL;
1975 }
Harald Welte50517742009-12-20 15:42:44 +01001976
Harald Weltebffa4992009-12-19 16:42:06 +01001977 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001978
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001979 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001980
1981 return 0;
1982}
1983
Harald Weltebffa4992009-12-19 16:42:06 +01001984static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1985{
1986 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1987 struct tlv_parsed tv;
1988 struct gsm_lchan *lchan = msg->lchan;
1989
1990 /* the BTS has acknowledged a remote connect request and
1991 * it now tells us the IP address and port number to which it has
1992 * connected the given logical channel */
1993
1994 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1995 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001996 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001997
1998 return 0;
1999}
2000
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002001static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08002002{
2003 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
2004 struct tlv_parsed tv;
2005
2006 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08002007
Harald Weltef1a168d2009-07-28 17:58:09 +02002008 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01002009 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02002010 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08002011
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02002012 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02002013
Harald Welte59b04682009-06-10 05:40:52 +08002014 return 0;
2015}
2016
2017static int abis_rsl_rx_ipacc(struct msgb *msg)
2018{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002019 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08002020 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01002021 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08002022 int rc = 0;
2023
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002024 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01002025 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08002026
2027 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002028 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01002029 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002030 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002031 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002032 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08002033 /* somehow the BTS was unable to bind the lchan to its local
2034 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01002035 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002036 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002037 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08002038 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01002039 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01002040 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002041 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002042 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08002043 /* somehow the BTS was unable to connect the lchan to a remote
2044 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01002045 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002046 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002047 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01002048 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002049 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002050 break;
2051 default:
Harald Weltede4477a2009-12-24 12:20:20 +01002052 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002053 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08002054 break;
2055 }
2056 DEBUGPC(DRSL, "\n");
2057
2058 return rc;
2059}
2060
2061
2062/* Entry-point where L2 RSL from BTS enters */
2063int abis_rsl_rcvmsg(struct msgb *msg)
2064{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002065 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08002066 int rc = 0;
2067
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002068 if (!msg) {
2069 DEBUGP(DRSL, "Empty RSL msg?..\n");
2070 return -1;
2071 }
2072
2073 if (msgb_l2len(msg) < sizeof(*rslh)) {
2074 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
Harald Weltece807262012-05-31 20:22:34 +02002075 msgb_free(msg);
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002076 return -1;
2077 }
2078
2079 rslh = msgb_l2(msg);
2080
Harald Welte59b04682009-06-10 05:40:52 +08002081 switch (rslh->msg_discr & 0xfe) {
2082 case ABIS_RSL_MDISC_RLL:
2083 rc = abis_rsl_rx_rll(msg);
2084 break;
2085 case ABIS_RSL_MDISC_DED_CHAN:
2086 rc = abis_rsl_rx_dchan(msg);
2087 break;
2088 case ABIS_RSL_MDISC_COM_CHAN:
2089 rc = abis_rsl_rx_cchan(msg);
2090 break;
2091 case ABIS_RSL_MDISC_TRX:
2092 rc = abis_rsl_rx_trx(msg);
2093 break;
2094 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002095 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08002096 rslh->msg_discr);
2097 break;
2098 case ABIS_RSL_MDISC_IPACCESS:
2099 rc = abis_rsl_rx_ipacc(msg);
2100 break;
2101 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002102 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
2103 "0x%02x\n", rslh->msg_discr);
Harald Weltece807262012-05-31 20:22:34 +02002104 rc = -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08002105 }
2106 msgb_free(msg);
2107 return rc;
2108}
2109
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002110int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
Harald Weltebf4ba722014-12-28 15:00:45 +01002111 struct rsl_ie_cb_cmd_type cb_command,
2112 const uint8_t *data, int len)
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002113{
2114 struct abis_rsl_dchan_hdr *dh;
2115 struct msgb *cb_cmd;
2116
2117 cb_cmd = rsl_msgb_alloc();
2118 if (!cb_cmd)
2119 return -1;
2120
Harald Weltebf4ba722014-12-28 15:00:45 +01002121 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof(*dh));
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002122 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
Harald Weltebf4ba722014-12-28 15:00:45 +01002123 dh->c.msg_discr = ABIS_RSL_MDISC_COM_CHAN;
2124 dh->chan_nr = chan_number; /* TODO: check the chan config */
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002125
Harald Weltebf4ba722014-12-28 15:00:45 +01002126 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, *(uint8_t*)&cb_command);
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002127 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
2128
Harald Weltebf4ba722014-12-28 15:00:45 +01002129 cb_cmd->dst = bts->c0->rsl_link;
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002130
2131 return abis_rsl_sendmsg(cb_cmd);
2132}
Dieter Spaar49c843e2011-07-28 00:01:50 +02002133
2134int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
2135{
2136 struct abis_rsl_common_hdr *ch;
2137 struct msgb *msg = rsl_msgb_alloc();
2138
2139 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2140 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2141 ch->msg_type = 0x40; /* Nokia SI Begin */
2142
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002143 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002144
2145 return abis_rsl_sendmsg(msg);
2146}
2147
2148int rsl_nokia_si_end(struct gsm_bts_trx *trx)
2149{
2150 struct abis_rsl_common_hdr *ch;
2151 struct msgb *msg = rsl_msgb_alloc();
2152
2153 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2154 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2155 ch->msg_type = 0x41; /* Nokia SI End */
2156
2157 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
2158
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002159 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002160
2161 return abis_rsl_sendmsg(msg);
2162}
2163
2164int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
2165{
2166 struct abis_rsl_common_hdr *ch;
2167 struct msgb *msg = rsl_msgb_alloc();
2168
2169 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2170 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
2171 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
2172
2173 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
2174 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
2175
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002176 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002177
2178 return abis_rsl_sendmsg(msg);
2179}
Holger Hans Peter Freythere38af682011-12-27 22:24:17 +01002180
2181/**
2182 * Release all allocated SAPIs starting from @param start and
2183 * release them with the given release mode. Once the release
2184 * confirmation arrives it will be attempted to release the
2185 * the RF channel.
2186 */
2187int rsl_release_sapis_from(struct gsm_lchan *lchan, int start,
2188 enum rsl_rel_mode release_mode)
2189{
2190 int no_sapi = 1;
2191 int sapi;
2192
2193 for (sapi = start; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
2194 uint8_t link_id;
2195 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
2196 continue;
2197
2198 link_id = sapi;
2199 if (lchan->type == GSM_LCHAN_TCH_F || lchan->type == GSM_LCHAN_TCH_H)
2200 link_id |= 0x40;
2201 rsl_release_request(lchan, link_id, release_mode);
2202 no_sapi = 0;
2203 }
2204
2205 return no_sapi;
2206}
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01002207
2208int rsl_start_t3109(struct gsm_lchan *lchan)
2209{
2210 struct gsm_bts *bts = lchan->ts->trx->bts;
2211
2212 /* Disabled, mostly legacy code */
2213 if (bts->network->T3109 == 0)
2214 return -1;
2215
2216 lchan->T3109.cb = t3109_expired;
2217 lchan->T3109.data = lchan;
2218 osmo_timer_schedule(&lchan->T3109, bts->network->T3109, 0);
2219 return 0;
2220}
Holger Hans Peter Freytherc63cb862012-12-25 23:45:14 +01002221
2222/**
2223 * \brief directly RF Channel Release the lchan
2224 *
2225 * When no SAPI was allocated, directly release the logical channel. This
2226 * should only be called from chan_alloc.c on channel release handling. In
2227 * case no SAPI was established the RF Channel can be directly released,
2228 */
2229int rsl_direct_rf_release(struct gsm_lchan *lchan)
2230{
2231 int i;
2232 for (i = 0; i < ARRAY_SIZE(lchan->sapis); ++i) {
2233 if (lchan->sapis[i] != LCHAN_SAPI_UNUSED) {
2234 LOGP(DRSL, LOGL_ERROR, "%s SAPI(%d) still allocated.\n",
2235 gsm_lchan_name(lchan), i);
2236 return -1;
2237 }
2238 }
2239
2240 /* Now release it */
2241 return rsl_rf_chan_release(lchan, 0, SACCH_NONE);
2242}