blob: 8e9258ca5a5179e6829e4623884bad2dd55a9f3d [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Welte3c9c5f92010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Holger Hans Peter Freyther85825352011-12-27 22:24:17 +01005 * (C) 2012 by Holger Hans Peter Freyther
Harald Welte8470bf22008-12-25 23:28:35 +00006 *
Harald Welte52b1f982008-12-23 20:25:15 +00007 * All Rights Reserved
8 *
9 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-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 Welte52b1f982008-12-23 20:25:15 +000012 * (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 Welte9af6ddf2011-01-01 15:25:50 +010017 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000018 *
Harald Welte9af6ddf2011-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 Welte52b1f982008-12-23 20:25:15 +000021 *
22 */
23
24#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000025#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000026#include <errno.h>
Harald Welte75099262009-02-16 21:12:08 +000027#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000028#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000029
Harald Welte8470bf22008-12-25 23:28:35 +000030#include <openbsc/gsm_data.h>
31#include <openbsc/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010032#include <osmocom/gsm/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000033#include <openbsc/abis_rsl.h>
34#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020035#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000036#include <openbsc/debug.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010037#include <osmocom/gsm/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000038#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000039#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010040#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010041#include <openbsc/rtp_proxy.h>
Pablo Neira Ayusoed5cacb2011-08-17 22:44:07 +020042#include <osmocom/abis/e1_input.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010043#include <osmocom/gsm/rsl.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010044#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080045
Harald Welte8470bf22008-12-25 23:28:35 +000046#define RSL_ALLOC_SIZE 1024
47#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000048
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +010049enum sacch_deact {
50 SACCH_NONE,
51 SACCH_DEACTIVATE,
52};
53
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080054static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
Holger Hans Peter Freytherf0405062014-04-06 12:21:05 +020055static void error_timeout_cb(void *data);
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080056
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010057static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
58 struct gsm_meas_rep *resp)
59{
60 struct lchan_signal_data sig;
61 sig.lchan = lchan;
62 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020063 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010064}
65
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +010066static void do_lchan_free(struct gsm_lchan *lchan)
67{
Holger Hans Peter Freytherf0405062014-04-06 12:21:05 +020068 /* We start the error timer to make the channel available again */
69 if (lchan->state == LCHAN_S_REL_ERR) {
70 lchan->error_timer.data = lchan;
71 lchan->error_timer.cb = error_timeout_cb;
72 osmo_timer_schedule(&lchan->error_timer,
73 lchan->ts->trx->bts->network->T3111 + 2, 0);
74 } else {
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +010075 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freytherf0405062014-04-06 12:21:05 +020076 }
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +010077 lchan_free(lchan);
78}
79
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020080static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000081{
82 /* mask off the transparent bit ? */
83 msg_type &= 0xfe;
84
Harald Welte8470bf22008-12-25 23:28:35 +000085 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000086 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000087 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000088 if (msg_type >= 0x19 && msg_type <= 0x22)
89 return ABIS_RSL_MDISC_TRX;
90 else
91 return ABIS_RSL_MDISC_COM_CHAN;
92 }
Harald Welte2d5b6382008-12-27 19:46:06 +000093 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000094 return ABIS_RSL_MDISC_DED_CHAN;
95
96 return ABIS_RSL_MDISC_LOC;
97}
98
99static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200100 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +0000101{
102 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
103 dh->c.msg_type = msg_type;
104 dh->ie_chan = RSL_IE_CHAN_NR;
105}
106
Harald Welte8470bf22008-12-25 23:28:35 +0000107/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200108struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +0000109{
110 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200111 uint8_t ts_nr = chan_nr & 0x07;
112 uint8_t cbits = chan_nr >> 3;
113 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +0000114 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
115
116 if (cbits == 0x01) {
117 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +0200118 if (ts->pchan != GSM_PCHAN_TCH_F &&
119 ts->pchan != GSM_PCHAN_PDCH &&
120 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000122 chan_nr, ts->pchan);
123 } else if ((cbits & 0x1e) == 0x02) {
124 lch_idx = cbits & 0x1; /* TCH/H */
125 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100126 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000127 chan_nr, ts->pchan);
128 } else if ((cbits & 0x1c) == 0x04) {
129 lch_idx = cbits & 0x3; /* SDCCH/4 */
Harald Welte30f1f372014-12-28 15:00:45 +0100130 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4 &&
131 ts->pchan != GSM_PCHAN_CCCH_SDCCH4_CBCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100132 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000133 chan_nr, ts->pchan);
134 } else if ((cbits & 0x18) == 0x08) {
135 lch_idx = cbits & 0x7; /* SDCCH/8 */
Harald Welte30f1f372014-12-28 15:00:45 +0100136 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C &&
137 ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C_CBCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100138 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000139 chan_nr, ts->pchan);
140 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
141 lch_idx = 0;
142 if (ts->pchan != GSM_PCHAN_CCCH &&
Harald Welte30f1f372014-12-28 15:00:45 +0100143 ts->pchan != GSM_PCHAN_CCCH_SDCCH4 &&
144 ts->pchan != GSM_PCHAN_CCCH_SDCCH4_CBCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100145 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000146 chan_nr, ts->pchan);
147 /* FIXME: we should not return first sdcch4 !!! */
148 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100149 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000150 return NULL;
151 }
152
153 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800154 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800155 if (lchan->conn)
156 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000157
158 return lchan;
159}
160
Harald Welte52b1f982008-12-23 20:25:15 +0000161/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200162uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000163{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200164 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000165
166 ret = strtoull(imsi_str, NULL, 10);
167
168 return ret;
169}
170
Harald Welte8470bf22008-12-25 23:28:35 +0000171static struct msgb *rsl_msgb_alloc(void)
172{
Harald Welte966636f2009-06-26 19:39:35 +0200173 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
174 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000175}
176
Harald Welte362322e2009-02-15 14:36:38 +0000177#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200178static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000179{
180 memcpy(out, in, len);
181
182 if (len < MACBLOCK_SIZE)
183 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
184}
185
Harald Welte08d91a52009-08-30 15:37:11 +0900186/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200187static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900188{
189 *out++ = lchan->encr.alg_id & 0xff;
190 if (lchan->encr.key_len)
191 memcpy(out, lchan->encr.key, lchan->encr.key_len);
192 return lchan->encr.key_len + 1;
193}
194
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200195static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200196{
Harald Welte7f93cea2009-02-23 00:02:59 +0000197 int i;
198
Harald Welte5b8ed432009-12-24 12:20:20 +0100199 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200200 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200201 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100202 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000203}
204
Harald Weltee8bd9e82011-08-10 23:26:33 +0200205static void lchan_act_tmr_cb(void *data)
206{
207 struct gsm_lchan *lchan = data;
208
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200209 LOGP(DRSL, LOGL_ERROR,
210 "%s Timeout during activation. Marked as broken.\n",
Harald Weltee8bd9e82011-08-10 23:26:33 +0200211 gsm_lchan_name(lchan));
212
Holger Hans Peter Freyther454140e2014-12-28 12:08:28 +0100213 rsl_lchan_mark_broken(lchan, "activation timeout");
Daniel Willmann513da172011-08-11 04:44:12 +0200214 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200215}
216
217static void lchan_deact_tmr_cb(void *data)
218{
219 struct gsm_lchan *lchan = data;
220
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200221 LOGP(DRSL, LOGL_ERROR,
222 "%s Timeout during deactivation! Marked as broken.\n",
Harald Weltee8bd9e82011-08-10 23:26:33 +0200223 gsm_lchan_name(lchan));
224
Holger Hans Peter Freyther454140e2014-12-28 12:08:28 +0100225 rsl_lchan_mark_broken(lchan, "de-activation timeout");
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200226 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200227}
228
229
Harald Welte52b1f982008-12-23 20:25:15 +0000230/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200231int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
232 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000233{
234 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000235 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000236
237 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
238 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
239 dh->chan_nr = RSL_CHAN_BCCH;
240
241 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
242 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
243
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200244 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000245
246 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000247}
248
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200249int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
250 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000251{
252 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000253 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000254
255 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
256 ch->msg_discr = ABIS_RSL_MDISC_TRX;
257 ch->msg_type = RSL_MT_SACCH_FILL;
258
259 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000260 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000261
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200262 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000263
264 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000265}
266
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200267int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
268 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100269{
270 struct abis_rsl_dchan_hdr *dh;
271 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200272 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100273
274 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
275 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
276 dh->chan_nr = chan_nr;
277
278 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
279 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
280
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200281 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte7a69cf02011-01-13 23:16:03 +0100282
283 return abis_rsl_sendmsg(msg);
284}
285
Harald Weltefcd24452009-06-20 18:15:19 +0200286int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
287{
288 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200289 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200290 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200291
292 db = abs(db);
293 if (db > 30)
294 return -EINVAL;
295
Harald Welteeab33352009-06-27 03:09:08 +0200296 msg = rsl_msgb_alloc();
297
Harald Weltefcd24452009-06-20 18:15:19 +0200298 lchan->bs_power = db/2;
299 if (fpc)
300 lchan->bs_power |= 0x10;
301
302 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
303 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
304 dh->chan_nr = chan_nr;
305
306 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
307
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200308 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200309
310 return abis_rsl_sendmsg(msg);
311}
312
Harald Weltefcd24452009-06-20 18:15:19 +0200313int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
314{
315 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200316 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200317 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200318 int ctl_lvl;
319
Harald Welte66b6a8d2009-08-09 14:45:18 +0200320 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200321 if (ctl_lvl < 0)
322 return ctl_lvl;
323
Harald Welteeab33352009-06-27 03:09:08 +0200324 msg = rsl_msgb_alloc();
325
Harald Weltefcd24452009-06-20 18:15:19 +0200326 lchan->ms_power = ctl_lvl;
327
328 if (fpc)
329 lchan->ms_power |= 0x20;
330
331 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
332 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
333 dh->chan_nr = chan_nr;
334
335 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
336
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200337 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200338
339 return abis_rsl_sendmsg(msg);
340}
341
Harald Welte9943c5b2009-07-29 15:41:29 +0200342static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
343 struct gsm_lchan *lchan)
344{
Holger Hans Peter Freythere1145cf2013-03-09 17:50:10 +0100345 memset(cm, 0, sizeof(*cm));
Harald Welte9943c5b2009-07-29 15:41:29 +0200346
347 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800348 if (lchan->ts->trx->bts->network->dtx_enabled)
349 cm->dtx_dtu = 0x03;
350 else
351 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200352
353 /* set TCH Speech/Data */
354 cm->spd_ind = lchan->rsl_cmode;
355
Harald Welte1a79d362009-11-27 08:55:16 +0100356 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
357 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100358 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100359 "but tch_mode != signalling\n");
360
Harald Welte9943c5b2009-07-29 15:41:29 +0200361 switch (lchan->type) {
362 case GSM_LCHAN_SDCCH:
363 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
364 break;
365 case GSM_LCHAN_TCH_F:
366 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
367 break;
368 case GSM_LCHAN_TCH_H:
369 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
370 break;
371 case GSM_LCHAN_NONE:
372 case GSM_LCHAN_UNKNOWN:
373 default:
374 return -EINVAL;
375 }
376
377 switch (lchan->tch_mode) {
378 case GSM48_CMODE_SIGN:
379 cm->chan_rate = 0;
380 break;
381 case GSM48_CMODE_SPEECH_V1:
382 cm->chan_rate = RSL_CMOD_SP_GSM1;
383 break;
384 case GSM48_CMODE_SPEECH_EFR:
385 cm->chan_rate = RSL_CMOD_SP_GSM2;
386 break;
387 case GSM48_CMODE_SPEECH_AMR:
388 cm->chan_rate = RSL_CMOD_SP_GSM3;
389 break;
390 case GSM48_CMODE_DATA_14k5:
Harald Welte9943c5b2009-07-29 15:41:29 +0200391 case GSM48_CMODE_DATA_12k0:
Harald Welte9943c5b2009-07-29 15:41:29 +0200392 case GSM48_CMODE_DATA_6k0:
Harald Weltee4227982012-08-24 15:33:56 +0200393 switch (lchan->csd_mode) {
394 case LCHAN_CSD_M_NT:
395 /* non-transparent CSD with RLP */
396 switch (lchan->tch_mode) {
397 case GSM48_CMODE_DATA_14k5:
398 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
399 break;
400 case GSM48_CMODE_DATA_12k0:
401 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
402 break;
403 case GSM48_CMODE_DATA_6k0:
404 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
405 break;
406 default:
407 return -EINVAL;
408 }
409 break;
410 /* transparent data services below */
411 case LCHAN_CSD_M_T_1200_75:
412 cm->chan_rate = RSL_CMOD_CSD_T_1200_75;
413 break;
414 case LCHAN_CSD_M_T_600:
415 cm->chan_rate = RSL_CMOD_CSD_T_600;
416 break;
417 case LCHAN_CSD_M_T_1200:
418 cm->chan_rate = RSL_CMOD_CSD_T_1200;
419 break;
420 case LCHAN_CSD_M_T_2400:
421 cm->chan_rate = RSL_CMOD_CSD_T_2400;
422 break;
423 case LCHAN_CSD_M_T_9600:
424 cm->chan_rate = RSL_CMOD_CSD_T_9600;
425 break;
426 case LCHAN_CSD_M_T_14400:
427 cm->chan_rate = RSL_CMOD_CSD_T_14400;
428 break;
429 case LCHAN_CSD_M_T_29000:
430 cm->chan_rate = RSL_CMOD_CSD_T_29000;
431 break;
432 case LCHAN_CSD_M_T_32000:
433 cm->chan_rate = RSL_CMOD_CSD_T_32000;
434 break;
435 default:
436 return -EINVAL;
437 }
Harald Welte9943c5b2009-07-29 15:41:29 +0200438 default:
439 return -EINVAL;
440 }
441
442 return 0;
443}
444
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200445static void mr_config_for_bts(struct gsm_lchan *lchan, struct msgb *msg)
446{
447 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
448 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, lchan->mr_bts_lv[0],
449 lchan->mr_bts_lv + 1);
450}
451
Harald Welte52b1f982008-12-23 20:25:15 +0000452/* Chapter 8.4.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200453int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
Andreas Eversberg723a7512013-10-11 12:55:35 +0200454 uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000455{
456 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200457 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200458 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200459 uint8_t *len;
Andreas Eversberg723a7512013-10-11 12:55:35 +0200460 uint8_t ta;
Harald Welte4b634542008-12-27 01:55:51 +0000461
Harald Weltef6093a42011-06-25 10:02:33 +0200462 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000463 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200464 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000465
Harald Welte9943c5b2009-07-29 15:41:29 +0200466 rc = channel_mode_from_lchan(&cm, lchan);
467 if (rc < 0)
468 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000469
Andreas Eversberg723a7512013-10-11 12:55:35 +0200470 ta = lchan->rqd_ta;
471
472 /* BS11 requires TA shifted by 2 bits */
473 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11)
474 ta <<= 2;
475
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800476 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200477 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000478
Harald Welteeab33352009-06-27 03:09:08 +0200479 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000480 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
481 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
482 dh->chan_nr = chan_nr;
483
484 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000485 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200486 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800487
488 /*
489 * The Channel Identification is needed for Phase1 phones
490 * and it contains the GSM48 Channel Description and the
491 * Mobile Allocation. The GSM 08.58 asks for the Mobile
492 * Allocation to have a length of zero. We are using the
493 * msgb_l3len to calculate the length of both messages.
494 */
laforge694a5cf2010-06-20 21:38:19 +0200495 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200496 len = msgb_put(msg, 1);
Dieter Spaareabb6e32011-07-27 23:40:33 +0200497 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800498
499 if (lchan->ts->hopping.enabled)
500 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
501 lchan->ts->hopping.ma_data);
502 else
503 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800504
505 /* update the calculated size */
506 msg->l3h = len + 1;
507 *len = msgb_l3len(msg);
508
Harald Welte08d91a52009-08-30 15:37:11 +0900509 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200510 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900511 rc = build_encr_info(encr_info, lchan);
512 if (rc > 0)
513 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
514 }
515
Harald Welte8d77b952009-12-17 00:31:10 +0100516 switch (act_type) {
517 case RSL_ACT_INTER_ASYNC:
518 case RSL_ACT_INTER_SYNC:
519 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
520 break;
521 default:
522 break;
523 }
524
Harald Welted4c9bf32009-02-15 16:56:18 +0000525 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
526 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000527 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200528 mr_config_for_bts(lchan, msg);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100529
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200530 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000531
Harald Welte4b634542008-12-27 01:55:51 +0000532 return abis_rsl_sendmsg(msg);
533}
534
Harald Welte470abb72009-07-29 11:38:15 +0200535/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000536int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
537{
538 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200539 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200540 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000541
Harald Weltef6093a42011-06-25 10:02:33 +0200542 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000543 struct rsl_ie_chan_mode cm;
544
Harald Welte9943c5b2009-07-29 15:41:29 +0200545 rc = channel_mode_from_lchan(&cm, lchan);
546 if (rc < 0)
547 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000548
Harald Welteeab33352009-06-27 03:09:08 +0200549 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000550 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
551 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
552 dh->chan_nr = chan_nr;
553
554 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200555 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900556
557 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200558 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900559 rc = build_encr_info(encr_info, lchan);
560 if (rc > 0)
561 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
562 }
563
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200564 mr_config_for_bts(lchan, msg);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100565
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200566 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte08d91a52009-08-30 15:37:11 +0900567
568 return abis_rsl_sendmsg(msg);
569}
570
571/* Chapter 8.4.6: Send the encryption command with given L3 info */
572int rsl_encryption_cmd(struct msgb *msg)
573{
574 struct abis_rsl_dchan_hdr *dh;
575 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200576 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200577 uint8_t encr_info[MAX_A5_KEY_LEN+2];
578 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900579 int rc;
580
581 /* First push the L3 IE tag and length */
582 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
583
584 /* then the link identifier (SAPI0, main sign link) */
585 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
586
587 /* then encryption information */
588 rc = build_encr_info(encr_info, lchan);
589 if (rc <= 0)
590 return rc;
591 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
592
593 /* and finally the DCHAN header */
594 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
595 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
596 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000597
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200598 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteda783762009-02-18 03:29:53 +0000599
600 return abis_rsl_sendmsg(msg);
601}
602
Harald Welte115d1032009-08-10 11:43:22 +0200603/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200604int rsl_deact_sacch(struct gsm_lchan *lchan)
605{
606 struct abis_rsl_dchan_hdr *dh;
607 struct msgb *msg = rsl_msgb_alloc();
608
609 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
610 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200611 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200612
613 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200614 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteae0f2362009-07-19 18:36:49 +0200615
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100616 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200617
618 return abis_rsl_sendmsg(msg);
619}
620
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800621static void error_timeout_cb(void *data)
622{
623 struct gsm_lchan *lchan = data;
624 if (lchan->state != LCHAN_S_REL_ERR) {
625 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
626 gsm_lchan_name(lchan), lchan->state);
627 return;
628 }
629
630 /* go back to the none state */
Harald Weltea9e420e2012-11-13 04:26:22 +0100631 LOGP(DRSL, LOGL_INFO, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800632 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800633}
634
Harald Weltefd355a32011-03-04 13:41:31 +0100635static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
636
Harald Welte115d1032009-08-10 11:43:22 +0200637/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100638static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error,
639 enum sacch_deact deact_sacch)
Harald Welte52b1f982008-12-23 20:25:15 +0000640{
641 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800642 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100643 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000644
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100645 /* Stop timers that should lead to a channel release */
646 osmo_timer_del(&lchan->T3109);
647
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800648 if (lchan->state == LCHAN_S_REL_ERR) {
649 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
650 gsm_lchan_name(lchan));
651 return -1;
652 }
653
654 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000655 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
656 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200657 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000658
Harald Welte8470bf22008-12-25 23:28:35 +0000659 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200660 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000661
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800662 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
663
664 if (error) {
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +0100665 /*
666 * FIXME: GSM 04.08 gives us two options for the abnormal
667 * chanel release. This can be either like in the non-existent
668 * sub-lcuase 3.5.1 or for the main signalling link deactivate
669 * the SACCH, start timer T3109 and consider the channel as
670 * released.
671 *
672 * This code is doing the later for all raido links and not
673 * only the main link. Right now all SAPIs are released on the
674 * local end, the SACCH will be de-activated and right now the
675 * T3111 will be started. First T3109 should be started and then
676 * the T3111.
677 *
678 * TODO: Move this out of the function.
679 */
680
681 /*
682 * sacch de-activate and "local end release"
683 */
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100684 if (deact_sacch == SACCH_DEACTIVATE)
685 rsl_deact_sacch(lchan);
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +0100686 rsl_release_sapis_from(lchan, 0, RSL_REL_LOCAL_END);
687
688 /*
689 * TODO: start T3109 now.
690 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800691 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800692 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000693
Harald Weltee8bd9e82011-08-10 23:26:33 +0200694 /* Start another timer or assume the BTS sends a ACK/NACK? */
695 lchan->act_timer.cb = lchan_deact_tmr_cb;
696 lchan->act_timer.data = lchan;
697 osmo_timer_schedule(&lchan->act_timer, 4, 0);
698
Harald Weltefd355a32011-03-04 13:41:31 +0100699 rc = abis_rsl_sendmsg(msg);
700
Harald Welte115d1032009-08-10 11:43:22 +0200701 /* BTS will respond by RF CHAN REL ACK */
Harald Weltefd355a32011-03-04 13:41:31 +0100702 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000703}
704
Holger Hans Peter Freyther0e4e73a2014-04-19 17:38:33 +0200705/*
706 * Special handling for channel releases in the error case.
707 */
708static int rsl_rf_chan_release_err(struct gsm_lchan *lchan)
709{
710 if (lchan->state != LCHAN_S_ACTIVE)
711 return 0;
712 return rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
713}
714
Harald Welte64bb7542011-01-14 14:16:16 +0100715static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
716{
717
718 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
719
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100720 /* Stop all pending timers */
Harald Weltee8bd9e82011-08-10 23:26:33 +0200721 osmo_timer_del(&lchan->act_timer);
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100722 osmo_timer_del(&lchan->T3111);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200723
Holger Hans Peter Freyther6f6cbf72015-04-04 19:35:22 +0200724 /*
725 * The BTS didn't respond within the timeout to our channel
726 * release request and we have marked the channel as broken.
727 * Now we do receive an ACK and let's be conservative. If it
728 * is a sysmoBTS we know that only one RF Channel Release ACK
729 * will be sent. So let's "repair" the channel.
730 */
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200731 if (lchan->state == LCHAN_S_BROKEN) {
Holger Hans Peter Freyther6f6cbf72015-04-04 19:35:22 +0200732 int do_free = is_sysmobts_v2(lchan->ts->trx->bts);
733 LOGP(DRSL, LOGL_NOTICE,
734 "%s CHAN REL ACK for broken channel. %s.\n",
735 gsm_lchan_name(lchan),
736 do_free ? "Releasing it" : "Keeping it broken");
737 if (do_free)
738 do_lchan_free(lchan);
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200739 return 0;
740 }
741
Harald Welte64bb7542011-01-14 14:16:16 +0100742 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
743 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
744 gsm_lchan_name(lchan),
745 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100746 do_lchan_free(lchan);
Harald Welte64bb7542011-01-14 14:16:16 +0100747
748 return 0;
749}
750
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200751int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
752 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000753{
754 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000755 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000756
757 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
758 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
759 dh->chan_nr = RSL_CHAN_PCH_AGCH;
760
761 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000762 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000763 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
764
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200765 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000766
767 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000768}
769
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200770int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000771{
772 int i, len = strlen(str_in);
773
774 for (i = 0; i < len; i++) {
775 int num = str_in[i] - 0x30;
776 if (num < 0 || num > 9)
777 return -1;
778 if (i % 2 == 0)
779 bcd_out[i/2] = num;
780 else
781 bcd_out[i/2] |= (num << 4);
782 }
783
784 return 0;
785}
786
Harald Welte702d8702008-12-26 20:25:35 +0000787/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200788int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000789{
Harald Welte8470bf22008-12-25 23:28:35 +0000790 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000791 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200792 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000793
794 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
795 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
796 dh->chan_nr = RSL_CHAN_PCH_AGCH;
797
Harald Welte362322e2009-02-15 14:36:38 +0000798 switch (bts->type) {
799 case GSM_BTS_TYPE_BS11:
800 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
801 break;
802 default:
803 /* If phase 2, construct a FULL_IMM_ASS_INFO */
804 pad_macblock(buf, val, len);
805 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
806 break;
807 }
Harald Welte52b1f982008-12-23 20:25:15 +0000808
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200809 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000810
811 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000812}
813
Harald Welte67fa91b2009-08-10 09:51:40 +0200814/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200815int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200816{
817 struct msgb *msg = rsl_msgb_alloc();
818 struct abis_rsl_dchan_hdr *dh;
819
820 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
821 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200822 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200823 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200824 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200825
Harald Welte5b8ed432009-12-24 12:20:20 +0100826 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200827 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200828
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200829 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte3c456d02009-08-10 11:26:14 +0200830
Harald Welte67fa91b2009-08-10 09:51:40 +0200831 return abis_rsl_sendmsg(msg);
832}
833
834
Harald Welte8470bf22008-12-25 23:28:35 +0000835/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000836/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200837int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000838{
Harald Welte8470bf22008-12-25 23:28:35 +0000839 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100840 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000841 return -EINVAL;
842 }
Harald Welte52b1f982008-12-23 20:25:15 +0000843
Harald Weltef6093a42011-06-25 10:02:33 +0200844 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100845 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000846
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200847 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000848
849 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000850}
851
Harald Welteedcc5272009-08-09 13:47:35 +0200852/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
853/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200854int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200855{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100856 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200857
Harald Weltef6093a42011-06-25 10:02:33 +0200858 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100859 link_id, 0);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200860 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteedcc5272009-08-09 13:47:35 +0200861
Harald Weltefda74ee2012-04-26 19:42:19 +0200862 DEBUGP(DRLL, "%s RSL RLL ESTABLISH REQ (link_id=0x%02x)\n",
863 gsm_lchan_name(lchan), link_id);
864
Harald Welteedcc5272009-08-09 13:47:35 +0200865 return abis_rsl_sendmsg(msg);
866}
867
Andreas Eversberg7d8fa342013-12-05 13:25:06 +0100868static void rsl_handle_release(struct gsm_lchan *lchan);
869
870/* Special work handler to handle missing RSL_MT_REL_CONF message from
871 * Nokia InSite BTS */
872static void lchan_rel_work_cb(void *data)
873{
874 struct gsm_lchan *lchan = data;
875 int sapi;
876
877 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
878 if (lchan->sapis[sapi] == LCHAN_SAPI_REL)
879 lchan->sapis[sapi] = LCHAN_SAPI_UNUSED;
880 }
881 rsl_handle_release(lchan);
882}
883
Harald Welted2dc1de2009-08-08 13:15:07 +0200884/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
885 This is what higher layers should call. The BTS then responds with
886 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
887 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
888 lchan_free() */
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100889int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id,
890 enum rsl_rel_mode release_mode)
Harald Welted2dc1de2009-08-08 13:15:07 +0200891{
Harald Welted2dc1de2009-08-08 13:15:07 +0200892
Harald Welte3c9c5f92010-03-04 10:33:10 +0100893 struct msgb *msg;
894
Harald Weltef6093a42011-06-25 10:02:33 +0200895 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100896 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800897 /* 0 is normal release, 1 is local end */
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100898 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, release_mode);
Harald Welted2dc1de2009-08-08 13:15:07 +0200899
Harald Welte8e93b792009-12-29 10:44:17 +0100900 /* FIXME: start some timer in case we don't receive a REL ACK ? */
901
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200902 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dc1de2009-08-08 13:15:07 +0200903
Harald Weltefda74ee2012-04-26 19:42:19 +0200904 DEBUGP(DRLL, "%s RSL RLL RELEASE REQ (link_id=0x%02x, reason=%u)\n",
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100905 gsm_lchan_name(lchan), link_id, release_mode);
Harald Weltefda74ee2012-04-26 19:42:19 +0200906
Andreas Eversberg7d8fa342013-12-05 13:25:06 +0100907 abis_rsl_sendmsg(msg);
908
909 /* Do not wait for Nokia BTS to send the confirm. */
910 if (is_nokia_bts(lchan->ts->trx->bts)
911 && lchan->ts->trx->bts->nokia.no_loc_rel_cnf
912 && release_mode == RSL_REL_LOCAL_END) {
913 DEBUGP(DRLL, "Scheduling release, becasuse Nokia InSite BTS does not send a RELease CONFirm.\n");
914 lchan->sapis[link_id & 0x7] = LCHAN_SAPI_REL;
915 lchan->rel_work.cb = lchan_rel_work_cb;
916 lchan->rel_work.data = lchan;
917 osmo_timer_schedule(&lchan->rel_work, 0, 0);
918 }
919
920 return 0;
Harald Welted2dc1de2009-08-08 13:15:07 +0200921}
922
Holger Hans Peter Freyther454140e2014-12-28 12:08:28 +0100923int rsl_lchan_mark_broken(struct gsm_lchan *lchan, const char *reason)
924{
925 lchan->state = LCHAN_S_BROKEN;
926 lchan->broken_reason = reason;
927 return 0;
928}
929
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200930int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
931{
932 lchan->state = state;
933 return 0;
934}
935
Harald Welte702d8702008-12-26 20:25:35 +0000936/* Chapter 8.4.2: Channel Activate Acknowledge */
937static int rsl_rx_chan_act_ack(struct msgb *msg)
938{
939 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
940
941 /* BTS has confirmed channel activation, we now need
942 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000943 if (rslh->ie_chan != RSL_IE_CHAN_NR)
944 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100945
Harald Weltee8bd9e82011-08-10 23:26:33 +0200946 osmo_timer_del(&msg->lchan->act_timer);
947
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200948 if (msg->lchan->state == LCHAN_S_BROKEN) {
949 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK for broken channel.\n",
950 gsm_lchan_name(msg->lchan));
951 return 0;
952 }
953
Harald Welte8e93b792009-12-29 10:44:17 +0100954 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100955 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
956 gsm_lchan_name(msg->lchan),
957 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200958 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100959
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800960 if (msg->lchan->rqd_ref) {
961 rsl_send_imm_assignment(msg->lchan);
962 talloc_free(msg->lchan->rqd_ref);
963 msg->lchan->rqd_ref = NULL;
964 msg->lchan->rqd_ta = 0;
965 }
966
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100967 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100968
Harald Welte4b634542008-12-27 01:55:51 +0000969 return 0;
970}
Harald Welte702d8702008-12-26 20:25:35 +0000971
Harald Welte4b634542008-12-27 01:55:51 +0000972/* Chapter 8.4.3: Channel Activate NACK */
973static int rsl_rx_chan_act_nack(struct msgb *msg)
974{
Harald Welte6dab0552009-05-01 17:21:37 +0000975 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
976 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000977
Harald Weltee8bd9e82011-08-10 23:26:33 +0200978 osmo_timer_del(&msg->lchan->act_timer);
979
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200980 if (msg->lchan->state == LCHAN_S_BROKEN) {
981 LOGP(DRSL, LOGL_ERROR,
982 "%s CHANNEL ACTIVATE NACK for broken channel.\n",
983 gsm_lchan_name(msg->lchan));
984 return -1;
985 }
986
Daniel Willmann6fc6a122011-08-11 04:54:23 +0200987 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100988 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100989
Harald Welte6dab0552009-05-01 17:21:37 +0000990 /* BTS has rejected channel activation ?!? */
991 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000992 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000993
994 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100995 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200996 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100997 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200998 TLVP_LEN(&tp, RSL_IE_CAUSE));
Holger Hans Peter Freyther638da512012-12-06 19:25:06 +0100999 msg->lchan->error_cause = *cause;
Holger Hans Peter Freyther454140e2014-12-28 12:08:28 +01001000 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC) {
1001 rsl_lchan_mark_broken(msg->lchan, "NACK on activation");
1002 } else
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001003 rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Daniel Willmann7ddc3182011-08-11 04:47:11 +02001004
Holger Hans Peter Freyther454140e2014-12-28 12:08:28 +01001005 } else {
1006 rsl_lchan_mark_broken(msg->lchan, "NACK on activation no IE");
1007 }
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001008
Harald Welte (local)91b603d2009-12-27 11:48:11 +01001009 LOGPC(DRSL, LOGL_ERROR, "\n");
1010
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001011 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte4b634542008-12-27 01:55:51 +00001012 return 0;
Harald Welte702d8702008-12-26 20:25:35 +00001013}
1014
Harald Welte7f93cea2009-02-23 00:02:59 +00001015/* Chapter 8.4.4: Connection Failure Indication */
1016static int rsl_rx_conn_fail(struct msgb *msg)
1017{
1018 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1019 struct tlv_parsed tp;
1020
Holger Hans Peter Freyther1e93b792014-04-19 16:45:36 +02001021 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING state %s ",
1022 gsm_lchan_name(msg->lchan),
1023 gsm_lchans_name(msg->lchan->state));
1024
Harald Welte7f93cea2009-02-23 00:02:59 +00001025 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1026
Harald Welte8830e072009-07-28 17:58:09 +02001027 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001028 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001029 TLVP_LEN(&tp, RSL_IE_CAUSE));
1030
Harald Welte (local)fc057502009-12-26 22:33:09 +01001031 LOGPC(DRSL, LOGL_NOTICE, "\n");
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001032 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther0e4e73a2014-04-19 17:38:33 +02001033 return rsl_rf_chan_release_err(msg->lchan);
Harald Welte7f93cea2009-02-23 00:02:59 +00001034}
1035
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001036static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
1037 const char *prefix)
1038{
Harald Welte6739dfb2009-12-16 16:52:07 +01001039 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
1040 prefix, rxlev2dbm(mru->full.rx_lev),
1041 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001042 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
1043 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
1044}
1045
Harald Welte0c1bd612012-07-02 17:12:08 +02001046static void print_meas_rep(struct gsm_lchan *lchan, struct gsm_meas_rep *mr)
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001047{
Harald Welte6739dfb2009-12-16 16:52:07 +01001048 int i;
Harald Welte0c1bd612012-07-02 17:12:08 +02001049 char *name = "";
Harald Welte6739dfb2009-12-16 16:52:07 +01001050
Harald Welte0c1bd612012-07-02 17:12:08 +02001051 if (lchan && lchan->conn && lchan->conn->subscr)
1052 name = subscr_name(lchan->conn->subscr);
1053
1054 DEBUGP(DMEAS, "[%s] MEASUREMENT RESULT NR=%d ", name, mr->nr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001055
1056 if (mr->flags & MEAS_REP_F_DL_DTX)
1057 DEBUGPC(DMEAS, "DTXd ");
1058
1059 print_meas_rep_uni(&mr->ul, "ul");
1060 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
1061 if (mr->flags & MEAS_REP_F_MS_TO)
1062 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
1063
1064 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +01001065 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001066 DEBUGPC(DMEAS, "L1_FPC=%u ",
1067 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1068 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1069 }
1070
1071 if (mr->flags & MEAS_REP_F_UL_DTX)
1072 DEBUGPC(DMEAS, "DTXu ");
1073 if (mr->flags & MEAS_REP_F_BA1)
1074 DEBUGPC(DMEAS, "BA1 ");
1075 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1076 DEBUGPC(DMEAS, "NOT VALID ");
1077 else
1078 print_meas_rep_uni(&mr->dl, "dl");
1079
1080 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +01001081 if (mr->num_cell == 7)
1082 return;
Harald Welte6739dfb2009-12-16 16:52:07 +01001083 for (i = 0; i < mr->num_cell; i++) {
1084 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +01001085 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1086 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +01001087 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001088}
1089
Harald Welte440fed02009-05-01 18:43:47 +00001090static int rsl_rx_meas_res(struct msgb *msg)
1091{
1092 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1093 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +01001094 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001095 uint8_t len;
1096 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001097 int rc;
Harald Welte440fed02009-05-01 18:43:47 +00001098
Harald Welteb8bfc562009-12-21 13:27:11 +01001099 /* check if this channel is actually active */
1100 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +01001101 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +08001102 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +01001103 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +01001104 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +01001105 }
Harald Welteb8bfc562009-12-21 13:27:11 +01001106
Harald Welted12b0fd2009-12-15 21:36:05 +01001107 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +01001108 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +01001109
Harald Welte440fed02009-05-01 18:43:47 +00001110 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1111
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001112 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1113 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1114 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1115 return -EIO;
1116
1117 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +01001118 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001119
1120 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1121 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1122 if (len >= 3) {
1123 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +01001124 mr->flags |= MEAS_REP_F_DL_DTX;
1125 mr->ul.full.rx_lev = val[0] & 0x3f;
1126 mr->ul.sub.rx_lev = val[1] & 0x3f;
1127 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1128 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +00001129 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001130
Harald Welted12b0fd2009-12-15 21:36:05 +01001131 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001132
1133 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +00001134 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +01001135 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001136 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1137
Harald Weltefe9af262009-06-20 18:44:35 +02001138 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001139 struct e1inp_sign_link *sign_link = msg->dst;
1140
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001141 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001142 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001143 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001144 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001145 mr->flags |= MEAS_REP_F_FPC;
1146 mr->ms_l1.ta = val[1];
Andreas Eversberg3365cd12011-12-24 11:49:05 +01001147 /* BS11 and Nokia reports TA shifted by 2 bits */
1148 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1149 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg2957de92011-12-16 17:45:37 +01001150 mr->ms_l1.ta >>= 2;
Harald Weltefe9af262009-06-20 18:44:35 +02001151 }
Harald Weltef7c43522009-06-09 20:24:21 +00001152 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001153 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001154 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001155 if (rc < 0)
1156 return rc;
1157 }
1158
Harald Welte0c1bd612012-07-02 17:12:08 +02001159 print_meas_rep(msg->lchan, mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001160
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001161 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001162
Harald Welte75d34a82009-05-23 06:11:13 +00001163 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001164}
1165
Harald Welted011e8b2009-11-29 22:45:52 +01001166/* Chapter 8.4.7 */
1167static int rsl_rx_hando_det(struct msgb *msg)
1168{
1169 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1170 struct tlv_parsed tp;
1171
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001172 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001173
1174 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1175
1176 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1177 DEBUGPC(DRSL, "access delay = %u\n",
1178 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1179 else
1180 DEBUGPC(DRSL, "\n");
1181
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001182 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001183
1184 return 0;
1185}
1186
Harald Welte52b1f982008-12-23 20:25:15 +00001187static int abis_rsl_rx_dchan(struct msgb *msg)
1188{
Harald Welte8470bf22008-12-25 23:28:35 +00001189 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1190 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001191 char *ts_name;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001192 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001193
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001194 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001195 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001196
Harald Welte8470bf22008-12-25 23:28:35 +00001197 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001198 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001199 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001200 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001201 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001202 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001203 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001204 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001205 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001206 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001207 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001208 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001209 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001210 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001211 case RSL_MT_HANDO_DET:
1212 rc = rsl_rx_hando_det(msg);
1213 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001214 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001215 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001216 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001217 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001218 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001219 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001220 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001221 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001222 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001223 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001224 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001225 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001226 break;
1227 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001228 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001229 break;
1230 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001231 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001232 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001233 break;
1234 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001235 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001236 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001237 case RSL_MT_PHY_CONTEXT_CONF:
1238 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001239 case RSL_MT_TALKER_DET:
1240 case RSL_MT_LISTENER_DET:
1241 case RSL_MT_REMOTE_CODEC_CONF_REP:
1242 case RSL_MT_MR_CODEC_MOD_ACK:
1243 case RSL_MT_MR_CODEC_MOD_NACK:
1244 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001245 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1246 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001247 break;
1248 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001249 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1250 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001251 return -EINVAL;
1252 }
Harald Weltef325eb42009-02-19 17:07:39 +00001253
Harald Welte8470bf22008-12-25 23:28:35 +00001254 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001255}
1256
Harald Welte702d8702008-12-26 20:25:35 +00001257static int rsl_rx_error_rep(struct msgb *msg)
1258{
1259 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001260 struct tlv_parsed tp;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001261 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte702d8702008-12-26 20:25:35 +00001262
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001263 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001264
1265 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1266
1267 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001268 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001269 TLVP_LEN(&tp, RSL_IE_CAUSE));
1270
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001271 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001272
1273 return 0;
1274}
1275
Harald Welte52b1f982008-12-23 20:25:15 +00001276static int abis_rsl_rx_trx(struct msgb *msg)
1277{
Harald Welte702d8702008-12-26 20:25:35 +00001278 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001279 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte8470bf22008-12-25 23:28:35 +00001280 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001281
1282 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001283 case RSL_MT_ERROR_REPORT:
1284 rc = rsl_rx_error_rep(msg);
1285 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001286 case RSL_MT_RF_RES_IND:
1287 /* interference on idle channels of TRX */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001288 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001289 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001290 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001291 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001292 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001293 gsm_trx_name(sign_link->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001294 break;
Dieter Spaar16646022011-07-28 00:01:50 +02001295 case 0x42: /* Nokia specific: SI End ACK */
1296 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1297 break;
1298 case 0x43: /* Nokia specific: SI End NACK */
1299 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1300 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001301 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001302 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001303 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001304 return -EINVAL;
1305 }
Harald Welte8470bf22008-12-25 23:28:35 +00001306 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001307}
1308
Harald Welteb7e81162009-08-10 00:26:10 +02001309/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1310static void t3101_expired(void *data)
1311{
1312 struct gsm_lchan *lchan = data;
1313
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001314 rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
Harald Welteb7e81162009-08-10 00:26:10 +02001315}
1316
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001317/* If T3111 expires, we will send the RF Channel Request */
1318static void t3111_expired(void *data)
1319{
1320 struct gsm_lchan *lchan = data;
1321
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001322 rsl_rf_chan_release(lchan, 0, SACCH_NONE);
1323}
1324
1325/* If T3109 expires the MS has not send a UA/UM do the error release */
1326static void t3109_expired(void *data)
1327{
1328 struct gsm_lchan *lchan = data;
1329
1330 LOGP(DRSL, LOGL_ERROR,
1331 "%s SACCH deactivation timeout.\n", gsm_lchan_name(lchan));
1332 rsl_rf_chan_release(lchan, 1, SACCH_NONE);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001333}
1334
laforgecfa4a012010-06-21 12:08:52 +02001335#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1336
Harald Welte2862dca2010-12-23 14:39:29 +01001337/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1338static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1339 unsigned int num_req_refs,
1340 struct gsm48_req_ref *rqd_refs,
1341 uint8_t wait_ind)
1342{
1343 uint8_t buf[GSM_MACBLOCK_LEN];
1344 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1345
1346 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1347 memset(iar, 0, sizeof(*iar));
1348 iar->proto_discr = GSM48_PDISC_RR;
Andreas Eversberg75e13a42013-02-07 11:51:16 +01001349 iar->msg_type = GSM48_MT_RR_IMM_ASS_REJ;
Harald Welte2862dca2010-12-23 14:39:29 +01001350 iar->page_mode = GSM48_PM_SAME;
1351
1352 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1353 iar->wait_ind1 = wait_ind;
1354
1355 if (num_req_refs >= 2)
1356 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1357 else
1358 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1359 iar->wait_ind2 = wait_ind;
1360
1361 if (num_req_refs >= 3)
1362 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1363 else
1364 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1365 iar->wait_ind3 = wait_ind;
1366
1367 if (num_req_refs >= 4)
1368 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1369 else
1370 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1371 iar->wait_ind4 = wait_ind;
1372
Andreas Eversberg75e13a42013-02-07 11:51:16 +01001373 /* we need to subtract 1 byte from sizeof(*iar) since ia includes the l2_plen field */
1374 iar->l2_plen = GSM48_LEN2PLEN((sizeof(*iar)-1));
1375
1376 return rsl_imm_assign_cmd(bts, sizeof(*iar), (uint8_t *) iar);
Harald Welte2862dca2010-12-23 14:39:29 +01001377}
1378
Harald Welte8470bf22008-12-25 23:28:35 +00001379/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001380static int rsl_rx_chan_rqd(struct msgb *msg)
1381{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001382 struct e1inp_sign_link *sign_link = msg->dst;
1383 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001384 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1385 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001386 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001387 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001388 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001389 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001390 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001391
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001392 uint16_t arfcn;
Holger Hans Peter Freytherc6d0a172012-02-03 20:10:13 +01001393 uint8_t subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001394
Harald Welte8470bf22008-12-25 23:28:35 +00001395 /* parse request reference to be used in immediate assign */
1396 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1397 return -EINVAL;
1398
1399 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1400
1401 /* parse access delay and use as TA */
1402 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1403 return -EINVAL;
1404 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1405
1406 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1407 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001408 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1409 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001410
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001411 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001412
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001413 /*
1414 * We want LOCATION UPDATES to succeed and will assign a TCH
1415 * if we have no SDCCH available.
1416 */
1417 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1418
Harald Welte8470bf22008-12-25 23:28:35 +00001419 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001420 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001421 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001422 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001423 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001424 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001425 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1426 if (bts->network->T3122)
1427 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte1dcc2602012-11-13 04:46:03 +01001428 return 0;
Harald Welte8470bf22008-12-25 23:28:35 +00001429 }
1430
Harald Welte8e93b792009-12-29 10:44:17 +01001431 if (lchan->state != LCHAN_S_NONE)
1432 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001433 "in state %s\n", gsm_lchan_name(lchan),
1434 gsm_lchans_name(lchan->state));
Harald Welte (local)3e460312009-12-27 18:12:29 +01001435
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001436 /* save the RACH data as we need it after the CHAN ACT ACK */
1437 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1438 if (!lchan->rqd_ref) {
1439 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1440 lchan_free(lchan);
1441 return -ENOMEM;
1442 }
1443
Holger Hans Peter Freytherc0a66742011-12-29 23:33:04 +01001444 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001445 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1446 lchan->rqd_ta = rqd_ta;
1447
Harald Welte8470bf22008-12-25 23:28:35 +00001448 arfcn = lchan->ts->trx->arfcn;
1449 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001450
Harald Welte08d91a52009-08-30 15:37:11 +09001451 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001452 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001453 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001454 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001455 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001456
Harald Weltee8bd9e82011-08-10 23:26:33 +02001457 /* Start another timer or assume the BTS sends a ACK/NACK? */
1458 lchan->act_timer.cb = lchan_act_tmr_cb;
1459 lchan->act_timer.data = lchan;
1460 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1461
Andreas Eversberg2957de92011-12-16 17:45:37 +01001462 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1463 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1464 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1465 rqd_ref->ra, rqd_ta);
1466
Andreas Eversberg723a7512013-10-11 12:55:35 +02001467 rsl_chan_activate_lchan(lchan, 0x00, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001468
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001469 return 0;
1470}
1471
1472static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1473{
1474 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001475 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001476 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1477
Harald Welte52b1f982008-12-23 20:25:15 +00001478 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001479 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001480 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001481 ia->proto_discr = GSM48_PDISC_RR;
1482 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1483 ia->page_mode = GSM48_PM_SAME;
1484 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001485
Harald Welte8470bf22008-12-25 23:28:35 +00001486 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001487 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1488 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001489 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001490 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001491 } else {
laforge09108bf2010-06-20 15:18:46 +02001492 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1493 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001494 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001495 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1496 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001497
Harald Welteb7e81162009-08-10 00:26:10 +02001498 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1499 lchan->T3101.cb = t3101_expired;
1500 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001501 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001502
Harald Welte52b1f982008-12-23 20:25:15 +00001503 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001504 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001505}
1506
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001507/* current load on the CCCH */
Harald Welteea280442009-02-02 22:29:56 +00001508static int rsl_rx_ccch_load(struct msgb *msg)
1509{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001510 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001511 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001512 struct ccch_signal_data sd;
1513
1514 sd.bts = sign_link->trx->bts;
1515 sd.rach_slot_count = -1;
1516 sd.rach_busy_count = -1;
1517 sd.rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001518
1519 switch (rslh->data[0]) {
1520 case RSL_IE_PAGING_LOAD:
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001521 sd.pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1522 if (is_ipaccess_bts(sign_link->trx->bts) && sd.pg_buf_space == 0xffff) {
Harald Welte38e9c822010-04-19 10:24:07 +02001523 /* paging load below configured threshold, use 50 as default */
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001524 sd.pg_buf_space = 50;
Harald Welte38e9c822010-04-19 10:24:07 +02001525 }
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001526 paging_update_buffer_space(sign_link->trx->bts, sd.pg_buf_space);
1527 osmo_signal_dispatch(SS_CCCH, S_CCCH_PAGING_LOAD, &sd);
Harald Welteea280442009-02-02 22:29:56 +00001528 break;
1529 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001530 if (msg->data_len >= 7) {
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001531 sd.rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1532 sd.rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1533 sd.rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1534 osmo_signal_dispatch(SS_CCCH, S_CCCH_RACH_LOAD, &sd);
Holger Freyther8c563cf2009-02-03 20:08:51 +00001535 }
Harald Welteea280442009-02-02 22:29:56 +00001536 break;
1537 default:
1538 break;
1539 }
1540
1541 return 0;
1542}
1543
Harald Welte52b1f982008-12-23 20:25:15 +00001544static int abis_rsl_rx_cchan(struct msgb *msg)
1545{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001546 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001547 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001548 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001549
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001550 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +00001551
1552 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001553 case RSL_MT_CHAN_RQD:
1554 /* MS has requested a channel on the RACH */
1555 rc = rsl_rx_chan_rqd(msg);
1556 break;
Harald Welteea280442009-02-02 22:29:56 +00001557 case RSL_MT_CCCH_LOAD_IND:
1558 /* current load on the CCCH */
1559 rc = rsl_rx_ccch_load(msg);
1560 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001561 case RSL_MT_DELETE_IND:
1562 /* CCCH overloaded, IMM_ASSIGN was dropped */
1563 case RSL_MT_CBCH_LOAD_IND:
1564 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001565 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1566 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001567 break;
1568 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001569 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1570 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001571 return -EINVAL;
1572 }
Harald Welte8470bf22008-12-25 23:28:35 +00001573
1574 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001575}
1576
Harald Welte4b634542008-12-27 01:55:51 +00001577static int rsl_rx_rll_err_ind(struct msgb *msg)
1578{
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001579 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +00001580 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001581 uint8_t rlm_cause;
Harald Welte4b634542008-12-27 01:55:51 +00001582
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001583 rsl_tlv_parse(&tp, rllh->data, msgb_l2len(msg) - sizeof(*rllh));
1584 if (!TLVP_PRESENT(&tp, RSL_IE_RLM_CAUSE)) {
1585 LOGP(DRLL, LOGL_ERROR,
1586 "%s ERROR INDICATION without mandantory cause.\n",
1587 gsm_lchan_name(msg->lchan));
1588 return -1;
1589 }
1590
1591 rlm_cause = *TLVP_VAL(&tp, RSL_IE_RLM_CAUSE);
Holger Hans Peter Freyther1e93b792014-04-19 16:45:36 +02001592 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s in state=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001593 gsm_lchan_name(msg->lchan),
Holger Hans Peter Freyther1e93b792014-04-19 16:45:36 +02001594 rsl_rlm_cause_name(rlm_cause),
1595 gsm_lchans_name(msg->lchan->state));
1596
Harald Welteedcc5272009-08-09 13:47:35 +02001597 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001598
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001599 if (rlm_cause == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001600 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther0e4e73a2014-04-19 17:38:33 +02001601 return rsl_rf_chan_release_err(msg->lchan);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001602 }
Harald Welte81543bc2009-07-04 09:40:05 +02001603
Harald Welte4b634542008-12-27 01:55:51 +00001604 return 0;
1605}
Harald Weltef325eb42009-02-19 17:07:39 +00001606
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001607static void rsl_handle_release(struct gsm_lchan *lchan)
1608{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001609 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001610 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001611
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +01001612 /*
1613 * Maybe only one link/SAPI was releasd or the error handling
1614 * was activated. Just return now and let the other code handle
1615 * it.
1616 */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001617 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001618 return;
1619
1620 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1621 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1622 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001623 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001624 gsm_lchan_name(lchan), sapi);
1625 return;
1626 }
1627
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001628
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001629 /* Stop T3109 and wait for T3111 before re-using the channel */
1630 osmo_timer_del(&lchan->T3109);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001631 lchan->T3111.cb = t3111_expired;
1632 lchan->T3111.data = lchan;
1633 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001634 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001635}
1636
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001637/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001638 0x02, 0x06,
1639 0x01, 0x20,
1640 0x02, 0x00,
1641 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1642
1643static int abis_rsl_rx_rll(struct msgb *msg)
1644{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001645 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001646 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001647 int rc = 0;
1648 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001649 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001650
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001651 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001652 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001653 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001654
1655 switch (rllh->c.msg_type) {
1656 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001657 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001658 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001659 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1660 rllh->data[0] == RSL_IE_L3_INFO) {
1661 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001662 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001663 }
Harald Welte52b1f982008-12-23 20:25:15 +00001664 break;
1665 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001666 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001667 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001668 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001669 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001670 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001671 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1672 rllh->data[0] == RSL_IE_L3_INFO) {
1673 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001674 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001675 }
Harald Welte52b1f982008-12-23 20:25:15 +00001676 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001677 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001678 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001679 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001680 rll_indication(msg->lchan, rllh->link_id,
1681 BSC_RLLR_IND_EST_CONF);
1682 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001683 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001684 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001685 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001686 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001687 rll_indication(msg->lchan, rllh->link_id,
1688 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001689 rsl_handle_release(msg->lchan);
Harald Welte2d5b6382008-12-27 19:46:06 +00001690 break;
1691 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001692 /* BTS informs us of having received UA from MS,
1693 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001694 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001695 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001696 rsl_handle_release(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +00001697 break;
1698 case RSL_MT_ERROR_IND:
1699 rc = rsl_rx_rll_err_ind(msg);
1700 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001701 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001702 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1703 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001704 break;
1705 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001706 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1707 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001708 }
Harald Welte8470bf22008-12-25 23:28:35 +00001709 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001710}
1711
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001712static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001713{
Harald Welte0603c9d2009-12-02 01:58:23 +05301714 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001715 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301716 switch (lchan->type) {
1717 case GSM_LCHAN_TCH_F:
1718 return 0x00;
1719 case GSM_LCHAN_TCH_H:
1720 return 0x03;
1721 default:
1722 break;
1723 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001724 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001725 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301726 switch (lchan->type) {
1727 case GSM_LCHAN_TCH_F:
1728 return 0x01;
1729 /* there's no half-rate EFR */
1730 default:
1731 break;
1732 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001733 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001734 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301735 switch (lchan->type) {
1736 case GSM_LCHAN_TCH_F:
1737 return 0x02;
1738 case GSM_LCHAN_TCH_H:
1739 return 0x05;
1740 default:
1741 break;
1742 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001743 break;
Harald Welte0603c9d2009-12-02 01:58:23 +05301744 default:
1745 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001746 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001747 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301748 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001749 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001750}
1751
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001752static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001753{
1754 switch (lchan->tch_mode) {
1755 case GSM48_CMODE_SPEECH_V1:
1756 switch (lchan->type) {
1757 case GSM_LCHAN_TCH_F:
1758 return RTP_PT_GSM_FULL;
1759 case GSM_LCHAN_TCH_H:
1760 return RTP_PT_GSM_HALF;
1761 default:
1762 break;
1763 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001764 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001765 case GSM48_CMODE_SPEECH_EFR:
1766 switch (lchan->type) {
1767 case GSM_LCHAN_TCH_F:
1768 return RTP_PT_GSM_EFR;
1769 /* there's no half-rate EFR */
1770 default:
1771 break;
1772 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001773 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001774 case GSM48_CMODE_SPEECH_AMR:
1775 switch (lchan->type) {
1776 case GSM_LCHAN_TCH_F:
Sylvain Munautb54dda42009-12-20 22:06:40 +01001777 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freythered999b22011-07-21 10:24:46 +02001778 return RTP_PT_AMR;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001779 default:
1780 break;
1781 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001782 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001783 default:
1784 break;
1785 }
1786 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1787 "tch_mode == 0x%02x\n & lchan_type == %d",
1788 lchan->tch_mode, lchan->type);
1789 return 0;
1790}
1791
Harald Welte75099262009-02-16 21:12:08 +00001792/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001793static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1794{
1795 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001796 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001797
1798 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Daniel Willmann8a485f02014-06-27 17:05:47 +02001799 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_LOCAL_IP);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001800 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1801 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1802 }
1803
1804 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Daniel Willmann8a485f02014-06-27 17:05:47 +02001805 port = tlvp_val16_unal(tv, RSL_IE_IPAC_LOCAL_PORT);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001806 port = ntohs(port);
1807 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1808 lchan->abis_ip.bound_port = port;
1809 }
1810
1811 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Daniel Willmann8a485f02014-06-27 17:05:47 +02001812 conn_id = tlvp_val16_unal(tv, RSL_IE_IPAC_CONN_ID);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001813 conn_id = ntohs(conn_id);
1814 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1815 lchan->abis_ip.conn_id = conn_id;
1816 }
1817
1818 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1819 lchan->abis_ip.rtp_payload2 =
1820 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1821 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1822 lchan->abis_ip.rtp_payload2);
1823 }
1824
1825 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1826 lchan->abis_ip.speech_mode =
1827 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1828 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1829 lchan->abis_ip.speech_mode);
1830 }
1831
1832 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Daniel Willmann8a485f02014-06-27 17:05:47 +02001833 ip.s_addr = tlvp_val32_unal(tv, RSL_IE_IPAC_REMOTE_IP);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001834 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1835 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1836 }
1837
1838 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Daniel Willmann8a485f02014-06-27 17:05:47 +02001839 port = tlvp_val16_unal(tv, RSL_IE_IPAC_REMOTE_PORT);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001840 port = ntohs(port);
1841 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1842 lchan->abis_ip.connect_port = port;
1843 }
1844}
1845
Harald Welte647db842013-02-03 12:06:58 +01001846/*! \brief Issue IPA RSL CRCX to configure RTP on BTS side
1847 * \param[in] lchan Logical Channel for which we issue CRCX
1848 */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001849int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001850{
1851 struct msgb *msg = rsl_msgb_alloc();
1852 struct abis_rsl_dchan_hdr *dh;
1853
1854 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001855 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001856 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001857 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001858
Harald Weltef4e79f22009-07-28 18:11:56 +02001859 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001860 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001861 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001862 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001863 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001864
Sylvain Munautb54dda42009-12-20 22:06:40 +01001865 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1866 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1867 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001868
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001869 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001870
1871 return abis_rsl_sendmsg(msg);
1872}
1873
Harald Welte647db842013-02-03 12:06:58 +01001874/*! \brief Issue IPA RSL MDCX to configure MGW-side of RTP
1875 * \param[in] lchan Logical Channel for which we issue MDCX
1876 * \param[in] ip Remote (MGW) IP address for RTP
1877 * \param[in] port Remote (MGW) UDP port number for RTP
1878 * \param[in] rtp_payload2 Contents of RTP PAYLOAD 2 IE
1879 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001880int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1881 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001882{
1883 struct msgb *msg = rsl_msgb_alloc();
1884 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001885 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001886 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001887
1888 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001889 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001890 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001891 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001892
Harald Welte5e3d91b2009-12-19 16:42:06 +01001893 /* we need to store these now as MDCX_ACK does not return them :( */
1894 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1895 lchan->abis_ip.connect_port = port;
1896 lchan->abis_ip.connect_ip = ip;
1897
Harald Welte58ca5b72009-07-29 12:12:18 +02001898 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001899 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001900 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001901
Harald Weltef4e79f22009-07-28 18:11:56 +02001902 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001903 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1904 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1905 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1906 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001907
Harald Welte5e3d91b2009-12-19 16:42:06 +01001908 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1909 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001910 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001911 *att_ip = ia.s_addr;
1912 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1913 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001914 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001915 if (rtp_payload2)
1916 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001917
1918 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001919
1920 return abis_rsl_sendmsg(msg);
1921}
1922
Harald Weltea72273e2009-12-20 16:51:09 +01001923/* tell BTS to connect RTP stream to our local RTP socket */
1924int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1925{
1926 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1927 int rc;
1928
1929 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1930 ntohs(rs->rtp.sin_local.sin_port),
1931 /* FIXME: use RTP payload of bound socket, not BTS*/
1932 lchan->abis_ip.rtp_payload2);
1933
1934 return rc;
1935}
1936
Harald Welte53cd7ac2010-12-23 12:59:52 +01001937int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001938{
1939 struct msgb *msg = rsl_msgb_alloc();
1940 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001941 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001942
1943 if (act)
1944 msg_type = RSL_MT_IPAC_PDCH_ACT;
1945 else
1946 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001947
1948 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001949 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001950 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001951 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001952
Harald Welte53cd7ac2010-12-23 12:59:52 +01001953 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001954 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001955
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001956 msg->dst = ts->trx->rsl_link;
Harald Welte9c880c92009-10-24 10:29:22 +02001957
1958 return abis_rsl_sendmsg(msg);
1959}
1960
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001961static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001962{
1963 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1964 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301965 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001966
1967 /* the BTS has acknowledged a local bind, it now tells us the IP
1968 * address and port number to which it has bound the given logical
1969 * channel */
1970
1971 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1972 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1973 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001974 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001975 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001976 return -EINVAL;
1977 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001978
Harald Welte5e3d91b2009-12-19 16:42:06 +01001979 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001980
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001981 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001982
Harald Welte75099262009-02-16 21:12:08 +00001983 return 0;
1984}
1985
Harald Welte5e3d91b2009-12-19 16:42:06 +01001986static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1987{
1988 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1989 struct tlv_parsed tv;
1990 struct gsm_lchan *lchan = msg->lchan;
1991
1992 /* the BTS has acknowledged a remote connect request and
1993 * it now tells us the IP address and port number to which it has
1994 * connected the given logical channel */
1995
1996 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1997 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001998 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001999
2000 return 0;
2001}
2002
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002003static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00002004{
2005 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
2006 struct tlv_parsed tv;
2007
2008 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00002009
Harald Welte8830e072009-07-28 17:58:09 +02002010 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01002011 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02002012 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00002013
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02002014 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02002015
Harald Welte75099262009-02-16 21:12:08 +00002016 return 0;
2017}
2018
2019static int abis_rsl_rx_ipacc(struct msgb *msg)
2020{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002021 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte75099262009-02-16 21:12:08 +00002022 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01002023 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00002024 int rc = 0;
2025
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002026 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01002027 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00002028
2029 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002030 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01002031 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002032 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00002033 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002034 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00002035 /* somehow the BTS was unable to bind the lchan to its local
2036 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01002037 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00002038 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002039 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00002040 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01002041 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01002042 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00002043 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002044 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00002045 /* somehow the BTS was unable to connect the lchan to a remote
2046 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01002047 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00002048 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002049 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01002050 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002051 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00002052 break;
2053 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01002054 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002055 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00002056 break;
2057 }
Harald Welte6dab0552009-05-01 17:21:37 +00002058 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00002059
2060 return rc;
2061}
2062
2063
Harald Welte52b1f982008-12-23 20:25:15 +00002064/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00002065int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00002066{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002067 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00002068 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00002069
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002070 if (!msg) {
2071 DEBUGP(DRSL, "Empty RSL msg?..\n");
2072 return -1;
2073 }
2074
2075 if (msgb_l2len(msg) < sizeof(*rslh)) {
2076 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
Harald Weltef25b55e2012-05-31 20:22:34 +02002077 msgb_free(msg);
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002078 return -1;
2079 }
2080
2081 rslh = msgb_l2(msg);
2082
Harald Welte52b1f982008-12-23 20:25:15 +00002083 switch (rslh->msg_discr & 0xfe) {
2084 case ABIS_RSL_MDISC_RLL:
2085 rc = abis_rsl_rx_rll(msg);
2086 break;
2087 case ABIS_RSL_MDISC_DED_CHAN:
2088 rc = abis_rsl_rx_dchan(msg);
2089 break;
2090 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00002091 rc = abis_rsl_rx_cchan(msg);
2092 break;
Harald Welte8470bf22008-12-25 23:28:35 +00002093 case ABIS_RSL_MDISC_TRX:
2094 rc = abis_rsl_rx_trx(msg);
2095 break;
Harald Welte52b1f982008-12-23 20:25:15 +00002096 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002097 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00002098 rslh->msg_discr);
2099 break;
Harald Welte75099262009-02-16 21:12:08 +00002100 case ABIS_RSL_MDISC_IPACCESS:
2101 rc = abis_rsl_rx_ipacc(msg);
2102 break;
Harald Welte52b1f982008-12-23 20:25:15 +00002103 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002104 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
2105 "0x%02x\n", rslh->msg_discr);
Harald Weltef25b55e2012-05-31 20:22:34 +02002106 rc = -EINVAL;
Harald Welte52b1f982008-12-23 20:25:15 +00002107 }
Harald Welte4f4a3902008-12-26 00:04:49 +00002108 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00002109 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00002110}
Holger Freyther3b72a892009-02-04 00:31:39 +00002111
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002112int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
Harald Welte30f1f372014-12-28 15:00:45 +01002113 struct rsl_ie_cb_cmd_type cb_command,
2114 const uint8_t *data, int len)
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002115{
2116 struct abis_rsl_dchan_hdr *dh;
2117 struct msgb *cb_cmd;
2118
2119 cb_cmd = rsl_msgb_alloc();
2120 if (!cb_cmd)
2121 return -1;
2122
Harald Welte30f1f372014-12-28 15:00:45 +01002123 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof(*dh));
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002124 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
Harald Welte30f1f372014-12-28 15:00:45 +01002125 dh->c.msg_discr = ABIS_RSL_MDISC_COM_CHAN;
2126 dh->chan_nr = chan_number; /* TODO: check the chan config */
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002127
Harald Welte30f1f372014-12-28 15:00:45 +01002128 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, *(uint8_t*)&cb_command);
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002129 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
2130
Harald Welte30f1f372014-12-28 15:00:45 +01002131 cb_cmd->dst = bts->c0->rsl_link;
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002132
2133 return abis_rsl_sendmsg(cb_cmd);
2134}
Dieter Spaar16646022011-07-28 00:01:50 +02002135
2136int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
2137{
2138 struct abis_rsl_common_hdr *ch;
2139 struct msgb *msg = rsl_msgb_alloc();
2140
2141 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2142 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2143 ch->msg_type = 0x40; /* Nokia SI Begin */
2144
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002145 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002146
2147 return abis_rsl_sendmsg(msg);
2148}
2149
2150int rsl_nokia_si_end(struct gsm_bts_trx *trx)
2151{
2152 struct abis_rsl_common_hdr *ch;
2153 struct msgb *msg = rsl_msgb_alloc();
2154
2155 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2156 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2157 ch->msg_type = 0x41; /* Nokia SI End */
2158
2159 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
2160
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002161 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002162
2163 return abis_rsl_sendmsg(msg);
2164}
2165
2166int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
2167{
2168 struct abis_rsl_common_hdr *ch;
2169 struct msgb *msg = rsl_msgb_alloc();
2170
2171 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2172 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
2173 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
2174
2175 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
2176 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
2177
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002178 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002179
2180 return abis_rsl_sendmsg(msg);
2181}
Holger Hans Peter Freyther85825352011-12-27 22:24:17 +01002182
2183/**
2184 * Release all allocated SAPIs starting from @param start and
2185 * release them with the given release mode. Once the release
2186 * confirmation arrives it will be attempted to release the
2187 * the RF channel.
2188 */
2189int rsl_release_sapis_from(struct gsm_lchan *lchan, int start,
2190 enum rsl_rel_mode release_mode)
2191{
2192 int no_sapi = 1;
2193 int sapi;
2194
2195 for (sapi = start; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
2196 uint8_t link_id;
2197 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
2198 continue;
2199
2200 link_id = sapi;
2201 if (lchan->type == GSM_LCHAN_TCH_F || lchan->type == GSM_LCHAN_TCH_H)
2202 link_id |= 0x40;
2203 rsl_release_request(lchan, link_id, release_mode);
2204 no_sapi = 0;
2205 }
2206
2207 return no_sapi;
2208}
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01002209
2210int rsl_start_t3109(struct gsm_lchan *lchan)
2211{
2212 struct gsm_bts *bts = lchan->ts->trx->bts;
2213
2214 /* Disabled, mostly legacy code */
2215 if (bts->network->T3109 == 0)
2216 return -1;
2217
2218 lchan->T3109.cb = t3109_expired;
2219 lchan->T3109.data = lchan;
2220 osmo_timer_schedule(&lchan->T3109, bts->network->T3109, 0);
2221 return 0;
2222}
Holger Hans Peter Freyther006e3d82012-12-25 23:45:14 +01002223
2224/**
2225 * \brief directly RF Channel Release the lchan
2226 *
2227 * When no SAPI was allocated, directly release the logical channel. This
2228 * should only be called from chan_alloc.c on channel release handling. In
2229 * case no SAPI was established the RF Channel can be directly released,
2230 */
2231int rsl_direct_rf_release(struct gsm_lchan *lchan)
2232{
2233 int i;
2234 for (i = 0; i < ARRAY_SIZE(lchan->sapis); ++i) {
2235 if (lchan->sapis[i] != LCHAN_SAPI_UNUSED) {
2236 LOGP(DRSL, LOGL_ERROR, "%s SAPI(%d) still allocated.\n",
2237 gsm_lchan_name(lchan), i);
2238 return -1;
2239 }
2240 }
2241
2242 /* Now release it */
2243 return rsl_rf_chan_release(lchan, 0, SACCH_NONE);
2244}