blob: 41bfcdc9290514080d6f4769f0a743246ba5dad8 [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);
55
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010056static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
57 struct gsm_meas_rep *resp)
58{
59 struct lchan_signal_data sig;
60 sig.lchan = lchan;
61 sig.mr = resp;
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +020062 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010063}
64
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +010065static void do_lchan_free(struct gsm_lchan *lchan)
66{
67 /* we have an error timer pending to release that */
68 if (lchan->state != LCHAN_S_REL_ERR)
69 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
70 lchan_free(lchan);
71}
72
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020073static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080074{
75 /* mask off the transparent bit ? */
76 msg_type &= 0xfe;
77
78 if ((msg_type & 0xf0) == 0x00)
79 return ABIS_RSL_MDISC_RLL;
80 if ((msg_type & 0xf0) == 0x10) {
81 if (msg_type >= 0x19 && msg_type <= 0x22)
82 return ABIS_RSL_MDISC_TRX;
83 else
84 return ABIS_RSL_MDISC_COM_CHAN;
85 }
86 if ((msg_type & 0xe0) == 0x20)
87 return ABIS_RSL_MDISC_DED_CHAN;
88
89 return ABIS_RSL_MDISC_LOC;
90}
91
92static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020093 uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080094{
95 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
96 dh->c.msg_type = msg_type;
97 dh->ie_chan = RSL_IE_CHAN_NR;
98}
99
Harald Welte59b04682009-06-10 05:40:52 +0800100/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200101struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte59b04682009-06-10 05:40:52 +0800102{
103 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200104 uint8_t ts_nr = chan_nr & 0x07;
105 uint8_t cbits = chan_nr >> 3;
106 uint8_t lch_idx;
Harald Welte59b04682009-06-10 05:40:52 +0800107 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
108
109 if (cbits == 0x01) {
110 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +0200111 if (ts->pchan != GSM_PCHAN_TCH_F &&
112 ts->pchan != GSM_PCHAN_PDCH &&
113 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100114 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800115 chan_nr, ts->pchan);
116 } else if ((cbits & 0x1e) == 0x02) {
117 lch_idx = cbits & 0x1; /* TCH/H */
118 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100119 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800120 chan_nr, ts->pchan);
121 } else if ((cbits & 0x1c) == 0x04) {
122 lch_idx = cbits & 0x3; /* SDCCH/4 */
123 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100124 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800125 chan_nr, ts->pchan);
126 } else if ((cbits & 0x18) == 0x08) {
127 lch_idx = cbits & 0x7; /* SDCCH/8 */
128 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100129 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800130 chan_nr, ts->pchan);
131 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
132 lch_idx = 0;
133 if (ts->pchan != GSM_PCHAN_CCCH &&
134 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100135 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800136 chan_nr, ts->pchan);
137 /* FIXME: we should not return first sdcch4 !!! */
138 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100139 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800140 return NULL;
141 }
142
143 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800144 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800145 if (lchan->conn)
146 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800147
148 return lchan;
149}
150
Harald Welte59b04682009-06-10 05:40:52 +0800151/* 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 +0200152uint64_t str_to_imsi(const char *imsi_str)
Harald Welte59b04682009-06-10 05:40:52 +0800153{
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200154 uint64_t ret;
Harald Welte59b04682009-06-10 05:40:52 +0800155
156 ret = strtoull(imsi_str, NULL, 10);
157
158 return ret;
159}
160
Harald Welte59b04682009-06-10 05:40:52 +0800161static struct msgb *rsl_msgb_alloc(void)
162{
Harald Welte9cfc9352009-06-26 19:39:35 +0200163 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
164 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800165}
166
167#define MACBLOCK_SIZE 23
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200168static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800169{
170 memcpy(out, in, len);
171
172 if (len < MACBLOCK_SIZE)
173 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
174}
175
Harald Welted2dd9de2009-08-30 15:37:11 +0900176/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200177static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welted2dd9de2009-08-30 15:37:11 +0900178{
179 *out++ = lchan->encr.alg_id & 0xff;
180 if (lchan->encr.key_len)
181 memcpy(out, lchan->encr.key, lchan->encr.key_len);
182 return lchan->encr.key_len + 1;
183}
184
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200185static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200186{
Harald Welte59b04682009-06-10 05:40:52 +0800187 int i;
188
Harald Weltede4477a2009-12-24 12:20:20 +0100189 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200190 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200191 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100192 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800193}
194
Harald Welte32951ea2011-08-10 23:26:33 +0200195static void lchan_act_tmr_cb(void *data)
196{
197 struct gsm_lchan *lchan = data;
198
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200199 LOGP(DRSL, LOGL_ERROR,
200 "%s Timeout during activation. Marked as broken.\n",
Harald Welte32951ea2011-08-10 23:26:33 +0200201 gsm_lchan_name(lchan));
202
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200203 rsl_lchan_set_state(lchan, LCHAN_S_BROKEN);
Daniel Willmann2731e732011-08-11 04:44:12 +0200204 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200205}
206
207static void lchan_deact_tmr_cb(void *data)
208{
209 struct gsm_lchan *lchan = data;
210
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200211 LOGP(DRSL, LOGL_ERROR,
212 "%s Timeout during deactivation! Marked as broken.\n",
Harald Welte32951ea2011-08-10 23:26:33 +0200213 gsm_lchan_name(lchan));
214
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200215 rsl_lchan_set_state(lchan, LCHAN_S_BROKEN);
216 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200217}
218
219
Harald Welte59b04682009-06-10 05:40:52 +0800220/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200221int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
222 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800223{
224 struct abis_rsl_dchan_hdr *dh;
225 struct msgb *msg = rsl_msgb_alloc();
226
227 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
228 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
229 dh->chan_nr = RSL_CHAN_BCCH;
230
231 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
232 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
233
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200234 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800235
236 return abis_rsl_sendmsg(msg);
237}
238
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200239int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
240 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800241{
242 struct abis_rsl_common_hdr *ch;
243 struct msgb *msg = rsl_msgb_alloc();
244
245 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
246 ch->msg_discr = ABIS_RSL_MDISC_TRX;
247 ch->msg_type = RSL_MT_SACCH_FILL;
248
249 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
250 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
251
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200252 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800253
254 return abis_rsl_sendmsg(msg);
255}
256
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200257int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
258 const uint8_t *data, int len)
Harald Welte10b7d8f2011-01-13 23:16:03 +0100259{
260 struct abis_rsl_dchan_hdr *dh;
261 struct msgb *msg = rsl_msgb_alloc();
Harald Weltee6d51f92011-06-25 10:02:33 +0200262 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte10b7d8f2011-01-13 23:16:03 +0100263
264 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
265 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
266 dh->chan_nr = chan_nr;
267
268 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
269 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
270
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200271 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte10b7d8f2011-01-13 23:16:03 +0100272
273 return abis_rsl_sendmsg(msg);
274}
275
Harald Welte91afe4c2009-06-20 18:15:19 +0200276int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
277{
278 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200279 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200280 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200281
282 db = abs(db);
283 if (db > 30)
284 return -EINVAL;
285
Harald Welteed831842009-06-27 03:09:08 +0200286 msg = rsl_msgb_alloc();
287
Harald Welte91afe4c2009-06-20 18:15:19 +0200288 lchan->bs_power = db/2;
289 if (fpc)
290 lchan->bs_power |= 0x10;
291
292 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
293 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
294 dh->chan_nr = chan_nr;
295
296 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
297
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200298 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200299
300 return abis_rsl_sendmsg(msg);
301}
302
Harald Welte91afe4c2009-06-20 18:15:19 +0200303int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
304{
305 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200306 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200307 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200308 int ctl_lvl;
309
Harald Weltec4dcda02009-08-09 14:45:18 +0200310 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200311 if (ctl_lvl < 0)
312 return ctl_lvl;
313
Harald Welteed831842009-06-27 03:09:08 +0200314 msg = rsl_msgb_alloc();
315
Harald Welte91afe4c2009-06-20 18:15:19 +0200316 lchan->ms_power = ctl_lvl;
317
318 if (fpc)
319 lchan->ms_power |= 0x20;
320
321 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
322 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
323 dh->chan_nr = chan_nr;
324
325 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
326
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200327 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200328
329 return abis_rsl_sendmsg(msg);
330}
331
Harald Welte39274f42009-07-29 15:41:29 +0200332static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
333 struct gsm_lchan *lchan)
334{
Holger Hans Peter Freytherfad73652013-03-09 17:50:10 +0100335 memset(cm, 0, sizeof(*cm));
Harald Welte39274f42009-07-29 15:41:29 +0200336
337 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800338 if (lchan->ts->trx->bts->network->dtx_enabled)
339 cm->dtx_dtu = 0x03;
340 else
341 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200342
343 /* set TCH Speech/Data */
344 cm->spd_ind = lchan->rsl_cmode;
345
Harald Welte951e3512009-11-27 08:55:16 +0100346 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
347 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100348 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100349 "but tch_mode != signalling\n");
350
Harald Welte39274f42009-07-29 15:41:29 +0200351 switch (lchan->type) {
352 case GSM_LCHAN_SDCCH:
353 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
354 break;
355 case GSM_LCHAN_TCH_F:
356 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
357 break;
358 case GSM_LCHAN_TCH_H:
359 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
360 break;
361 case GSM_LCHAN_NONE:
362 case GSM_LCHAN_UNKNOWN:
363 default:
364 return -EINVAL;
365 }
366
367 switch (lchan->tch_mode) {
368 case GSM48_CMODE_SIGN:
369 cm->chan_rate = 0;
370 break;
371 case GSM48_CMODE_SPEECH_V1:
372 cm->chan_rate = RSL_CMOD_SP_GSM1;
373 break;
374 case GSM48_CMODE_SPEECH_EFR:
375 cm->chan_rate = RSL_CMOD_SP_GSM2;
376 break;
377 case GSM48_CMODE_SPEECH_AMR:
378 cm->chan_rate = RSL_CMOD_SP_GSM3;
379 break;
380 case GSM48_CMODE_DATA_14k5:
Harald Welte39274f42009-07-29 15:41:29 +0200381 case GSM48_CMODE_DATA_12k0:
Harald Welte39274f42009-07-29 15:41:29 +0200382 case GSM48_CMODE_DATA_6k0:
Harald Weltee75a47d2012-08-24 15:33:56 +0200383 switch (lchan->csd_mode) {
384 case LCHAN_CSD_M_NT:
385 /* non-transparent CSD with RLP */
386 switch (lchan->tch_mode) {
387 case GSM48_CMODE_DATA_14k5:
388 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
389 break;
390 case GSM48_CMODE_DATA_12k0:
391 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
392 break;
393 case GSM48_CMODE_DATA_6k0:
394 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
395 break;
396 default:
397 return -EINVAL;
398 }
399 break;
400 /* transparent data services below */
401 case LCHAN_CSD_M_T_1200_75:
402 cm->chan_rate = RSL_CMOD_CSD_T_1200_75;
403 break;
404 case LCHAN_CSD_M_T_600:
405 cm->chan_rate = RSL_CMOD_CSD_T_600;
406 break;
407 case LCHAN_CSD_M_T_1200:
408 cm->chan_rate = RSL_CMOD_CSD_T_1200;
409 break;
410 case LCHAN_CSD_M_T_2400:
411 cm->chan_rate = RSL_CMOD_CSD_T_2400;
412 break;
413 case LCHAN_CSD_M_T_9600:
414 cm->chan_rate = RSL_CMOD_CSD_T_9600;
415 break;
416 case LCHAN_CSD_M_T_14400:
417 cm->chan_rate = RSL_CMOD_CSD_T_14400;
418 break;
419 case LCHAN_CSD_M_T_29000:
420 cm->chan_rate = RSL_CMOD_CSD_T_29000;
421 break;
422 case LCHAN_CSD_M_T_32000:
423 cm->chan_rate = RSL_CMOD_CSD_T_32000;
424 break;
425 default:
426 return -EINVAL;
427 }
Harald Welte39274f42009-07-29 15:41:29 +0200428 default:
429 return -EINVAL;
430 }
431
432 return 0;
433}
434
Harald Welte59b04682009-06-10 05:40:52 +0800435/* Chapter 8.4.1 */
436#if 0
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200437int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
438 uint8_t act_type,
Harald Welte59b04682009-06-10 05:40:52 +0800439 struct rsl_ie_chan_mode *chan_mode,
440 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200441 uint8_t bs_power, uint8_t ms_power,
442 uint8_t ta)
Harald Welte59b04682009-06-10 05:40:52 +0800443{
444 struct abis_rsl_dchan_hdr *dh;
445 struct msgb *msg = rsl_msgb_alloc();
446
447 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
448 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
449 dh->chan_nr = chan_nr;
450
451 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
452 /* For compatibility with Phase 1 */
453 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200454 (uint8_t *) chan_mode);
Harald Welte59b04682009-06-10 05:40:52 +0800455 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200456 (uint8_t *) chan_ident);
Harald Welte59b04682009-06-10 05:40:52 +0800457#if 0
458 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200459 (uint8_t *) &encr_info);
Harald Welte59b04682009-06-10 05:40:52 +0800460#endif
461 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
462 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
463 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
464
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200465 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800466
467 return abis_rsl_sendmsg(msg);
468}
469#endif
470
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200471int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
472 uint8_t ta, uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800473{
474 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200475 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200476 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200477 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800478
Harald Weltee6d51f92011-06-25 10:02:33 +0200479 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800480 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200481 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800482
Harald Welte39274f42009-07-29 15:41:29 +0200483 rc = channel_mode_from_lchan(&cm, lchan);
484 if (rc < 0)
485 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800486
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800487 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200488 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800489
Harald Welteed831842009-06-27 03:09:08 +0200490 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800491 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
492 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
493 dh->chan_nr = chan_nr;
494
495 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800496 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200497 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800498
499 /*
500 * The Channel Identification is needed for Phase1 phones
501 * and it contains the GSM48 Channel Description and the
502 * Mobile Allocation. The GSM 08.58 asks for the Mobile
503 * Allocation to have a length of zero. We are using the
504 * msgb_l3len to calculate the length of both messages.
505 */
laforgef723cf02010-06-20 21:38:19 +0200506 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200507 len = msgb_put(msg, 1);
Dieter Spaar18a55f62011-07-27 23:40:33 +0200508 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800509
510 if (lchan->ts->hopping.enabled)
511 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
512 lchan->ts->hopping.ma_data);
513 else
514 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800515
516 /* update the calculated size */
517 msg->l3h = len + 1;
518 *len = msgb_l3len(msg);
519
Harald Welted2dd9de2009-08-30 15:37:11 +0900520 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200521 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900522 rc = build_encr_info(encr_info, lchan);
523 if (rc > 0)
524 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
525 }
526
Harald Welteb90d7bd2009-12-17 00:31:10 +0100527 switch (act_type) {
528 case RSL_ACT_INTER_ASYNC:
529 case RSL_ACT_INTER_SYNC:
530 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
531 break;
532 default:
533 break;
534 }
535
Harald Welte59b04682009-06-10 05:40:52 +0800536 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
537 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
538 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
539
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100540 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
541 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200542 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100543
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200544 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800545
546 return abis_rsl_sendmsg(msg);
547}
548
Harald Welte8e770492009-07-29 11:38:15 +0200549/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800550int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
551{
552 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200553 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200554 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800555
Harald Weltee6d51f92011-06-25 10:02:33 +0200556 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800557 struct rsl_ie_chan_mode cm;
558
Harald Welte39274f42009-07-29 15:41:29 +0200559 rc = channel_mode_from_lchan(&cm, lchan);
560 if (rc < 0)
561 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800562
Harald Welteed831842009-06-27 03:09:08 +0200563 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800564 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
565 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
566 dh->chan_nr = chan_nr;
567
568 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200569 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900570
571 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200572 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900573 rc = build_encr_info(encr_info, lchan);
574 if (rc > 0)
575 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
576 }
577
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100578 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
579 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200580 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100581 }
582
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200583 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dd9de2009-08-30 15:37:11 +0900584
585 return abis_rsl_sendmsg(msg);
586}
587
588/* Chapter 8.4.6: Send the encryption command with given L3 info */
589int rsl_encryption_cmd(struct msgb *msg)
590{
591 struct abis_rsl_dchan_hdr *dh;
592 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200593 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200594 uint8_t encr_info[MAX_A5_KEY_LEN+2];
595 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900596 int rc;
597
598 /* First push the L3 IE tag and length */
599 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
600
601 /* then the link identifier (SAPI0, main sign link) */
602 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
603
604 /* then encryption information */
605 rc = build_encr_info(encr_info, lchan);
606 if (rc <= 0)
607 return rc;
608 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
609
610 /* and finally the DCHAN header */
611 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
612 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
613 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800614
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200615 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800616
617 return abis_rsl_sendmsg(msg);
618}
619
Harald Welte85a163c2009-08-10 11:43:22 +0200620/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200621int rsl_deact_sacch(struct gsm_lchan *lchan)
622{
623 struct abis_rsl_dchan_hdr *dh;
624 struct msgb *msg = rsl_msgb_alloc();
625
626 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
627 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200628 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200629
630 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200631 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteafe3c232009-07-19 18:36:49 +0200632
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100633 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200634
635 return abis_rsl_sendmsg(msg);
636}
637
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800638static void error_timeout_cb(void *data)
639{
640 struct gsm_lchan *lchan = data;
641 if (lchan->state != LCHAN_S_REL_ERR) {
642 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
643 gsm_lchan_name(lchan), lchan->state);
644 return;
645 }
646
647 /* go back to the none state */
648 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800649 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800650}
651
Harald Welte08011e22011-03-04 13:41:31 +0100652static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
653
Harald Welte85a163c2009-08-10 11:43:22 +0200654/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100655static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error,
656 enum sacch_deact deact_sacch)
Harald Welte59b04682009-06-10 05:40:52 +0800657{
658 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800659 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100660 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800661
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100662 /* Stop timers that should lead to a channel release */
663 osmo_timer_del(&lchan->T3109);
664
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800665 if (lchan->state == LCHAN_S_REL_ERR) {
666 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
667 gsm_lchan_name(lchan));
668 return -1;
669 }
670
671 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800672 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
673 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200674 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800675
676 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200677 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800678
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800679 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
680
681 if (error) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200682 struct e1inp_sign_link *sign_link = msg->dst;
683
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100684 /*
685 * FIXME: GSM 04.08 gives us two options for the abnormal
686 * chanel release. This can be either like in the non-existent
687 * sub-lcuase 3.5.1 or for the main signalling link deactivate
688 * the SACCH, start timer T3109 and consider the channel as
689 * released.
690 *
691 * This code is doing the later for all raido links and not
692 * only the main link. Right now all SAPIs are released on the
693 * local end, the SACCH will be de-activated and right now the
694 * T3111 will be started. First T3109 should be started and then
695 * the T3111.
696 *
697 * TODO: Move this out of the function.
698 */
699
700 /*
701 * sacch de-activate and "local end release"
702 */
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100703 if (deact_sacch == SACCH_DEACTIVATE)
704 rsl_deact_sacch(lchan);
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +0100705 rsl_release_sapis_from(lchan, 0, RSL_REL_LOCAL_END);
706
707 /*
708 * TODO: start T3109 now.
709 */
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800710 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800711 lchan->error_timer.data = lchan;
712 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200713 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200714 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800715 }
Harald Welte59b04682009-06-10 05:40:52 +0800716
Harald Welte32951ea2011-08-10 23:26:33 +0200717 /* Start another timer or assume the BTS sends a ACK/NACK? */
718 lchan->act_timer.cb = lchan_deact_tmr_cb;
719 lchan->act_timer.data = lchan;
720 osmo_timer_schedule(&lchan->act_timer, 4, 0);
721
Harald Welte08011e22011-03-04 13:41:31 +0100722 rc = abis_rsl_sendmsg(msg);
723
Harald Welte85a163c2009-08-10 11:43:22 +0200724 /* BTS will respond by RF CHAN REL ACK */
Harald Welte08011e22011-03-04 13:41:31 +0100725 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800726}
727
Harald Welte9773f6c2011-01-14 14:16:16 +0100728static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
729{
730
731 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
732
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100733 /* Stop all pending timers */
Harald Welte32951ea2011-08-10 23:26:33 +0200734 osmo_timer_del(&lchan->act_timer);
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100735 osmo_timer_del(&lchan->T3111);
Harald Welte32951ea2011-08-10 23:26:33 +0200736
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200737 if (lchan->state == LCHAN_S_BROKEN) {
738 /* we are leaving this channel broken for now */
739 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK for broken channel.\n",
740 gsm_lchan_name(lchan));
741 return 0;
742 }
743
Harald Welte9773f6c2011-01-14 14:16:16 +0100744 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
745 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
746 gsm_lchan_name(lchan),
747 gsm_lchans_name(lchan->state));
Holger Hans Peter Freytherc22f2992012-12-06 19:09:58 +0100748 do_lchan_free(lchan);
Harald Welte9773f6c2011-01-14 14:16:16 +0100749
750 return 0;
751}
752
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200753int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
754 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800755{
756 struct abis_rsl_dchan_hdr *dh;
757 struct msgb *msg = rsl_msgb_alloc();
758
759 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
760 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
761 dh->chan_nr = RSL_CHAN_PCH_AGCH;
762
763 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
764 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
765 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
766
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200767 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800768
769 return abis_rsl_sendmsg(msg);
770}
771
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200772int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800773{
774 int i, len = strlen(str_in);
775
776 for (i = 0; i < len; i++) {
777 int num = str_in[i] - 0x30;
778 if (num < 0 || num > 9)
779 return -1;
780 if (i % 2 == 0)
781 bcd_out[i/2] = num;
782 else
783 bcd_out[i/2] |= (num << 4);
784 }
785
786 return 0;
787}
788
789/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200790int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800791{
792 struct msgb *msg = rsl_msgb_alloc();
793 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200794 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800795
796 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
797 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
798 dh->chan_nr = RSL_CHAN_PCH_AGCH;
799
800 switch (bts->type) {
801 case GSM_BTS_TYPE_BS11:
802 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
803 break;
804 default:
805 /* If phase 2, construct a FULL_IMM_ASS_INFO */
806 pad_macblock(buf, val, len);
807 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
808 break;
809 }
810
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200811 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800812
813 return abis_rsl_sendmsg(msg);
814}
815
Harald Welte4684e632009-08-10 09:51:40 +0200816/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200817int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200818{
819 struct msgb *msg = rsl_msgb_alloc();
820 struct abis_rsl_dchan_hdr *dh;
821
822 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
823 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200824 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200825 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200826 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200827
Harald Weltede4477a2009-12-24 12:20:20 +0100828 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200829 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200830
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200831 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte874a5b42009-08-10 11:26:14 +0200832
Harald Welte4684e632009-08-10 09:51:40 +0200833 return abis_rsl_sendmsg(msg);
834}
835
836
Harald Welte59b04682009-06-10 05:40:52 +0800837/* Send "DATA REQUEST" message with given L3 Info payload */
838/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200839int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800840{
Harald Welte59b04682009-06-10 05:40:52 +0800841 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100842 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800843 return -EINVAL;
844 }
845
Harald Weltee6d51f92011-06-25 10:02:33 +0200846 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100847 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800848
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200849 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800850
851 return abis_rsl_sendmsg(msg);
852}
853
Harald Welteed9a5ab2009-08-09 13:47:35 +0200854/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
855/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200856int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200857{
Harald Weltea22d36b2010-03-04 10:33:10 +0100858 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200859
Harald Weltee6d51f92011-06-25 10:02:33 +0200860 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100861 link_id, 0);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200862 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200863
Harald Welte17091bd2012-04-26 19:42:19 +0200864 DEBUGP(DRLL, "%s RSL RLL ESTABLISH REQ (link_id=0x%02x)\n",
865 gsm_lchan_name(lchan), link_id);
866
Harald Welteed9a5ab2009-08-09 13:47:35 +0200867 return abis_rsl_sendmsg(msg);
868}
869
Harald Welte0f2e3c12009-08-08 13:15:07 +0200870/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
871 This is what higher layers should call. The BTS then responds with
872 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
873 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
874 lchan_free() */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100875int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id,
876 enum rsl_rel_mode release_mode)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200877{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200878
Harald Weltea22d36b2010-03-04 10:33:10 +0100879 struct msgb *msg;
880
Harald Weltee6d51f92011-06-25 10:02:33 +0200881 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100882 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800883 /* 0 is normal release, 1 is local end */
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100884 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, release_mode);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200885
Harald Weltec88a4432009-12-29 10:44:17 +0100886 /* FIXME: start some timer in case we don't receive a REL ACK ? */
887
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200888 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200889
Harald Welte17091bd2012-04-26 19:42:19 +0200890 DEBUGP(DRLL, "%s RSL RLL RELEASE REQ (link_id=0x%02x, reason=%u)\n",
Holger Hans Peter Freyther2806c792012-12-06 12:01:38 +0100891 gsm_lchan_name(lchan), link_id, release_mode);
Harald Welte17091bd2012-04-26 19:42:19 +0200892
Harald Welte0f2e3c12009-08-08 13:15:07 +0200893 return abis_rsl_sendmsg(msg);
894}
895
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200896int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
897{
898 lchan->state = state;
899 return 0;
900}
901
Harald Welte59b04682009-06-10 05:40:52 +0800902/* Chapter 8.4.2: Channel Activate Acknowledge */
903static int rsl_rx_chan_act_ack(struct msgb *msg)
904{
905 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
906
907 /* BTS has confirmed channel activation, we now need
908 * to assign the activated channel to the MS */
909 if (rslh->ie_chan != RSL_IE_CHAN_NR)
910 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100911
Harald Welte32951ea2011-08-10 23:26:33 +0200912 osmo_timer_del(&msg->lchan->act_timer);
913
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200914 if (msg->lchan->state == LCHAN_S_BROKEN) {
915 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK for broken channel.\n",
916 gsm_lchan_name(msg->lchan));
917 return 0;
918 }
919
Harald Weltec88a4432009-12-29 10:44:17 +0100920 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100921 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
922 gsm_lchan_name(msg->lchan),
923 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200924 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100925
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800926 if (msg->lchan->rqd_ref) {
927 rsl_send_imm_assignment(msg->lchan);
928 talloc_free(msg->lchan->rqd_ref);
929 msg->lchan->rqd_ref = NULL;
930 msg->lchan->rqd_ta = 0;
931 }
932
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100933 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100934
Harald Welte59b04682009-06-10 05:40:52 +0800935 return 0;
936}
937
938/* Chapter 8.4.3: Channel Activate NACK */
939static int rsl_rx_chan_act_nack(struct msgb *msg)
940{
941 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
942 struct tlv_parsed tp;
943
Harald Welte32951ea2011-08-10 23:26:33 +0200944 osmo_timer_del(&msg->lchan->act_timer);
945
Holger Hans Peter Freytherbd5f21f2013-05-01 18:44:04 +0200946 if (msg->lchan->state == LCHAN_S_BROKEN) {
947 LOGP(DRSL, LOGL_ERROR,
948 "%s CHANNEL ACTIVATE NACK for broken channel.\n",
949 gsm_lchan_name(msg->lchan));
950 return -1;
951 }
952
Daniel Willmann9e9d44c2011-08-11 04:54:23 +0200953 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100954 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100955
Harald Welte59b04682009-06-10 05:40:52 +0800956 /* BTS has rejected channel activation ?!? */
957 if (dh->ie_chan != RSL_IE_CHAN_NR)
958 return -EINVAL;
959
960 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100961 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200962 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100963 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200964 TLVP_LEN(&tp, RSL_IE_CAUSE));
Holger Hans Peter Freyther5149c172012-12-06 19:25:06 +0100965 msg->lchan->error_cause = *cause;
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100966 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther5149c172012-12-06 19:25:06 +0100967 rsl_lchan_set_state(msg->lchan, LCHAN_S_BROKEN);
Daniel Willmann245ee032011-08-11 04:47:11 +0200968 else
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100969 rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Daniel Willmann245ee032011-08-11 04:47:11 +0200970
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100971 } else
Holger Hans Peter Freyther5149c172012-12-06 19:25:06 +0100972 rsl_lchan_set_state(msg->lchan, LCHAN_S_BROKEN);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200973
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100974 LOGPC(DRSL, LOGL_ERROR, "\n");
975
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100976 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte59b04682009-06-10 05:40:52 +0800977 return 0;
978}
979
980/* Chapter 8.4.4: Connection Failure Indication */
981static int rsl_rx_conn_fail(struct msgb *msg)
982{
983 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
984 struct tlv_parsed tp;
985
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100986 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100987 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100988 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800989
990 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
991
Harald Weltef1a168d2009-07-28 17:58:09 +0200992 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100993 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200994 TLVP_LEN(&tp, RSL_IE_CAUSE));
995
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100996 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800997 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200998 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +0100999 return rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Harald Welte59b04682009-06-10 05:40:52 +08001000}
1001
Harald Weltec20bd1d2009-11-29 19:07:28 +01001002static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
1003 const char *prefix)
1004{
Harald Welte0e4fa782009-12-16 16:52:07 +01001005 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
1006 prefix, rxlev2dbm(mru->full.rx_lev),
1007 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +01001008 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
1009 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
1010}
1011
Harald Welte50290cc2012-07-02 17:12:08 +02001012static void print_meas_rep(struct gsm_lchan *lchan, struct gsm_meas_rep *mr)
Harald Weltec20bd1d2009-11-29 19:07:28 +01001013{
Harald Welte0e4fa782009-12-16 16:52:07 +01001014 int i;
Harald Welte50290cc2012-07-02 17:12:08 +02001015 char *name = "";
Harald Welte0e4fa782009-12-16 16:52:07 +01001016
Harald Welte50290cc2012-07-02 17:12:08 +02001017 if (lchan && lchan->conn && lchan->conn->subscr)
1018 name = subscr_name(lchan->conn->subscr);
1019
1020 DEBUGP(DMEAS, "[%s] MEASUREMENT RESULT NR=%d ", name, mr->nr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001021
1022 if (mr->flags & MEAS_REP_F_DL_DTX)
1023 DEBUGPC(DMEAS, "DTXd ");
1024
1025 print_meas_rep_uni(&mr->ul, "ul");
1026 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
1027 if (mr->flags & MEAS_REP_F_MS_TO)
1028 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
1029
1030 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +01001031 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001032 DEBUGPC(DMEAS, "L1_FPC=%u ",
1033 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1034 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1035 }
1036
1037 if (mr->flags & MEAS_REP_F_UL_DTX)
1038 DEBUGPC(DMEAS, "DTXu ");
1039 if (mr->flags & MEAS_REP_F_BA1)
1040 DEBUGPC(DMEAS, "BA1 ");
1041 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1042 DEBUGPC(DMEAS, "NOT VALID ");
1043 else
1044 print_meas_rep_uni(&mr->dl, "dl");
1045
1046 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001047 if (mr->num_cell == 7)
1048 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001049 for (i = 0; i < mr->num_cell; i++) {
1050 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +01001051 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1052 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +01001053 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001054}
1055
Harald Welte59b04682009-06-10 05:40:52 +08001056static int rsl_rx_meas_res(struct msgb *msg)
1057{
1058 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1059 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001060 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001061 uint8_t len;
1062 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +01001063 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001064
Harald Welte4baa9c52009-12-21 13:27:11 +01001065 /* check if this channel is actually active */
1066 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +01001067 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +08001068 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +01001069 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +01001070 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +01001071 }
Harald Welte4baa9c52009-12-21 13:27:11 +01001072
Harald Weltef9476812009-12-15 21:36:05 +01001073 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001074 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001075
Harald Welte59b04682009-06-10 05:40:52 +08001076 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1077
Harald Weltec20bd1d2009-11-29 19:07:28 +01001078 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1079 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1080 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1081 return -EIO;
1082
1083 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001084 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001085
1086 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1087 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1088 if (len >= 3) {
1089 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001090 mr->flags |= MEAS_REP_F_DL_DTX;
1091 mr->ul.full.rx_lev = val[0] & 0x3f;
1092 mr->ul.sub.rx_lev = val[1] & 0x3f;
1093 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1094 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001095 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001096
Harald Weltef9476812009-12-15 21:36:05 +01001097 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001098
1099 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001100 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001101 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001102 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1103
Harald Weltea1467eb2009-06-20 18:44:35 +02001104 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001105 struct e1inp_sign_link *sign_link = msg->dst;
1106
Harald Weltec20bd1d2009-11-29 19:07:28 +01001107 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001108 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001109 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001110 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001111 mr->flags |= MEAS_REP_F_FPC;
1112 mr->ms_l1.ta = val[1];
Andreas Eversbergfe56cf82011-12-24 11:49:05 +01001113 /* BS11 and Nokia reports TA shifted by 2 bits */
1114 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1115 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001116 mr->ms_l1.ta >>= 2;
Harald Weltea1467eb2009-06-20 18:44:35 +02001117 }
Harald Welte59b04682009-06-10 05:40:52 +08001118 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001119 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001120 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001121 if (rc < 0)
1122 return rc;
1123 }
1124
Harald Welte50290cc2012-07-02 17:12:08 +02001125 print_meas_rep(msg->lchan, mr);
Harald Welte59b04682009-06-10 05:40:52 +08001126
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001127 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001128
Harald Welte59b04682009-06-10 05:40:52 +08001129 return 0;
1130}
1131
Harald Welte6720a432009-11-29 22:45:52 +01001132/* Chapter 8.4.7 */
1133static int rsl_rx_hando_det(struct msgb *msg)
1134{
1135 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1136 struct tlv_parsed tp;
1137
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001138 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001139
1140 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1141
1142 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1143 DEBUGPC(DRSL, "access delay = %u\n",
1144 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1145 else
1146 DEBUGPC(DRSL, "\n");
1147
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001148 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001149
1150 return 0;
1151}
1152
Harald Welte59b04682009-06-10 05:40:52 +08001153static int abis_rsl_rx_dchan(struct msgb *msg)
1154{
1155 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1156 int rc = 0;
1157 char *ts_name;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001158 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001159
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001160 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001161 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001162
Harald Welte59b04682009-06-10 05:40:52 +08001163 switch (rslh->c.msg_type) {
1164 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001165 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001166 rc = rsl_rx_chan_act_ack(msg);
1167 break;
1168 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001169 rc = rsl_rx_chan_act_nack(msg);
1170 break;
1171 case RSL_MT_CONN_FAIL:
1172 rc = rsl_rx_conn_fail(msg);
1173 break;
1174 case RSL_MT_MEAS_RES:
1175 rc = rsl_rx_meas_res(msg);
1176 break;
Harald Welte6720a432009-11-29 22:45:52 +01001177 case RSL_MT_HANDO_DET:
1178 rc = rsl_rx_hando_det(msg);
1179 break;
Harald Welte59b04682009-06-10 05:40:52 +08001180 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001181 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001182 break;
1183 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001184 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001185 break;
1186 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001187 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001188 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001189 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001190 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001191 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001192 break;
1193 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001194 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001195 break;
1196 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001197 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001198 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001199 break;
1200 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001201 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001202 break;
Harald Welte59b04682009-06-10 05:40:52 +08001203 case RSL_MT_PHY_CONTEXT_CONF:
1204 case RSL_MT_PREPROC_MEAS_RES:
1205 case RSL_MT_TALKER_DET:
1206 case RSL_MT_LISTENER_DET:
1207 case RSL_MT_REMOTE_CODEC_CONF_REP:
1208 case RSL_MT_MR_CODEC_MOD_ACK:
1209 case RSL_MT_MR_CODEC_MOD_NACK:
1210 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001211 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1212 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001213 break;
1214 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001215 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1216 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001217 return -EINVAL;
1218 }
1219
1220 return rc;
1221}
1222
1223static int rsl_rx_error_rep(struct msgb *msg)
1224{
1225 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001226 struct tlv_parsed tp;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001227 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001228
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001229 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001230
1231 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1232
1233 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001234 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001235 TLVP_LEN(&tp, RSL_IE_CAUSE));
1236
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001237 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001238
1239 return 0;
1240}
1241
1242static int abis_rsl_rx_trx(struct msgb *msg)
1243{
1244 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001245 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001246 int rc = 0;
1247
1248 switch (rslh->msg_type) {
1249 case RSL_MT_ERROR_REPORT:
1250 rc = rsl_rx_error_rep(msg);
1251 break;
1252 case RSL_MT_RF_RES_IND:
1253 /* interference on idle channels of TRX */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001254 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001255 break;
1256 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001257 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001258 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001259 gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001260 break;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001261 case 0x42: /* Nokia specific: SI End ACK */
1262 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1263 break;
1264 case 0x43: /* Nokia specific: SI End NACK */
1265 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1266 break;
Harald Welte59b04682009-06-10 05:40:52 +08001267 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001268 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001269 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001270 return -EINVAL;
1271 }
1272 return rc;
1273}
1274
Harald Welte427dbc42009-08-10 00:26:10 +02001275/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1276static void t3101_expired(void *data)
1277{
1278 struct gsm_lchan *lchan = data;
1279
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001280 rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
Harald Welte427dbc42009-08-10 00:26:10 +02001281}
1282
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001283/* If T3111 expires, we will send the RF Channel Request */
1284static void t3111_expired(void *data)
1285{
1286 struct gsm_lchan *lchan = data;
1287
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001288 rsl_rf_chan_release(lchan, 0, SACCH_NONE);
1289}
1290
1291/* If T3109 expires the MS has not send a UA/UM do the error release */
1292static void t3109_expired(void *data)
1293{
1294 struct gsm_lchan *lchan = data;
1295
1296 LOGP(DRSL, LOGL_ERROR,
1297 "%s SACCH deactivation timeout.\n", gsm_lchan_name(lchan));
1298 rsl_rf_chan_release(lchan, 1, SACCH_NONE);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001299}
1300
laforge50312e82010-06-21 12:08:52 +02001301#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1302
Harald Weltea00fdd72010-12-23 14:39:29 +01001303/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1304static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1305 unsigned int num_req_refs,
1306 struct gsm48_req_ref *rqd_refs,
1307 uint8_t wait_ind)
1308{
1309 uint8_t buf[GSM_MACBLOCK_LEN];
1310 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1311
1312 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1313 memset(iar, 0, sizeof(*iar));
1314 iar->proto_discr = GSM48_PDISC_RR;
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001315 iar->msg_type = GSM48_MT_RR_IMM_ASS_REJ;
Harald Weltea00fdd72010-12-23 14:39:29 +01001316 iar->page_mode = GSM48_PM_SAME;
1317
1318 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1319 iar->wait_ind1 = wait_ind;
1320
1321 if (num_req_refs >= 2)
1322 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1323 else
1324 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1325 iar->wait_ind2 = wait_ind;
1326
1327 if (num_req_refs >= 3)
1328 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1329 else
1330 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1331 iar->wait_ind3 = wait_ind;
1332
1333 if (num_req_refs >= 4)
1334 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1335 else
1336 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1337 iar->wait_ind4 = wait_ind;
1338
Andreas Eversbergdee934a2013-02-07 11:51:16 +01001339 /* we need to subtract 1 byte from sizeof(*iar) since ia includes the l2_plen field */
1340 iar->l2_plen = GSM48_LEN2PLEN((sizeof(*iar)-1));
1341
1342 return rsl_imm_assign_cmd(bts, sizeof(*iar), (uint8_t *) iar);
Harald Weltea00fdd72010-12-23 14:39:29 +01001343}
1344
Harald Welte59b04682009-06-10 05:40:52 +08001345/* MS has requested a channel on the RACH */
1346static int rsl_rx_chan_rqd(struct msgb *msg)
1347{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001348 struct e1inp_sign_link *sign_link = msg->dst;
1349 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001350 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1351 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001352 enum gsm_chan_t lctype;
1353 enum gsm_chreq_reason_t chreq_reason;
1354 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001355 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001356 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001357
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001358 uint16_t arfcn;
Holger Hans Peter Freytherefd75b52012-02-03 20:10:13 +01001359 uint8_t subch;
Harald Welte59b04682009-06-10 05:40:52 +08001360
1361 /* parse request reference to be used in immediate assign */
1362 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1363 return -EINVAL;
1364
1365 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1366
1367 /* parse access delay and use as TA */
1368 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1369 return -EINVAL;
1370 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1371
1372 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1373 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001374 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1375 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001376
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001377 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001378
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001379 /*
1380 * We want LOCATION UPDATES to succeed and will assign a TCH
1381 * if we have no SDCCH available.
1382 */
1383 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1384
Harald Welte59b04682009-06-10 05:40:52 +08001385 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001386 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001387 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001388 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001389 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001390 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001391 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1392 if (bts->network->T3122)
1393 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001394 return -ENOMEM;
1395 }
1396
Harald Weltec88a4432009-12-29 10:44:17 +01001397 if (lchan->state != LCHAN_S_NONE)
1398 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001399 "in state %s\n", gsm_lchan_name(lchan),
1400 gsm_lchans_name(lchan->state));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001401
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001402 /* save the RACH data as we need it after the CHAN ACT ACK */
1403 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1404 if (!lchan->rqd_ref) {
1405 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1406 lchan_free(lchan);
1407 return -ENOMEM;
1408 }
1409
Holger Hans Peter Freyther161cec12011-12-29 23:33:04 +01001410 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001411 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1412 lchan->rqd_ta = rqd_ta;
1413
Harald Welte59b04682009-06-10 05:40:52 +08001414 arfcn = lchan->ts->trx->arfcn;
1415 subch = lchan->nr;
1416
Harald Welted2dd9de2009-08-30 15:37:11 +09001417 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001418 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001419 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001420 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001421 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001422
Harald Welte32951ea2011-08-10 23:26:33 +02001423 /* Start another timer or assume the BTS sends a ACK/NACK? */
1424 lchan->act_timer.cb = lchan_act_tmr_cb;
1425 lchan->act_timer.data = lchan;
1426 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1427
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001428 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1429 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1430 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1431 rqd_ref->ra, rqd_ta);
1432
1433 /* BS11 requires TA shifted by 2 bits */
1434 if (bts->type == GSM_BTS_TYPE_BS11)
1435 rqd_ta <<= 2;
Harald Welteb90d7bd2009-12-17 00:31:10 +01001436 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001437
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001438 return 0;
1439}
1440
1441static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1442{
1443 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001444 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001445 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1446
Harald Welte59b04682009-06-10 05:40:52 +08001447 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001448 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001449 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001450 ia->proto_discr = GSM48_PDISC_RR;
1451 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1452 ia->page_mode = GSM48_PM_SAME;
1453 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001454
Harald Welte59b04682009-06-10 05:40:52 +08001455 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001456 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1457 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001458 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001459 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001460 } else {
laforgee06d5982010-06-20 15:18:46 +02001461 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1462 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001463 }
Harald Welte07f32182010-06-28 18:41:27 +02001464 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1465 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001466
Harald Welte427dbc42009-08-10 00:26:10 +02001467 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1468 lchan->T3101.cb = t3101_expired;
1469 lchan->T3101.data = lchan;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001470 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001471
1472 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001473 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001474}
1475
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001476/* current load on the CCCH */
Harald Welte59b04682009-06-10 05:40:52 +08001477static int rsl_rx_ccch_load(struct msgb *msg)
1478{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001479 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001480 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001481 struct ccch_signal_data sd;
1482
1483 sd.bts = sign_link->trx->bts;
1484 sd.rach_slot_count = -1;
1485 sd.rach_busy_count = -1;
1486 sd.rach_access_count = -1;
Harald Welte59b04682009-06-10 05:40:52 +08001487
1488 switch (rslh->data[0]) {
1489 case RSL_IE_PAGING_LOAD:
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001490 sd.pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1491 if (is_ipaccess_bts(sign_link->trx->bts) && sd.pg_buf_space == 0xffff) {
Harald Welte008a4922010-04-19 10:24:07 +02001492 /* paging load below configured threshold, use 50 as default */
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001493 sd.pg_buf_space = 50;
Harald Welte008a4922010-04-19 10:24:07 +02001494 }
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001495 paging_update_buffer_space(sign_link->trx->bts, sd.pg_buf_space);
1496 osmo_signal_dispatch(SS_CCCH, S_CCCH_PAGING_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001497 break;
1498 case RSL_IE_RACH_LOAD:
1499 if (msg->data_len >= 7) {
Holger Hans Peter Freyther285af692012-02-03 20:26:25 +01001500 sd.rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1501 sd.rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1502 sd.rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1503 osmo_signal_dispatch(SS_CCCH, S_CCCH_RACH_LOAD, &sd);
Harald Welte59b04682009-06-10 05:40:52 +08001504 }
1505 break;
1506 default:
1507 break;
1508 }
1509
1510 return 0;
1511}
1512
1513static int abis_rsl_rx_cchan(struct msgb *msg)
1514{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001515 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001516 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1517 int rc = 0;
1518
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001519 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +08001520
1521 switch (rslh->c.msg_type) {
1522 case RSL_MT_CHAN_RQD:
1523 /* MS has requested a channel on the RACH */
1524 rc = rsl_rx_chan_rqd(msg);
1525 break;
1526 case RSL_MT_CCCH_LOAD_IND:
1527 /* current load on the CCCH */
1528 rc = rsl_rx_ccch_load(msg);
1529 break;
1530 case RSL_MT_DELETE_IND:
1531 /* CCCH overloaded, IMM_ASSIGN was dropped */
1532 case RSL_MT_CBCH_LOAD_IND:
1533 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001534 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1535 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001536 break;
1537 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001538 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1539 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001540 return -EINVAL;
1541 }
1542
1543 return rc;
1544}
1545
1546static int rsl_rx_rll_err_ind(struct msgb *msg)
1547{
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001548 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001549 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001550 uint8_t rlm_cause;
Harald Welte59b04682009-06-10 05:40:52 +08001551
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001552 rsl_tlv_parse(&tp, rllh->data, msgb_l2len(msg) - sizeof(*rllh));
1553 if (!TLVP_PRESENT(&tp, RSL_IE_RLM_CAUSE)) {
1554 LOGP(DRLL, LOGL_ERROR,
1555 "%s ERROR INDICATION without mandantory cause.\n",
1556 gsm_lchan_name(msg->lchan));
1557 return -1;
1558 }
1559
1560 rlm_cause = *TLVP_VAL(&tp, RSL_IE_RLM_CAUSE);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001561 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001562 gsm_lchan_name(msg->lchan),
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001563 rsl_rlm_cause_name(rlm_cause));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001564
1565 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001566
Holger Hans Peter Freyther80abe252013-01-16 21:07:43 +01001567 if (rlm_cause == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001568 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001569 return rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001570 }
Harald Welte692f5852009-07-04 09:40:05 +02001571
Harald Welte59b04682009-06-10 05:40:52 +08001572 return 0;
1573}
1574
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001575static void rsl_handle_release(struct gsm_lchan *lchan)
1576{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001577 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001578 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001579
Holger Hans Peter Freyther701a6472011-12-28 12:11:40 +01001580 /*
1581 * Maybe only one link/SAPI was releasd or the error handling
1582 * was activated. Just return now and let the other code handle
1583 * it.
1584 */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001585 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001586 return;
1587
1588 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1589 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1590 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001591 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001592 gsm_lchan_name(lchan), sapi);
1593 return;
1594 }
1595
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001596
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01001597 /* Stop T3109 and wait for T3111 before re-using the channel */
1598 osmo_timer_del(&lchan->T3109);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001599 lchan->T3111.cb = t3111_expired;
1600 lchan->T3111.data = lchan;
1601 bts = lchan->ts->trx->bts;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001602 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001603}
1604
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001605/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001606 0x02, 0x06,
1607 0x01, 0x20,
1608 0x02, 0x00,
1609 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1610
1611static int abis_rsl_rx_rll(struct msgb *msg)
1612{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001613 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001614 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1615 int rc = 0;
1616 char *ts_name;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001617 uint8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001618
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001619 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001620 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001621 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001622
1623 switch (rllh->c.msg_type) {
1624 case RSL_MT_DATA_IND:
1625 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001626 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001627 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1628 rllh->data[0] == RSL_IE_L3_INFO) {
1629 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001630 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001631 }
1632 break;
1633 case RSL_MT_EST_IND:
1634 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001635 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001636 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001637 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001638 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001639 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1640 rllh->data[0] == RSL_IE_L3_INFO) {
1641 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001642 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001643 }
1644 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001645 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001646 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001647 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001648 rll_indication(msg->lchan, rllh->link_id,
1649 BSC_RLLR_IND_EST_CONF);
1650 break;
Harald Welte59b04682009-06-10 05:40:52 +08001651 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001652 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001653 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001654 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001655 rll_indication(msg->lchan, rllh->link_id,
1656 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001657 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001658 break;
1659 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001660 /* BTS informs us of having received UA from MS,
1661 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001662 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001663 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001664 rsl_handle_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001665 break;
1666 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001667 rc = rsl_rx_rll_err_ind(msg);
1668 break;
1669 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001670 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1671 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001672 break;
1673 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001674 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1675 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001676 }
Harald Welte59b04682009-06-10 05:40:52 +08001677 return rc;
1678}
1679
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001680static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001681{
Harald Welteb284b472009-12-02 01:58:23 +05301682 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001683 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301684 switch (lchan->type) {
1685 case GSM_LCHAN_TCH_F:
1686 return 0x00;
1687 case GSM_LCHAN_TCH_H:
1688 return 0x03;
1689 default:
1690 break;
1691 }
Harald Welte98d79f92009-07-28 18:11:56 +02001692 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301693 switch (lchan->type) {
1694 case GSM_LCHAN_TCH_F:
1695 return 0x01;
1696 /* there's no half-rate EFR */
1697 default:
1698 break;
1699 }
Harald Welte98d79f92009-07-28 18:11:56 +02001700 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301701 switch (lchan->type) {
1702 case GSM_LCHAN_TCH_F:
1703 return 0x02;
1704 case GSM_LCHAN_TCH_H:
1705 return 0x05;
1706 default:
1707 break;
1708 }
1709 default:
1710 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001711 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001712 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301713 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001714 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001715}
1716
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001717static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munaut1338a552009-12-20 22:06:40 +01001718{
1719 switch (lchan->tch_mode) {
1720 case GSM48_CMODE_SPEECH_V1:
1721 switch (lchan->type) {
1722 case GSM_LCHAN_TCH_F:
1723 return RTP_PT_GSM_FULL;
1724 case GSM_LCHAN_TCH_H:
1725 return RTP_PT_GSM_HALF;
1726 default:
1727 break;
1728 }
1729 case GSM48_CMODE_SPEECH_EFR:
1730 switch (lchan->type) {
1731 case GSM_LCHAN_TCH_F:
1732 return RTP_PT_GSM_EFR;
1733 /* there's no half-rate EFR */
1734 default:
1735 break;
1736 }
1737 case GSM48_CMODE_SPEECH_AMR:
1738 switch (lchan->type) {
1739 case GSM_LCHAN_TCH_F:
Sylvain Munaut1338a552009-12-20 22:06:40 +01001740 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freytherd78bee82011-07-21 10:24:46 +02001741 return RTP_PT_AMR;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001742 default:
1743 break;
1744 }
1745 default:
1746 break;
1747 }
1748 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1749 "tch_mode == 0x%02x\n & lchan_type == %d",
1750 lchan->tch_mode, lchan->type);
1751 return 0;
1752}
1753
Harald Welte59b04682009-06-10 05:40:52 +08001754/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001755static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1756{
1757 struct in_addr ip;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001758 uint16_t port, conn_id;
Harald Weltebffa4992009-12-19 16:42:06 +01001759
1760 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001761 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001762 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1763 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1764 }
1765
1766 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001767 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001768 port = ntohs(port);
1769 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1770 lchan->abis_ip.bound_port = port;
1771 }
1772
1773 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001774 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Weltebffa4992009-12-19 16:42:06 +01001775 conn_id = ntohs(conn_id);
1776 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1777 lchan->abis_ip.conn_id = conn_id;
1778 }
1779
1780 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1781 lchan->abis_ip.rtp_payload2 =
1782 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1783 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1784 lchan->abis_ip.rtp_payload2);
1785 }
1786
1787 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1788 lchan->abis_ip.speech_mode =
1789 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1790 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1791 lchan->abis_ip.speech_mode);
1792 }
1793
1794 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001795 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001796 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1797 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1798 }
1799
1800 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001801 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001802 port = ntohs(port);
1803 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1804 lchan->abis_ip.connect_port = port;
1805 }
1806}
1807
Harald Welte9a696d72013-02-03 12:06:58 +01001808/*! \brief Issue IPA RSL CRCX to configure RTP on BTS side
1809 * \param[in] lchan Logical Channel for which we issue CRCX
1810 */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001811int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001812{
1813 struct msgb *msg = rsl_msgb_alloc();
1814 struct abis_rsl_dchan_hdr *dh;
1815
1816 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001817 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001818 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001819 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001820
Harald Welte98d79f92009-07-28 18:11:56 +02001821 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001822 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001823 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001824 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001825 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001826
Sylvain Munaut1338a552009-12-20 22:06:40 +01001827 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1828 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1829 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001830
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001831 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001832
1833 return abis_rsl_sendmsg(msg);
1834}
1835
Harald Welte9a696d72013-02-03 12:06:58 +01001836/*! \brief Issue IPA RSL MDCX to configure MGW-side of RTP
1837 * \param[in] lchan Logical Channel for which we issue MDCX
1838 * \param[in] ip Remote (MGW) IP address for RTP
1839 * \param[in] port Remote (MGW) UDP port number for RTP
1840 * \param[in] rtp_payload2 Contents of RTP PAYLOAD 2 IE
1841 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001842int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1843 uint8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001844{
1845 struct msgb *msg = rsl_msgb_alloc();
1846 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001847 uint32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001848 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001849
1850 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001851 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001852 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001853 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001854
Harald Weltebffa4992009-12-19 16:42:06 +01001855 /* we need to store these now as MDCX_ACK does not return them :( */
1856 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1857 lchan->abis_ip.connect_port = port;
1858 lchan->abis_ip.connect_ip = ip;
1859
Harald Weltefb4a9e92009-07-29 12:12:18 +02001860 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001861 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001862 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001863
Harald Welte98d79f92009-07-28 18:11:56 +02001864 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001865 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1866 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1867 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1868 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001869
Harald Weltebffa4992009-12-19 16:42:06 +01001870 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1871 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001872 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Weltebffa4992009-12-19 16:42:06 +01001873 *att_ip = ia.s_addr;
1874 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1875 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001876 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001877 if (rtp_payload2)
1878 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001879
1880 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001881
1882 return abis_rsl_sendmsg(msg);
1883}
1884
Harald Welte9947d9f2009-12-20 16:51:09 +01001885/* tell BTS to connect RTP stream to our local RTP socket */
1886int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1887{
1888 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1889 int rc;
1890
1891 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1892 ntohs(rs->rtp.sin_local.sin_port),
1893 /* FIXME: use RTP payload of bound socket, not BTS*/
1894 lchan->abis_ip.rtp_payload2);
1895
1896 return rc;
1897}
1898
Harald Welte6f40df02010-12-23 12:59:52 +01001899int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001900{
1901 struct msgb *msg = rsl_msgb_alloc();
1902 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001903 uint8_t msg_type;
Harald Welte2b361522010-03-28 14:42:09 +08001904
1905 if (act)
1906 msg_type = RSL_MT_IPAC_PDCH_ACT;
1907 else
1908 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001909
1910 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001911 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001912 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +02001913 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001914
Harald Welte6f40df02010-12-23 12:59:52 +01001915 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001916 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001917
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001918 msg->dst = ts->trx->rsl_link;
Harald Welteaed946e2009-10-24 10:29:22 +02001919
1920 return abis_rsl_sendmsg(msg);
1921}
1922
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001923static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001924{
1925 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1926 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301927 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001928
1929 /* the BTS has acknowledged a local bind, it now tells us the IP
1930 * address and port number to which it has bound the given logical
1931 * channel */
1932
1933 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1934 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1935 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001936 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001937 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001938 return -EINVAL;
1939 }
Harald Welte50517742009-12-20 15:42:44 +01001940
Harald Weltebffa4992009-12-19 16:42:06 +01001941 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001942
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001943 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001944
1945 return 0;
1946}
1947
Harald Weltebffa4992009-12-19 16:42:06 +01001948static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1949{
1950 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1951 struct tlv_parsed tv;
1952 struct gsm_lchan *lchan = msg->lchan;
1953
1954 /* the BTS has acknowledged a remote connect request and
1955 * it now tells us the IP address and port number to which it has
1956 * connected the given logical channel */
1957
1958 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1959 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001960 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001961
1962 return 0;
1963}
1964
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001965static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001966{
1967 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1968 struct tlv_parsed tv;
1969
1970 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001971
Harald Weltef1a168d2009-07-28 17:58:09 +02001972 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001973 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001974 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001975
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001976 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001977
Harald Welte59b04682009-06-10 05:40:52 +08001978 return 0;
1979}
1980
1981static int abis_rsl_rx_ipacc(struct msgb *msg)
1982{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001983 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001984 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001985 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001986 int rc = 0;
1987
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001988 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001989 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001990
1991 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001992 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001993 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001994 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001995 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001996 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001997 /* somehow the BTS was unable to bind the lchan to its local
1998 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001999 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002000 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002001 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08002002 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01002003 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01002004 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002005 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002006 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08002007 /* somehow the BTS was unable to connect the lchan to a remote
2008 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01002009 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08002010 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002011 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01002012 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01002013 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08002014 break;
2015 default:
Harald Weltede4477a2009-12-24 12:20:20 +01002016 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002017 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08002018 break;
2019 }
2020 DEBUGPC(DRSL, "\n");
2021
2022 return rc;
2023}
2024
2025
2026/* Entry-point where L2 RSL from BTS enters */
2027int abis_rsl_rcvmsg(struct msgb *msg)
2028{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002029 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08002030 int rc = 0;
2031
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002032 if (!msg) {
2033 DEBUGP(DRSL, "Empty RSL msg?..\n");
2034 return -1;
2035 }
2036
2037 if (msgb_l2len(msg) < sizeof(*rslh)) {
2038 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
Harald Weltece807262012-05-31 20:22:34 +02002039 msgb_free(msg);
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01002040 return -1;
2041 }
2042
2043 rslh = msgb_l2(msg);
2044
Harald Welte59b04682009-06-10 05:40:52 +08002045 switch (rslh->msg_discr & 0xfe) {
2046 case ABIS_RSL_MDISC_RLL:
2047 rc = abis_rsl_rx_rll(msg);
2048 break;
2049 case ABIS_RSL_MDISC_DED_CHAN:
2050 rc = abis_rsl_rx_dchan(msg);
2051 break;
2052 case ABIS_RSL_MDISC_COM_CHAN:
2053 rc = abis_rsl_rx_cchan(msg);
2054 break;
2055 case ABIS_RSL_MDISC_TRX:
2056 rc = abis_rsl_rx_trx(msg);
2057 break;
2058 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002059 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08002060 rslh->msg_discr);
2061 break;
2062 case ABIS_RSL_MDISC_IPACCESS:
2063 rc = abis_rsl_rx_ipacc(msg);
2064 break;
2065 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01002066 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
2067 "0x%02x\n", rslh->msg_discr);
Harald Weltece807262012-05-31 20:22:34 +02002068 rc = -EINVAL;
Harald Welte59b04682009-06-10 05:40:52 +08002069 }
2070 msgb_free(msg);
2071 return rc;
2072}
2073
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08002074int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
2075 uint8_t cb_command, const uint8_t *data, int len)
2076{
2077 struct abis_rsl_dchan_hdr *dh;
2078 struct msgb *cb_cmd;
2079
2080 cb_cmd = rsl_msgb_alloc();
2081 if (!cb_cmd)
2082 return -1;
2083
2084 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
2085 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
2086 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
2087
2088 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
2089 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
2090
2091 cb_cmd->trx = bts->c0;
2092
2093 return abis_rsl_sendmsg(cb_cmd);
2094}
Dieter Spaar49c843e2011-07-28 00:01:50 +02002095
2096int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
2097{
2098 struct abis_rsl_common_hdr *ch;
2099 struct msgb *msg = rsl_msgb_alloc();
2100
2101 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2102 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2103 ch->msg_type = 0x40; /* Nokia SI Begin */
2104
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002105 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002106
2107 return abis_rsl_sendmsg(msg);
2108}
2109
2110int rsl_nokia_si_end(struct gsm_bts_trx *trx)
2111{
2112 struct abis_rsl_common_hdr *ch;
2113 struct msgb *msg = rsl_msgb_alloc();
2114
2115 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2116 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2117 ch->msg_type = 0x41; /* Nokia SI End */
2118
2119 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
2120
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002121 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002122
2123 return abis_rsl_sendmsg(msg);
2124}
2125
2126int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
2127{
2128 struct abis_rsl_common_hdr *ch;
2129 struct msgb *msg = rsl_msgb_alloc();
2130
2131 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2132 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
2133 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
2134
2135 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
2136 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
2137
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002138 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002139
2140 return abis_rsl_sendmsg(msg);
2141}
Holger Hans Peter Freythere38af682011-12-27 22:24:17 +01002142
2143/**
2144 * Release all allocated SAPIs starting from @param start and
2145 * release them with the given release mode. Once the release
2146 * confirmation arrives it will be attempted to release the
2147 * the RF channel.
2148 */
2149int rsl_release_sapis_from(struct gsm_lchan *lchan, int start,
2150 enum rsl_rel_mode release_mode)
2151{
2152 int no_sapi = 1;
2153 int sapi;
2154
2155 for (sapi = start; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
2156 uint8_t link_id;
2157 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
2158 continue;
2159
2160 link_id = sapi;
2161 if (lchan->type == GSM_LCHAN_TCH_F || lchan->type == GSM_LCHAN_TCH_H)
2162 link_id |= 0x40;
2163 rsl_release_request(lchan, link_id, release_mode);
2164 no_sapi = 0;
2165 }
2166
2167 return no_sapi;
2168}
Holger Hans Peter Freyther969a4052011-12-28 16:21:05 +01002169
2170int rsl_start_t3109(struct gsm_lchan *lchan)
2171{
2172 struct gsm_bts *bts = lchan->ts->trx->bts;
2173
2174 /* Disabled, mostly legacy code */
2175 if (bts->network->T3109 == 0)
2176 return -1;
2177
2178 lchan->T3109.cb = t3109_expired;
2179 lchan->T3109.data = lchan;
2180 osmo_timer_schedule(&lchan->T3109, bts->network->T3109, 0);
2181 return 0;
2182}
Holger Hans Peter Freytherc63cb862012-12-25 23:45:14 +01002183
2184/**
2185 * \brief directly RF Channel Release the lchan
2186 *
2187 * When no SAPI was allocated, directly release the logical channel. This
2188 * should only be called from chan_alloc.c on channel release handling. In
2189 * case no SAPI was established the RF Channel can be directly released,
2190 */
2191int rsl_direct_rf_release(struct gsm_lchan *lchan)
2192{
2193 int i;
2194 for (i = 0; i < ARRAY_SIZE(lchan->sapis); ++i) {
2195 if (lchan->sapis[i] != LCHAN_SAPI_UNUSED) {
2196 LOGP(DRSL, LOGL_ERROR, "%s SAPI(%d) still allocated.\n",
2197 gsm_lchan_name(lchan), i);
2198 return -1;
2199 }
2200 }
2201
2202 /* Now release it */
2203 return rsl_rf_chan_release(lchan, 0, SACCH_NONE);
2204}