blob: 5d407948c2748e10932dd873c099408bc5f161bb [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);
55
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010056static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
57 struct gsm_meas_rep *resp)
58{
59 struct lchan_signal_data sig;
60 sig.lchan = lchan;
61 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020062 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010063}
64
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +010065static void do_lchan_free(struct gsm_lchan *lchan)
66{
67 /* we have an error timer pending to release that */
68 if (lchan->state != LCHAN_S_REL_ERR)
69 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
70 lchan_free(lchan);
71}
72
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020073static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000074{
75 /* mask off the transparent bit ? */
76 msg_type &= 0xfe;
77
Harald Welte8470bf22008-12-25 23:28:35 +000078 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000079 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000080 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000081 if (msg_type >= 0x19 && msg_type <= 0x22)
82 return ABIS_RSL_MDISC_TRX;
83 else
84 return ABIS_RSL_MDISC_COM_CHAN;
85 }
Harald Welte2d5b6382008-12-27 19:46:06 +000086 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000087 return ABIS_RSL_MDISC_DED_CHAN;
88
89 return ABIS_RSL_MDISC_LOC;
90}
91
92static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020093 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000094{
95 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
96 dh->c.msg_type = msg_type;
97 dh->ie_chan = RSL_IE_CHAN_NR;
98}
99
Harald Welte8470bf22008-12-25 23:28:35 +0000100/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200101struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +0000102{
103 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200104 uint8_t ts_nr = chan_nr & 0x07;
105 uint8_t cbits = chan_nr >> 3;
106 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +0000107 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
108
109 if (cbits == 0x01) {
110 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +0200111 if (ts->pchan != GSM_PCHAN_TCH_F &&
112 ts->pchan != GSM_PCHAN_PDCH &&
113 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100114 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000115 chan_nr, ts->pchan);
116 } else if ((cbits & 0x1e) == 0x02) {
117 lch_idx = cbits & 0x1; /* TCH/H */
118 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100119 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000120 chan_nr, ts->pchan);
121 } else if ((cbits & 0x1c) == 0x04) {
122 lch_idx = cbits & 0x3; /* SDCCH/4 */
123 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100124 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000125 chan_nr, ts->pchan);
126 } else if ((cbits & 0x18) == 0x08) {
127 lch_idx = cbits & 0x7; /* SDCCH/8 */
128 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100129 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000130 chan_nr, ts->pchan);
131 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
132 lch_idx = 0;
133 if (ts->pchan != GSM_PCHAN_CCCH &&
134 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100135 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000136 chan_nr, ts->pchan);
137 /* FIXME: we should not return first sdcch4 !!! */
138 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100139 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000140 return NULL;
141 }
142
143 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800144 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800145 if (lchan->conn)
146 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000147
148 return lchan;
149}
150
Harald Welte52b1f982008-12-23 20:25:15 +0000151/* 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 +0200152uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000153{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200154 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000155
156 ret = strtoull(imsi_str, NULL, 10);
157
158 return ret;
159}
160
Harald Welte8470bf22008-12-25 23:28:35 +0000161static struct msgb *rsl_msgb_alloc(void)
162{
Harald Welte966636f2009-06-26 19:39:35 +0200163 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
164 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000165}
166
Harald Welte362322e2009-02-15 14:36:38 +0000167#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200168static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000169{
170 memcpy(out, in, len);
171
172 if (len < MACBLOCK_SIZE)
173 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
174}
175
Harald Welte08d91a52009-08-30 15:37:11 +0900176/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200177static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900178{
179 *out++ = lchan->encr.alg_id & 0xff;
180 if (lchan->encr.key_len)
181 memcpy(out, lchan->encr.key, lchan->encr.key_len);
182 return lchan->encr.key_len + 1;
183}
184
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200185static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200186{
Harald Welte7f93cea2009-02-23 00:02:59 +0000187 int i;
188
Harald Welte5b8ed432009-12-24 12:20:20 +0100189 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200190 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200191 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100192 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000193}
194
Harald Weltee8bd9e82011-08-10 23:26:33 +0200195static void lchan_act_tmr_cb(void *data)
196{
197 struct gsm_lchan *lchan = data;
198
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200199 LOGP(DRSL, LOGL_ERROR,
200 "%s Timeout during activation. Marked as broken.\n",
Harald Weltee8bd9e82011-08-10 23:26:33 +0200201 gsm_lchan_name(lchan));
202
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200203 rsl_lchan_set_state(lchan, LCHAN_S_BROKEN);
Daniel Willmann513da172011-08-11 04:44:12 +0200204 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200205}
206
207static void lchan_deact_tmr_cb(void *data)
208{
209 struct gsm_lchan *lchan = data;
210
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200211 LOGP(DRSL, LOGL_ERROR,
212 "%s Timeout during deactivation! Marked as broken.\n",
Harald Weltee8bd9e82011-08-10 23:26:33 +0200213 gsm_lchan_name(lchan));
214
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200215 rsl_lchan_set_state(lchan, LCHAN_S_BROKEN);
216 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200217}
218
219
Harald Welte52b1f982008-12-23 20:25:15 +0000220/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200221int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
222 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000223{
224 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000225 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000226
227 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
228 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
229 dh->chan_nr = RSL_CHAN_BCCH;
230
231 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
232 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
233
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200234 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000235
236 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000237}
238
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200239int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
240 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000241{
242 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000243 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000244
245 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
246 ch->msg_discr = ABIS_RSL_MDISC_TRX;
247 ch->msg_type = RSL_MT_SACCH_FILL;
248
249 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000250 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000251
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200252 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000253
254 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000255}
256
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200257int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
258 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100259{
260 struct abis_rsl_dchan_hdr *dh;
261 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200262 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100263
264 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
265 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
266 dh->chan_nr = chan_nr;
267
268 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
269 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
270
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200271 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte7a69cf02011-01-13 23:16:03 +0100272
273 return abis_rsl_sendmsg(msg);
274}
275
Harald Weltefcd24452009-06-20 18:15:19 +0200276int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
277{
278 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200279 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200280 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200281
282 db = abs(db);
283 if (db > 30)
284 return -EINVAL;
285
Harald Welteeab33352009-06-27 03:09:08 +0200286 msg = rsl_msgb_alloc();
287
Harald Weltefcd24452009-06-20 18:15:19 +0200288 lchan->bs_power = db/2;
289 if (fpc)
290 lchan->bs_power |= 0x10;
291
292 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
293 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
294 dh->chan_nr = chan_nr;
295
296 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
297
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200298 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200299
300 return abis_rsl_sendmsg(msg);
301}
302
Harald Weltefcd24452009-06-20 18:15:19 +0200303int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
304{
305 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200306 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200307 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200308 int ctl_lvl;
309
Harald Welte66b6a8d2009-08-09 14:45:18 +0200310 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200311 if (ctl_lvl < 0)
312 return ctl_lvl;
313
Harald Welteeab33352009-06-27 03:09:08 +0200314 msg = rsl_msgb_alloc();
315
Harald Weltefcd24452009-06-20 18:15:19 +0200316 lchan->ms_power = ctl_lvl;
317
318 if (fpc)
319 lchan->ms_power |= 0x20;
320
321 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
322 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
323 dh->chan_nr = chan_nr;
324
325 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
326
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200327 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200328
329 return abis_rsl_sendmsg(msg);
330}
331
Harald Welte9943c5b2009-07-29 15:41:29 +0200332static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
333 struct gsm_lchan *lchan)
334{
Holger Hans Peter Freythere1145cf2013-03-09 17:50:10 +0100335 memset(cm, 0, sizeof(*cm));
Harald Welte9943c5b2009-07-29 15:41:29 +0200336
337 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800338 if (lchan->ts->trx->bts->network->dtx_enabled)
339 cm->dtx_dtu = 0x03;
340 else
341 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200342
343 /* set TCH Speech/Data */
344 cm->spd_ind = lchan->rsl_cmode;
345
Harald Welte1a79d362009-11-27 08:55:16 +0100346 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
347 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100348 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100349 "but tch_mode != signalling\n");
350
Harald Welte9943c5b2009-07-29 15:41:29 +0200351 switch (lchan->type) {
352 case GSM_LCHAN_SDCCH:
353 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
354 break;
355 case GSM_LCHAN_TCH_F:
356 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
357 break;
358 case GSM_LCHAN_TCH_H:
359 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
360 break;
361 case GSM_LCHAN_NONE:
362 case GSM_LCHAN_UNKNOWN:
363 default:
364 return -EINVAL;
365 }
366
367 switch (lchan->tch_mode) {
368 case GSM48_CMODE_SIGN:
369 cm->chan_rate = 0;
370 break;
371 case GSM48_CMODE_SPEECH_V1:
372 cm->chan_rate = RSL_CMOD_SP_GSM1;
373 break;
374 case GSM48_CMODE_SPEECH_EFR:
375 cm->chan_rate = RSL_CMOD_SP_GSM2;
376 break;
377 case GSM48_CMODE_SPEECH_AMR:
378 cm->chan_rate = RSL_CMOD_SP_GSM3;
379 break;
380 case GSM48_CMODE_DATA_14k5:
Harald Welte9943c5b2009-07-29 15:41:29 +0200381 case GSM48_CMODE_DATA_12k0:
Harald Welte9943c5b2009-07-29 15:41:29 +0200382 case GSM48_CMODE_DATA_6k0:
Harald Weltee4227982012-08-24 15:33:56 +0200383 switch (lchan->csd_mode) {
384 case LCHAN_CSD_M_NT:
385 /* non-transparent CSD with RLP */
386 switch (lchan->tch_mode) {
387 case GSM48_CMODE_DATA_14k5:
388 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
389 break;
390 case GSM48_CMODE_DATA_12k0:
391 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
392 break;
393 case GSM48_CMODE_DATA_6k0:
394 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
395 break;
396 default:
397 return -EINVAL;
398 }
399 break;
400 /* transparent data services below */
401 case LCHAN_CSD_M_T_1200_75:
402 cm->chan_rate = RSL_CMOD_CSD_T_1200_75;
403 break;
404 case LCHAN_CSD_M_T_600:
405 cm->chan_rate = RSL_CMOD_CSD_T_600;
406 break;
407 case LCHAN_CSD_M_T_1200:
408 cm->chan_rate = RSL_CMOD_CSD_T_1200;
409 break;
410 case LCHAN_CSD_M_T_2400:
411 cm->chan_rate = RSL_CMOD_CSD_T_2400;
412 break;
413 case LCHAN_CSD_M_T_9600:
414 cm->chan_rate = RSL_CMOD_CSD_T_9600;
415 break;
416 case LCHAN_CSD_M_T_14400:
417 cm->chan_rate = RSL_CMOD_CSD_T_14400;
418 break;
419 case LCHAN_CSD_M_T_29000:
420 cm->chan_rate = RSL_CMOD_CSD_T_29000;
421 break;
422 case LCHAN_CSD_M_T_32000:
423 cm->chan_rate = RSL_CMOD_CSD_T_32000;
424 break;
425 default:
426 return -EINVAL;
427 }
Harald Welte9943c5b2009-07-29 15:41:29 +0200428 default:
429 return -EINVAL;
430 }
431
432 return 0;
433}
434
Harald Welte52b1f982008-12-23 20:25:15 +0000435/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000436#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200437int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
438 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000439 struct rsl_ie_chan_mode *chan_mode,
440 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200441 uint8_t bs_power, uint8_t ms_power,
442 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000443{
444 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000445 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000446
447 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
448 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
449 dh->chan_nr = chan_nr;
450
451 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
452 /* For compatibility with Phase 1 */
453 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200454 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000455 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200456 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000457#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000458 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200459 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000460#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000461 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000462 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
463 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
464
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200465 msg->dst = trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000466
Harald Welte8470bf22008-12-25 23:28:35 +0000467 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000468}
Harald Welteddab3c72009-02-28 13:19:15 +0000469#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000470
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200471int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
472 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000473{
474 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200475 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200476 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200477 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000478
Harald Weltef6093a42011-06-25 10:02:33 +0200479 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000480 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200481 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000482
Harald Welte9943c5b2009-07-29 15:41:29 +0200483 rc = channel_mode_from_lchan(&cm, lchan);
484 if (rc < 0)
485 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000486
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800487 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200488 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000489
Harald Welteeab33352009-06-27 03:09:08 +0200490 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000491 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
492 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
493 dh->chan_nr = chan_nr;
494
495 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000496 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200497 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800498
499 /*
500 * The Channel Identification is needed for Phase1 phones
501 * and it contains the GSM48 Channel Description and the
502 * Mobile Allocation. The GSM 08.58 asks for the Mobile
503 * Allocation to have a length of zero. We are using the
504 * msgb_l3len to calculate the length of both messages.
505 */
laforge694a5cf2010-06-20 21:38:19 +0200506 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200507 len = msgb_put(msg, 1);
Dieter Spaareabb6e32011-07-27 23:40:33 +0200508 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800509
510 if (lchan->ts->hopping.enabled)
511 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
512 lchan->ts->hopping.ma_data);
513 else
514 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800515
516 /* update the calculated size */
517 msg->l3h = len + 1;
518 *len = msgb_l3len(msg);
519
Harald Welte08d91a52009-08-30 15:37:11 +0900520 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200521 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900522 rc = build_encr_info(encr_info, lchan);
523 if (rc > 0)
524 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
525 }
526
Harald Welte8d77b952009-12-17 00:31:10 +0100527 switch (act_type) {
528 case RSL_ACT_INTER_ASYNC:
529 case RSL_ACT_INTER_SYNC:
530 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
531 break;
532 default:
533 break;
534 }
535
Harald Welted4c9bf32009-02-15 16:56:18 +0000536 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
537 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000538 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
539
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100540 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
541 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200542 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100543
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200544 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000545
Harald Welte4b634542008-12-27 01:55:51 +0000546 return abis_rsl_sendmsg(msg);
547}
548
Harald Welte470abb72009-07-29 11:38:15 +0200549/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000550int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
551{
552 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200553 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200554 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000555
Harald Weltef6093a42011-06-25 10:02:33 +0200556 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000557 struct rsl_ie_chan_mode cm;
558
Harald Welte9943c5b2009-07-29 15:41:29 +0200559 rc = channel_mode_from_lchan(&cm, lchan);
560 if (rc < 0)
561 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000562
Harald Welteeab33352009-06-27 03:09:08 +0200563 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000564 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
565 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
566 dh->chan_nr = chan_nr;
567
568 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200569 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900570
571 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200572 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900573 rc = build_encr_info(encr_info, lchan);
574 if (rc > 0)
575 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
576 }
577
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100578 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
579 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200580 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100581 }
582
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200583 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte08d91a52009-08-30 15:37:11 +0900584
585 return abis_rsl_sendmsg(msg);
586}
587
588/* Chapter 8.4.6: Send the encryption command with given L3 info */
589int rsl_encryption_cmd(struct msgb *msg)
590{
591 struct abis_rsl_dchan_hdr *dh;
592 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200593 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200594 uint8_t encr_info[MAX_A5_KEY_LEN+2];
595 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900596 int rc;
597
598 /* First push the L3 IE tag and length */
599 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
600
601 /* then the link identifier (SAPI0, main sign link) */
602 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
603
604 /* then encryption information */
605 rc = build_encr_info(encr_info, lchan);
606 if (rc <= 0)
607 return rc;
608 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
609
610 /* and finally the DCHAN header */
611 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
612 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
613 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000614
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200615 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteda783762009-02-18 03:29:53 +0000616
617 return abis_rsl_sendmsg(msg);
618}
619
Harald Welte115d1032009-08-10 11:43:22 +0200620/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200621int rsl_deact_sacch(struct gsm_lchan *lchan)
622{
623 struct abis_rsl_dchan_hdr *dh;
624 struct msgb *msg = rsl_msgb_alloc();
625
626 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
627 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200628 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200629
630 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200631 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteae0f2362009-07-19 18:36:49 +0200632
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100633 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200634
635 return abis_rsl_sendmsg(msg);
636}
637
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800638static void error_timeout_cb(void *data)
639{
640 struct gsm_lchan *lchan = data;
641 if (lchan->state != LCHAN_S_REL_ERR) {
642 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
643 gsm_lchan_name(lchan), lchan->state);
644 return;
645 }
646
647 /* go back to the none state */
648 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800649 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800650}
651
Harald Weltefd355a32011-03-04 13:41:31 +0100652static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
653
Harald Welte115d1032009-08-10 11:43:22 +0200654/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100655static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error,
656 enum sacch_deact deact_sacch)
Harald Welte52b1f982008-12-23 20:25:15 +0000657{
658 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800659 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100660 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000661
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100662 /* Stop timers that should lead to a channel release */
663 osmo_timer_del(&lchan->T3109);
664
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800665 if (lchan->state == LCHAN_S_REL_ERR) {
666 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
667 gsm_lchan_name(lchan));
668 return -1;
669 }
670
671 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000672 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
673 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200674 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000675
Harald Welte8470bf22008-12-25 23:28:35 +0000676 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200677 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000678
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800679 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
680
681 if (error) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200682 struct e1inp_sign_link *sign_link = msg->dst;
683
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +0100684 /*
685 * FIXME: GSM 04.08 gives us two options for the abnormal
686 * chanel release. This can be either like in the non-existent
687 * sub-lcuase 3.5.1 or for the main signalling link deactivate
688 * the SACCH, start timer T3109 and consider the channel as
689 * released.
690 *
691 * This code is doing the later for all raido links and not
692 * only the main link. Right now all SAPIs are released on the
693 * local end, the SACCH will be de-activated and right now the
694 * T3111 will be started. First T3109 should be started and then
695 * the T3111.
696 *
697 * TODO: Move this out of the function.
698 */
699
700 /*
701 * sacch de-activate and "local end release"
702 */
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100703 if (deact_sacch == SACCH_DEACTIVATE)
704 rsl_deact_sacch(lchan);
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +0100705 rsl_release_sapis_from(lchan, 0, RSL_REL_LOCAL_END);
706
707 /*
708 * TODO: start T3109 now.
709 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800710 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800711 lchan->error_timer.data = lchan;
712 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200713 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200714 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800715 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000716
Harald Weltee8bd9e82011-08-10 23:26:33 +0200717 /* Start another timer or assume the BTS sends a ACK/NACK? */
718 lchan->act_timer.cb = lchan_deact_tmr_cb;
719 lchan->act_timer.data = lchan;
720 osmo_timer_schedule(&lchan->act_timer, 4, 0);
721
Harald Weltefd355a32011-03-04 13:41:31 +0100722 rc = abis_rsl_sendmsg(msg);
723
Harald Welte115d1032009-08-10 11:43:22 +0200724 /* BTS will respond by RF CHAN REL ACK */
Harald Weltefd355a32011-03-04 13:41:31 +0100725 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000726}
727
Harald Welte64bb7542011-01-14 14:16:16 +0100728static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
729{
730
731 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
732
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100733 /* Stop all pending timers */
Harald Weltee8bd9e82011-08-10 23:26:33 +0200734 osmo_timer_del(&lchan->act_timer);
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100735 osmo_timer_del(&lchan->T3111);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200736
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200737 if (lchan->state == LCHAN_S_BROKEN) {
738 /* we are leaving this channel broken for now */
739 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK for broken channel.\n",
740 gsm_lchan_name(lchan));
741 return 0;
742 }
743
Harald Welte64bb7542011-01-14 14:16:16 +0100744 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
745 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
746 gsm_lchan_name(lchan),
747 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther93599a22012-12-06 19:09:58 +0100748 do_lchan_free(lchan);
Harald Welte64bb7542011-01-14 14:16:16 +0100749
750 return 0;
751}
752
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200753int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
754 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000755{
756 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000757 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000758
759 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
760 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
761 dh->chan_nr = RSL_CHAN_PCH_AGCH;
762
763 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000764 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000765 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
766
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200767 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000768
769 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000770}
771
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200772int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000773{
774 int i, len = strlen(str_in);
775
776 for (i = 0; i < len; i++) {
777 int num = str_in[i] - 0x30;
778 if (num < 0 || num > 9)
779 return -1;
780 if (i % 2 == 0)
781 bcd_out[i/2] = num;
782 else
783 bcd_out[i/2] |= (num << 4);
784 }
785
786 return 0;
787}
788
Harald Welte702d8702008-12-26 20:25:35 +0000789/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200790int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000791{
Harald Welte8470bf22008-12-25 23:28:35 +0000792 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000793 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200794 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000795
796 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
797 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
798 dh->chan_nr = RSL_CHAN_PCH_AGCH;
799
Harald Welte362322e2009-02-15 14:36:38 +0000800 switch (bts->type) {
801 case GSM_BTS_TYPE_BS11:
802 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
803 break;
804 default:
805 /* If phase 2, construct a FULL_IMM_ASS_INFO */
806 pad_macblock(buf, val, len);
807 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
808 break;
809 }
Harald Welte52b1f982008-12-23 20:25:15 +0000810
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200811 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000812
813 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000814}
815
Harald Welte67fa91b2009-08-10 09:51:40 +0200816/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200817int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200818{
819 struct msgb *msg = rsl_msgb_alloc();
820 struct abis_rsl_dchan_hdr *dh;
821
822 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
823 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200824 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200825 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200826 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200827
Harald Welte5b8ed432009-12-24 12:20:20 +0100828 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200829 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200830
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200831 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte3c456d02009-08-10 11:26:14 +0200832
Harald Welte67fa91b2009-08-10 09:51:40 +0200833 return abis_rsl_sendmsg(msg);
834}
835
836
Harald Welte8470bf22008-12-25 23:28:35 +0000837/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000838/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200839int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000840{
Harald Welte8470bf22008-12-25 23:28:35 +0000841 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100842 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000843 return -EINVAL;
844 }
Harald Welte52b1f982008-12-23 20:25:15 +0000845
Harald Weltef6093a42011-06-25 10:02:33 +0200846 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100847 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000848
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200849 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000850
851 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000852}
853
Harald Welteedcc5272009-08-09 13:47:35 +0200854/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
855/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200856int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200857{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100858 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200859
Harald Weltef6093a42011-06-25 10:02:33 +0200860 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100861 link_id, 0);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200862 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteedcc5272009-08-09 13:47:35 +0200863
Harald Weltefda74ee2012-04-26 19:42:19 +0200864 DEBUGP(DRLL, "%s RSL RLL ESTABLISH REQ (link_id=0x%02x)\n",
865 gsm_lchan_name(lchan), link_id);
866
Harald Welteedcc5272009-08-09 13:47:35 +0200867 return abis_rsl_sendmsg(msg);
868}
869
Andreas Eversberg7d8fa342013-12-05 13:25:06 +0100870static void rsl_handle_release(struct gsm_lchan *lchan);
871
872/* Special work handler to handle missing RSL_MT_REL_CONF message from
873 * Nokia InSite BTS */
874static void lchan_rel_work_cb(void *data)
875{
876 struct gsm_lchan *lchan = data;
877 int sapi;
878
879 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
880 if (lchan->sapis[sapi] == LCHAN_SAPI_REL)
881 lchan->sapis[sapi] = LCHAN_SAPI_UNUSED;
882 }
883 rsl_handle_release(lchan);
884}
885
Harald Welted2dc1de2009-08-08 13:15:07 +0200886/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
887 This is what higher layers should call. The BTS then responds with
888 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
889 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
890 lchan_free() */
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100891int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id,
892 enum rsl_rel_mode release_mode)
Harald Welted2dc1de2009-08-08 13:15:07 +0200893{
Harald Welted2dc1de2009-08-08 13:15:07 +0200894
Harald Welte3c9c5f92010-03-04 10:33:10 +0100895 struct msgb *msg;
896
Harald Weltef6093a42011-06-25 10:02:33 +0200897 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100898 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800899 /* 0 is normal release, 1 is local end */
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100900 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, release_mode);
Harald Welted2dc1de2009-08-08 13:15:07 +0200901
Harald Welte8e93b792009-12-29 10:44:17 +0100902 /* FIXME: start some timer in case we don't receive a REL ACK ? */
903
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200904 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dc1de2009-08-08 13:15:07 +0200905
Harald Weltefda74ee2012-04-26 19:42:19 +0200906 DEBUGP(DRLL, "%s RSL RLL RELEASE REQ (link_id=0x%02x, reason=%u)\n",
Holger Hans Peter Freyther5ca825e2012-12-06 12:01:38 +0100907 gsm_lchan_name(lchan), link_id, release_mode);
Harald Weltefda74ee2012-04-26 19:42:19 +0200908
Andreas Eversberg7d8fa342013-12-05 13:25:06 +0100909 abis_rsl_sendmsg(msg);
910
911 /* Do not wait for Nokia BTS to send the confirm. */
912 if (is_nokia_bts(lchan->ts->trx->bts)
913 && lchan->ts->trx->bts->nokia.no_loc_rel_cnf
914 && release_mode == RSL_REL_LOCAL_END) {
915 DEBUGP(DRLL, "Scheduling release, becasuse Nokia InSite BTS does not send a RELease CONFirm.\n");
916 lchan->sapis[link_id & 0x7] = LCHAN_SAPI_REL;
917 lchan->rel_work.cb = lchan_rel_work_cb;
918 lchan->rel_work.data = lchan;
919 osmo_timer_schedule(&lchan->rel_work, 0, 0);
920 }
921
922 return 0;
Harald Welted2dc1de2009-08-08 13:15:07 +0200923}
924
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200925int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
926{
927 lchan->state = state;
928 return 0;
929}
930
Harald Welte702d8702008-12-26 20:25:35 +0000931/* Chapter 8.4.2: Channel Activate Acknowledge */
932static int rsl_rx_chan_act_ack(struct msgb *msg)
933{
934 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
935
936 /* BTS has confirmed channel activation, we now need
937 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000938 if (rslh->ie_chan != RSL_IE_CHAN_NR)
939 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100940
Harald Weltee8bd9e82011-08-10 23:26:33 +0200941 osmo_timer_del(&msg->lchan->act_timer);
942
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200943 if (msg->lchan->state == LCHAN_S_BROKEN) {
944 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK for broken channel.\n",
945 gsm_lchan_name(msg->lchan));
946 return 0;
947 }
948
Harald Welte8e93b792009-12-29 10:44:17 +0100949 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100950 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
951 gsm_lchan_name(msg->lchan),
952 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200953 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100954
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800955 if (msg->lchan->rqd_ref) {
956 rsl_send_imm_assignment(msg->lchan);
957 talloc_free(msg->lchan->rqd_ref);
958 msg->lchan->rqd_ref = NULL;
959 msg->lchan->rqd_ta = 0;
960 }
961
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100962 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100963
Harald Welte4b634542008-12-27 01:55:51 +0000964 return 0;
965}
Harald Welte702d8702008-12-26 20:25:35 +0000966
Harald Welte4b634542008-12-27 01:55:51 +0000967/* Chapter 8.4.3: Channel Activate NACK */
968static int rsl_rx_chan_act_nack(struct msgb *msg)
969{
Harald Welte6dab0552009-05-01 17:21:37 +0000970 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
971 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000972
Harald Weltee8bd9e82011-08-10 23:26:33 +0200973 osmo_timer_del(&msg->lchan->act_timer);
974
Holger Hans Peter Freyther21776242013-05-01 18:44:04 +0200975 if (msg->lchan->state == LCHAN_S_BROKEN) {
976 LOGP(DRSL, LOGL_ERROR,
977 "%s CHANNEL ACTIVATE NACK for broken channel.\n",
978 gsm_lchan_name(msg->lchan));
979 return -1;
980 }
981
Daniel Willmann6fc6a122011-08-11 04:54:23 +0200982 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100983 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100984
Harald Welte6dab0552009-05-01 17:21:37 +0000985 /* BTS has rejected channel activation ?!? */
986 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000987 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000988
989 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100990 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200991 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100992 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200993 TLVP_LEN(&tp, RSL_IE_CAUSE));
Holger Hans Peter Freyther638da512012-12-06 19:25:06 +0100994 msg->lchan->error_cause = *cause;
Harald Welte (local)3e460312009-12-27 18:12:29 +0100995 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther638da512012-12-06 19:25:06 +0100996 rsl_lchan_set_state(msg->lchan, LCHAN_S_BROKEN);
Daniel Willmann7ddc3182011-08-11 04:47:11 +0200997 else
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100998 rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Daniel Willmann7ddc3182011-08-11 04:47:11 +0200999
Harald Welte (local)3e460312009-12-27 18:12:29 +01001000 } else
Holger Hans Peter Freyther638da512012-12-06 19:25:06 +01001001 rsl_lchan_set_state(msg->lchan, LCHAN_S_BROKEN);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001002
Harald Welte (local)91b603d2009-12-27 11:48:11 +01001003 LOGPC(DRSL, LOGL_ERROR, "\n");
1004
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001005 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte4b634542008-12-27 01:55:51 +00001006 return 0;
Harald Welte702d8702008-12-26 20:25:35 +00001007}
1008
Harald Welte7f93cea2009-02-23 00:02:59 +00001009/* Chapter 8.4.4: Connection Failure Indication */
1010static int rsl_rx_conn_fail(struct msgb *msg)
1011{
1012 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1013 struct tlv_parsed tp;
1014
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001015 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +01001016 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001017 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +00001018
1019 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1020
Harald Welte8830e072009-07-28 17:58:09 +02001021 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001022 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001023 TLVP_LEN(&tp, RSL_IE_CAUSE));
1024
Harald Welte (local)fc057502009-12-26 22:33:09 +01001025 LOGPC(DRSL, LOGL_NOTICE, "\n");
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001026 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001027 return rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Harald Welte7f93cea2009-02-23 00:02:59 +00001028}
1029
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001030static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
1031 const char *prefix)
1032{
Harald Welte6739dfb2009-12-16 16:52:07 +01001033 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
1034 prefix, rxlev2dbm(mru->full.rx_lev),
1035 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001036 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
1037 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
1038}
1039
Harald Welte0c1bd612012-07-02 17:12:08 +02001040static void print_meas_rep(struct gsm_lchan *lchan, struct gsm_meas_rep *mr)
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001041{
Harald Welte6739dfb2009-12-16 16:52:07 +01001042 int i;
Harald Welte0c1bd612012-07-02 17:12:08 +02001043 char *name = "";
Harald Welte6739dfb2009-12-16 16:52:07 +01001044
Harald Welte0c1bd612012-07-02 17:12:08 +02001045 if (lchan && lchan->conn && lchan->conn->subscr)
1046 name = subscr_name(lchan->conn->subscr);
1047
1048 DEBUGP(DMEAS, "[%s] MEASUREMENT RESULT NR=%d ", name, mr->nr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001049
1050 if (mr->flags & MEAS_REP_F_DL_DTX)
1051 DEBUGPC(DMEAS, "DTXd ");
1052
1053 print_meas_rep_uni(&mr->ul, "ul");
1054 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
1055 if (mr->flags & MEAS_REP_F_MS_TO)
1056 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
1057
1058 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +01001059 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001060 DEBUGPC(DMEAS, "L1_FPC=%u ",
1061 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1062 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1063 }
1064
1065 if (mr->flags & MEAS_REP_F_UL_DTX)
1066 DEBUGPC(DMEAS, "DTXu ");
1067 if (mr->flags & MEAS_REP_F_BA1)
1068 DEBUGPC(DMEAS, "BA1 ");
1069 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1070 DEBUGPC(DMEAS, "NOT VALID ");
1071 else
1072 print_meas_rep_uni(&mr->dl, "dl");
1073
1074 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +01001075 if (mr->num_cell == 7)
1076 return;
Harald Welte6739dfb2009-12-16 16:52:07 +01001077 for (i = 0; i < mr->num_cell; i++) {
1078 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +01001079 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1080 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +01001081 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001082}
1083
Harald Welte440fed02009-05-01 18:43:47 +00001084static int rsl_rx_meas_res(struct msgb *msg)
1085{
1086 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1087 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +01001088 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001089 uint8_t len;
1090 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001091 int rc;
Harald Welte440fed02009-05-01 18:43:47 +00001092
Harald Welteb8bfc562009-12-21 13:27:11 +01001093 /* check if this channel is actually active */
1094 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +01001095 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +08001096 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +01001097 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +01001098 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +01001099 }
Harald Welteb8bfc562009-12-21 13:27:11 +01001100
Harald Welted12b0fd2009-12-15 21:36:05 +01001101 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +01001102 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +01001103
Harald Welte440fed02009-05-01 18:43:47 +00001104 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1105
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001106 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1107 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1108 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1109 return -EIO;
1110
1111 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +01001112 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001113
1114 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1115 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1116 if (len >= 3) {
1117 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +01001118 mr->flags |= MEAS_REP_F_DL_DTX;
1119 mr->ul.full.rx_lev = val[0] & 0x3f;
1120 mr->ul.sub.rx_lev = val[1] & 0x3f;
1121 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1122 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +00001123 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001124
Harald Welted12b0fd2009-12-15 21:36:05 +01001125 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001126
1127 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +00001128 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +01001129 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001130 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1131
Harald Weltefe9af262009-06-20 18:44:35 +02001132 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001133 struct e1inp_sign_link *sign_link = msg->dst;
1134
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001135 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001136 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001137 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001138 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001139 mr->flags |= MEAS_REP_F_FPC;
1140 mr->ms_l1.ta = val[1];
Andreas Eversberg3365cd12011-12-24 11:49:05 +01001141 /* BS11 and Nokia reports TA shifted by 2 bits */
1142 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1143 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg2957de92011-12-16 17:45:37 +01001144 mr->ms_l1.ta >>= 2;
Harald Weltefe9af262009-06-20 18:44:35 +02001145 }
Harald Weltef7c43522009-06-09 20:24:21 +00001146 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001147 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001148 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001149 if (rc < 0)
1150 return rc;
1151 }
1152
Harald Welte0c1bd612012-07-02 17:12:08 +02001153 print_meas_rep(msg->lchan, mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001154
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001155 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001156
Harald Welte75d34a82009-05-23 06:11:13 +00001157 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001158}
1159
Harald Welted011e8b2009-11-29 22:45:52 +01001160/* Chapter 8.4.7 */
1161static int rsl_rx_hando_det(struct msgb *msg)
1162{
1163 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1164 struct tlv_parsed tp;
1165
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001166 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001167
1168 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1169
1170 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1171 DEBUGPC(DRSL, "access delay = %u\n",
1172 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1173 else
1174 DEBUGPC(DRSL, "\n");
1175
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001176 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001177
1178 return 0;
1179}
1180
Harald Welte52b1f982008-12-23 20:25:15 +00001181static int abis_rsl_rx_dchan(struct msgb *msg)
1182{
Harald Welte8470bf22008-12-25 23:28:35 +00001183 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1184 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001185 char *ts_name;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001186 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001187
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001188 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001189 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001190
Harald Welte8470bf22008-12-25 23:28:35 +00001191 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001192 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001193 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001194 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001195 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001196 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001197 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001198 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001199 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001200 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001201 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001202 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001203 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001204 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001205 case RSL_MT_HANDO_DET:
1206 rc = rsl_rx_hando_det(msg);
1207 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001208 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001209 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001210 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001211 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001212 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001213 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001214 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001215 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001216 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001217 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001218 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001219 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001220 break;
1221 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001222 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001223 break;
1224 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001225 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001226 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001227 break;
1228 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001229 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001230 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001231 case RSL_MT_PHY_CONTEXT_CONF:
1232 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001233 case RSL_MT_TALKER_DET:
1234 case RSL_MT_LISTENER_DET:
1235 case RSL_MT_REMOTE_CODEC_CONF_REP:
1236 case RSL_MT_MR_CODEC_MOD_ACK:
1237 case RSL_MT_MR_CODEC_MOD_NACK:
1238 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001239 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1240 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001241 break;
1242 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001243 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1244 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001245 return -EINVAL;
1246 }
Harald Weltef325eb42009-02-19 17:07:39 +00001247
Harald Welte8470bf22008-12-25 23:28:35 +00001248 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001249}
1250
Harald Welte702d8702008-12-26 20:25:35 +00001251static int rsl_rx_error_rep(struct msgb *msg)
1252{
1253 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001254 struct tlv_parsed tp;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001255 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte702d8702008-12-26 20:25:35 +00001256
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001257 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001258
1259 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1260
1261 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001262 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001263 TLVP_LEN(&tp, RSL_IE_CAUSE));
1264
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001265 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001266
1267 return 0;
1268}
1269
Harald Welte52b1f982008-12-23 20:25:15 +00001270static int abis_rsl_rx_trx(struct msgb *msg)
1271{
Harald Welte702d8702008-12-26 20:25:35 +00001272 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001273 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte8470bf22008-12-25 23:28:35 +00001274 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001275
1276 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001277 case RSL_MT_ERROR_REPORT:
1278 rc = rsl_rx_error_rep(msg);
1279 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001280 case RSL_MT_RF_RES_IND:
1281 /* interference on idle channels of TRX */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001282 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001283 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001284 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001285 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001286 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001287 gsm_trx_name(sign_link->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001288 break;
Dieter Spaar16646022011-07-28 00:01:50 +02001289 case 0x42: /* Nokia specific: SI End ACK */
1290 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1291 break;
1292 case 0x43: /* Nokia specific: SI End NACK */
1293 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1294 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001295 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001296 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001297 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001298 return -EINVAL;
1299 }
Harald Welte8470bf22008-12-25 23:28:35 +00001300 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001301}
1302
Harald Welteb7e81162009-08-10 00:26:10 +02001303/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1304static void t3101_expired(void *data)
1305{
1306 struct gsm_lchan *lchan = data;
1307
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001308 rsl_rf_chan_release(lchan, 1, SACCH_DEACTIVATE);
Harald Welteb7e81162009-08-10 00:26:10 +02001309}
1310
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001311/* If T3111 expires, we will send the RF Channel Request */
1312static void t3111_expired(void *data)
1313{
1314 struct gsm_lchan *lchan = data;
1315
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001316 rsl_rf_chan_release(lchan, 0, SACCH_NONE);
1317}
1318
1319/* If T3109 expires the MS has not send a UA/UM do the error release */
1320static void t3109_expired(void *data)
1321{
1322 struct gsm_lchan *lchan = data;
1323
1324 LOGP(DRSL, LOGL_ERROR,
1325 "%s SACCH deactivation timeout.\n", gsm_lchan_name(lchan));
1326 rsl_rf_chan_release(lchan, 1, SACCH_NONE);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001327}
1328
laforgecfa4a012010-06-21 12:08:52 +02001329#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1330
Harald Welte2862dca2010-12-23 14:39:29 +01001331/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1332static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1333 unsigned int num_req_refs,
1334 struct gsm48_req_ref *rqd_refs,
1335 uint8_t wait_ind)
1336{
1337 uint8_t buf[GSM_MACBLOCK_LEN];
1338 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1339
1340 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1341 memset(iar, 0, sizeof(*iar));
1342 iar->proto_discr = GSM48_PDISC_RR;
Andreas Eversberg75e13a42013-02-07 11:51:16 +01001343 iar->msg_type = GSM48_MT_RR_IMM_ASS_REJ;
Harald Welte2862dca2010-12-23 14:39:29 +01001344 iar->page_mode = GSM48_PM_SAME;
1345
1346 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1347 iar->wait_ind1 = wait_ind;
1348
1349 if (num_req_refs >= 2)
1350 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1351 else
1352 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1353 iar->wait_ind2 = wait_ind;
1354
1355 if (num_req_refs >= 3)
1356 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1357 else
1358 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1359 iar->wait_ind3 = wait_ind;
1360
1361 if (num_req_refs >= 4)
1362 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1363 else
1364 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1365 iar->wait_ind4 = wait_ind;
1366
Andreas Eversberg75e13a42013-02-07 11:51:16 +01001367 /* we need to subtract 1 byte from sizeof(*iar) since ia includes the l2_plen field */
1368 iar->l2_plen = GSM48_LEN2PLEN((sizeof(*iar)-1));
1369
1370 return rsl_imm_assign_cmd(bts, sizeof(*iar), (uint8_t *) iar);
Harald Welte2862dca2010-12-23 14:39:29 +01001371}
1372
Harald Welte8470bf22008-12-25 23:28:35 +00001373/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001374static int rsl_rx_chan_rqd(struct msgb *msg)
1375{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001376 struct e1inp_sign_link *sign_link = msg->dst;
1377 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001378 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1379 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001380 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001381 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001382 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001383 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001384 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001385
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001386 uint16_t arfcn;
Holger Hans Peter Freytherc6d0a172012-02-03 20:10:13 +01001387 uint8_t subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001388
Harald Welte8470bf22008-12-25 23:28:35 +00001389 /* parse request reference to be used in immediate assign */
1390 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1391 return -EINVAL;
1392
1393 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1394
1395 /* parse access delay and use as TA */
1396 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1397 return -EINVAL;
1398 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1399
1400 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1401 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001402 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1403 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001404
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001405 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001406
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001407 /*
1408 * We want LOCATION UPDATES to succeed and will assign a TCH
1409 * if we have no SDCCH available.
1410 */
1411 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1412
Harald Welte8470bf22008-12-25 23:28:35 +00001413 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001414 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001415 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001416 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001417 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001418 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001419 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1420 if (bts->network->T3122)
1421 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001422 return -ENOMEM;
1423 }
1424
Harald Welte8e93b792009-12-29 10:44:17 +01001425 if (lchan->state != LCHAN_S_NONE)
1426 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001427 "in state %s\n", gsm_lchan_name(lchan),
1428 gsm_lchans_name(lchan->state));
Harald Welte (local)3e460312009-12-27 18:12:29 +01001429
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001430 /* save the RACH data as we need it after the CHAN ACT ACK */
1431 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1432 if (!lchan->rqd_ref) {
1433 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1434 lchan_free(lchan);
1435 return -ENOMEM;
1436 }
1437
Holger Hans Peter Freytherc0a66742011-12-29 23:33:04 +01001438 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001439 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1440 lchan->rqd_ta = rqd_ta;
1441
Harald Welte8470bf22008-12-25 23:28:35 +00001442 arfcn = lchan->ts->trx->arfcn;
1443 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001444
Harald Welte08d91a52009-08-30 15:37:11 +09001445 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001446 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001447 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001448 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001449 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001450
Harald Weltee8bd9e82011-08-10 23:26:33 +02001451 /* Start another timer or assume the BTS sends a ACK/NACK? */
1452 lchan->act_timer.cb = lchan_act_tmr_cb;
1453 lchan->act_timer.data = lchan;
1454 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1455
Andreas Eversberg2957de92011-12-16 17:45:37 +01001456 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1457 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1458 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1459 rqd_ref->ra, rqd_ta);
1460
1461 /* BS11 requires TA shifted by 2 bits */
1462 if (bts->type == GSM_BTS_TYPE_BS11)
1463 rqd_ta <<= 2;
Harald Welte8d77b952009-12-17 00:31:10 +01001464 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001465
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001466 return 0;
1467}
1468
1469static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1470{
1471 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001472 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001473 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1474
Harald Welte52b1f982008-12-23 20:25:15 +00001475 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001476 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001477 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001478 ia->proto_discr = GSM48_PDISC_RR;
1479 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1480 ia->page_mode = GSM48_PM_SAME;
1481 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001482
Harald Welte8470bf22008-12-25 23:28:35 +00001483 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001484 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1485 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001486 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001487 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001488 } else {
laforge09108bf2010-06-20 15:18:46 +02001489 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1490 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001491 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001492 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1493 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001494
Harald Welteb7e81162009-08-10 00:26:10 +02001495 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1496 lchan->T3101.cb = t3101_expired;
1497 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001498 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001499
Harald Welte52b1f982008-12-23 20:25:15 +00001500 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001501 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001502}
1503
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001504/* current load on the CCCH */
Harald Welteea280442009-02-02 22:29:56 +00001505static int rsl_rx_ccch_load(struct msgb *msg)
1506{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001507 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001508 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001509 struct ccch_signal_data sd;
1510
1511 sd.bts = sign_link->trx->bts;
1512 sd.rach_slot_count = -1;
1513 sd.rach_busy_count = -1;
1514 sd.rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001515
1516 switch (rslh->data[0]) {
1517 case RSL_IE_PAGING_LOAD:
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001518 sd.pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1519 if (is_ipaccess_bts(sign_link->trx->bts) && sd.pg_buf_space == 0xffff) {
Harald Welte38e9c822010-04-19 10:24:07 +02001520 /* paging load below configured threshold, use 50 as default */
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001521 sd.pg_buf_space = 50;
Harald Welte38e9c822010-04-19 10:24:07 +02001522 }
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001523 paging_update_buffer_space(sign_link->trx->bts, sd.pg_buf_space);
1524 osmo_signal_dispatch(SS_CCCH, S_CCCH_PAGING_LOAD, &sd);
Harald Welteea280442009-02-02 22:29:56 +00001525 break;
1526 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001527 if (msg->data_len >= 7) {
Holger Hans Peter Freyther54fa2c72012-02-03 20:26:25 +01001528 sd.rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1529 sd.rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1530 sd.rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1531 osmo_signal_dispatch(SS_CCCH, S_CCCH_RACH_LOAD, &sd);
Holger Freyther8c563cf2009-02-03 20:08:51 +00001532 }
Harald Welteea280442009-02-02 22:29:56 +00001533 break;
1534 default:
1535 break;
1536 }
1537
1538 return 0;
1539}
1540
Harald Welte52b1f982008-12-23 20:25:15 +00001541static int abis_rsl_rx_cchan(struct msgb *msg)
1542{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001543 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001544 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001545 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001546
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001547 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +00001548
1549 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001550 case RSL_MT_CHAN_RQD:
1551 /* MS has requested a channel on the RACH */
1552 rc = rsl_rx_chan_rqd(msg);
1553 break;
Harald Welteea280442009-02-02 22:29:56 +00001554 case RSL_MT_CCCH_LOAD_IND:
1555 /* current load on the CCCH */
1556 rc = rsl_rx_ccch_load(msg);
1557 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001558 case RSL_MT_DELETE_IND:
1559 /* CCCH overloaded, IMM_ASSIGN was dropped */
1560 case RSL_MT_CBCH_LOAD_IND:
1561 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001562 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1563 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001564 break;
1565 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001566 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1567 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001568 return -EINVAL;
1569 }
Harald Welte8470bf22008-12-25 23:28:35 +00001570
1571 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001572}
1573
Harald Welte4b634542008-12-27 01:55:51 +00001574static int rsl_rx_rll_err_ind(struct msgb *msg)
1575{
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001576 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +00001577 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001578 uint8_t rlm_cause;
Harald Welte4b634542008-12-27 01:55:51 +00001579
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001580 rsl_tlv_parse(&tp, rllh->data, msgb_l2len(msg) - sizeof(*rllh));
1581 if (!TLVP_PRESENT(&tp, RSL_IE_RLM_CAUSE)) {
1582 LOGP(DRLL, LOGL_ERROR,
1583 "%s ERROR INDICATION without mandantory cause.\n",
1584 gsm_lchan_name(msg->lchan));
1585 return -1;
1586 }
1587
1588 rlm_cause = *TLVP_VAL(&tp, RSL_IE_RLM_CAUSE);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001589 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001590 gsm_lchan_name(msg->lchan),
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001591 rsl_rlm_cause_name(rlm_cause));
Harald Welteedcc5272009-08-09 13:47:35 +02001592
1593 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001594
Holger Hans Peter Freyther164ee302013-01-16 21:07:43 +01001595 if (rlm_cause == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001596 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001597 return rsl_rf_chan_release(msg->lchan, 1, SACCH_DEACTIVATE);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001598 }
Harald Welte81543bc2009-07-04 09:40:05 +02001599
Harald Welte4b634542008-12-27 01:55:51 +00001600 return 0;
1601}
Harald Weltef325eb42009-02-19 17:07:39 +00001602
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001603static void rsl_handle_release(struct gsm_lchan *lchan)
1604{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001605 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001606 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001607
Holger Hans Peter Freyther9d50a272011-12-28 12:11:40 +01001608 /*
1609 * Maybe only one link/SAPI was releasd or the error handling
1610 * was activated. Just return now and let the other code handle
1611 * it.
1612 */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001613 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001614 return;
1615
1616 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1617 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1618 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001619 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001620 gsm_lchan_name(lchan), sapi);
1621 return;
1622 }
1623
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001624
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01001625 /* Stop T3109 and wait for T3111 before re-using the channel */
1626 osmo_timer_del(&lchan->T3109);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001627 lchan->T3111.cb = t3111_expired;
1628 lchan->T3111.data = lchan;
1629 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001630 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001631}
1632
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001633/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001634 0x02, 0x06,
1635 0x01, 0x20,
1636 0x02, 0x00,
1637 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1638
1639static int abis_rsl_rx_rll(struct msgb *msg)
1640{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001641 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001642 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001643 int rc = 0;
1644 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001645 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001646
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001647 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001648 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001649 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001650
1651 switch (rllh->c.msg_type) {
1652 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001653 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001654 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001655 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1656 rllh->data[0] == RSL_IE_L3_INFO) {
1657 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001658 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001659 }
Harald Welte52b1f982008-12-23 20:25:15 +00001660 break;
1661 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001662 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001663 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001664 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001665 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001666 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001667 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1668 rllh->data[0] == RSL_IE_L3_INFO) {
1669 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001670 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001671 }
Harald Welte52b1f982008-12-23 20:25:15 +00001672 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001673 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001674 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001675 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001676 rll_indication(msg->lchan, rllh->link_id,
1677 BSC_RLLR_IND_EST_CONF);
1678 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001679 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001680 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001681 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001682 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001683 rll_indication(msg->lchan, rllh->link_id,
1684 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001685 rsl_handle_release(msg->lchan);
Harald Welte2d5b6382008-12-27 19:46:06 +00001686 break;
1687 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001688 /* BTS informs us of having received UA from MS,
1689 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001690 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001691 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001692 rsl_handle_release(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +00001693 break;
1694 case RSL_MT_ERROR_IND:
1695 rc = rsl_rx_rll_err_ind(msg);
1696 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001697 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001698 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1699 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001700 break;
1701 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001702 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1703 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001704 }
Harald Welte8470bf22008-12-25 23:28:35 +00001705 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001706}
1707
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001708static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001709{
Harald Welte0603c9d2009-12-02 01:58:23 +05301710 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001711 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301712 switch (lchan->type) {
1713 case GSM_LCHAN_TCH_F:
1714 return 0x00;
1715 case GSM_LCHAN_TCH_H:
1716 return 0x03;
1717 default:
1718 break;
1719 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001720 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001721 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301722 switch (lchan->type) {
1723 case GSM_LCHAN_TCH_F:
1724 return 0x01;
1725 /* there's no half-rate EFR */
1726 default:
1727 break;
1728 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001729 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001730 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301731 switch (lchan->type) {
1732 case GSM_LCHAN_TCH_F:
1733 return 0x02;
1734 case GSM_LCHAN_TCH_H:
1735 return 0x05;
1736 default:
1737 break;
1738 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001739 break;
Harald Welte0603c9d2009-12-02 01:58:23 +05301740 default:
1741 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001742 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001743 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301744 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001745 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001746}
1747
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001748static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001749{
1750 switch (lchan->tch_mode) {
1751 case GSM48_CMODE_SPEECH_V1:
1752 switch (lchan->type) {
1753 case GSM_LCHAN_TCH_F:
1754 return RTP_PT_GSM_FULL;
1755 case GSM_LCHAN_TCH_H:
1756 return RTP_PT_GSM_HALF;
1757 default:
1758 break;
1759 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001760 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001761 case GSM48_CMODE_SPEECH_EFR:
1762 switch (lchan->type) {
1763 case GSM_LCHAN_TCH_F:
1764 return RTP_PT_GSM_EFR;
1765 /* there's no half-rate EFR */
1766 default:
1767 break;
1768 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001769 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001770 case GSM48_CMODE_SPEECH_AMR:
1771 switch (lchan->type) {
1772 case GSM_LCHAN_TCH_F:
Sylvain Munautb54dda42009-12-20 22:06:40 +01001773 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freythered999b22011-07-21 10:24:46 +02001774 return RTP_PT_AMR;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001775 default:
1776 break;
1777 }
Holger Hans Peter Freyther47665242014-04-04 12:14:55 +02001778 break;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001779 default:
1780 break;
1781 }
1782 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1783 "tch_mode == 0x%02x\n & lchan_type == %d",
1784 lchan->tch_mode, lchan->type);
1785 return 0;
1786}
1787
Harald Welte75099262009-02-16 21:12:08 +00001788/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001789static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1790{
1791 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001792 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001793
1794 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001795 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001796 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1797 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1798 }
1799
1800 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001801 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001802 port = ntohs(port);
1803 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1804 lchan->abis_ip.bound_port = port;
1805 }
1806
1807 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001808 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001809 conn_id = ntohs(conn_id);
1810 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1811 lchan->abis_ip.conn_id = conn_id;
1812 }
1813
1814 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1815 lchan->abis_ip.rtp_payload2 =
1816 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1817 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1818 lchan->abis_ip.rtp_payload2);
1819 }
1820
1821 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1822 lchan->abis_ip.speech_mode =
1823 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1824 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1825 lchan->abis_ip.speech_mode);
1826 }
1827
1828 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001829 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001830 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1831 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1832 }
1833
1834 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001835 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001836 port = ntohs(port);
1837 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1838 lchan->abis_ip.connect_port = port;
1839 }
1840}
1841
Harald Welte647db842013-02-03 12:06:58 +01001842/*! \brief Issue IPA RSL CRCX to configure RTP on BTS side
1843 * \param[in] lchan Logical Channel for which we issue CRCX
1844 */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001845int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001846{
1847 struct msgb *msg = rsl_msgb_alloc();
1848 struct abis_rsl_dchan_hdr *dh;
1849
1850 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001851 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001852 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001853 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001854
Harald Weltef4e79f22009-07-28 18:11:56 +02001855 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001856 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001857 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001858 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001859 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001860
Sylvain Munautb54dda42009-12-20 22:06:40 +01001861 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1862 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1863 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001864
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001865 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001866
1867 return abis_rsl_sendmsg(msg);
1868}
1869
Harald Welte647db842013-02-03 12:06:58 +01001870/*! \brief Issue IPA RSL MDCX to configure MGW-side of RTP
1871 * \param[in] lchan Logical Channel for which we issue MDCX
1872 * \param[in] ip Remote (MGW) IP address for RTP
1873 * \param[in] port Remote (MGW) UDP port number for RTP
1874 * \param[in] rtp_payload2 Contents of RTP PAYLOAD 2 IE
1875 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001876int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1877 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001878{
1879 struct msgb *msg = rsl_msgb_alloc();
1880 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001881 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001882 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001883
1884 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001885 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001886 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001887 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001888
Harald Welte5e3d91b2009-12-19 16:42:06 +01001889 /* we need to store these now as MDCX_ACK does not return them :( */
1890 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1891 lchan->abis_ip.connect_port = port;
1892 lchan->abis_ip.connect_ip = ip;
1893
Harald Welte58ca5b72009-07-29 12:12:18 +02001894 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001895 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001896 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001897
Harald Weltef4e79f22009-07-28 18:11:56 +02001898 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001899 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1900 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1901 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1902 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001903
Harald Welte5e3d91b2009-12-19 16:42:06 +01001904 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1905 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001906 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001907 *att_ip = ia.s_addr;
1908 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1909 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001910 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001911 if (rtp_payload2)
1912 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001913
1914 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001915
1916 return abis_rsl_sendmsg(msg);
1917}
1918
Harald Weltea72273e2009-12-20 16:51:09 +01001919/* tell BTS to connect RTP stream to our local RTP socket */
1920int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1921{
1922 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1923 int rc;
1924
1925 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1926 ntohs(rs->rtp.sin_local.sin_port),
1927 /* FIXME: use RTP payload of bound socket, not BTS*/
1928 lchan->abis_ip.rtp_payload2);
1929
1930 return rc;
1931}
1932
Harald Welte53cd7ac2010-12-23 12:59:52 +01001933int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001934{
1935 struct msgb *msg = rsl_msgb_alloc();
1936 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001937 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001938
1939 if (act)
1940 msg_type = RSL_MT_IPAC_PDCH_ACT;
1941 else
1942 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001943
1944 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001945 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001946 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001947 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001948
Harald Welte53cd7ac2010-12-23 12:59:52 +01001949 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001950 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001951
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001952 msg->dst = ts->trx->rsl_link;
Harald Welte9c880c92009-10-24 10:29:22 +02001953
1954 return abis_rsl_sendmsg(msg);
1955}
1956
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001957static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001958{
1959 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1960 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301961 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001962
1963 /* the BTS has acknowledged a local bind, it now tells us the IP
1964 * address and port number to which it has bound the given logical
1965 * channel */
1966
1967 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1968 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1969 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001970 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001971 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001972 return -EINVAL;
1973 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001974
Harald Welte5e3d91b2009-12-19 16:42:06 +01001975 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001976
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001977 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001978
Harald Welte75099262009-02-16 21:12:08 +00001979 return 0;
1980}
1981
Harald Welte5e3d91b2009-12-19 16:42:06 +01001982static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1983{
1984 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1985 struct tlv_parsed tv;
1986 struct gsm_lchan *lchan = msg->lchan;
1987
1988 /* the BTS has acknowledged a remote connect request and
1989 * it now tells us the IP address and port number to which it has
1990 * connected the given logical channel */
1991
1992 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1993 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001994 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001995
1996 return 0;
1997}
1998
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001999static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00002000{
2001 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
2002 struct tlv_parsed tv;
2003
2004 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00002005
Harald Welte8830e072009-07-28 17:58:09 +02002006 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01002007 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02002008 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00002009
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02002010 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02002011
Harald Welte75099262009-02-16 21:12:08 +00002012 return 0;
2013}
2014
2015static int abis_rsl_rx_ipacc(struct msgb *msg)
2016{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002017 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte75099262009-02-16 21:12:08 +00002018 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01002019 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00002020 int rc = 0;
2021
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002022 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01002023 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00002024
2025 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002026 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01002027 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002028 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00002029 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002030 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00002031 /* somehow the BTS was unable to bind the lchan to its local
2032 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01002033 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00002034 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002035 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00002036 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01002037 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01002038 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00002039 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002040 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00002041 /* somehow the BTS was unable to connect the lchan to a remote
2042 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01002043 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00002044 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002045 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01002046 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01002047 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00002048 break;
2049 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01002050 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002051 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00002052 break;
2053 }
Harald Welte6dab0552009-05-01 17:21:37 +00002054 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00002055
2056 return rc;
2057}
2058
2059
Harald Welte52b1f982008-12-23 20:25:15 +00002060/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00002061int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00002062{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002063 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00002064 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00002065
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002066 if (!msg) {
2067 DEBUGP(DRSL, "Empty RSL msg?..\n");
2068 return -1;
2069 }
2070
2071 if (msgb_l2len(msg) < sizeof(*rslh)) {
2072 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
Harald Weltef25b55e2012-05-31 20:22:34 +02002073 msgb_free(msg);
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01002074 return -1;
2075 }
2076
2077 rslh = msgb_l2(msg);
2078
Harald Welte52b1f982008-12-23 20:25:15 +00002079 switch (rslh->msg_discr & 0xfe) {
2080 case ABIS_RSL_MDISC_RLL:
2081 rc = abis_rsl_rx_rll(msg);
2082 break;
2083 case ABIS_RSL_MDISC_DED_CHAN:
2084 rc = abis_rsl_rx_dchan(msg);
2085 break;
2086 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00002087 rc = abis_rsl_rx_cchan(msg);
2088 break;
Harald Welte8470bf22008-12-25 23:28:35 +00002089 case ABIS_RSL_MDISC_TRX:
2090 rc = abis_rsl_rx_trx(msg);
2091 break;
Harald Welte52b1f982008-12-23 20:25:15 +00002092 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002093 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00002094 rslh->msg_discr);
2095 break;
Harald Welte75099262009-02-16 21:12:08 +00002096 case ABIS_RSL_MDISC_IPACCESS:
2097 rc = abis_rsl_rx_ipacc(msg);
2098 break;
Harald Welte52b1f982008-12-23 20:25:15 +00002099 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01002100 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
2101 "0x%02x\n", rslh->msg_discr);
Harald Weltef25b55e2012-05-31 20:22:34 +02002102 rc = -EINVAL;
Harald Welte52b1f982008-12-23 20:25:15 +00002103 }
Harald Welte4f4a3902008-12-26 00:04:49 +00002104 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00002105 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00002106}
Holger Freyther3b72a892009-02-04 00:31:39 +00002107
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08002108int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
2109 uint8_t cb_command, const uint8_t *data, int len)
2110{
2111 struct abis_rsl_dchan_hdr *dh;
2112 struct msgb *cb_cmd;
2113
2114 cb_cmd = rsl_msgb_alloc();
2115 if (!cb_cmd)
2116 return -1;
2117
2118 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
2119 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
2120 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
2121
2122 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
2123 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
2124
2125 cb_cmd->trx = bts->c0;
2126
2127 return abis_rsl_sendmsg(cb_cmd);
2128}
Dieter Spaar16646022011-07-28 00:01:50 +02002129
2130int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
2131{
2132 struct abis_rsl_common_hdr *ch;
2133 struct msgb *msg = rsl_msgb_alloc();
2134
2135 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2136 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2137 ch->msg_type = 0x40; /* Nokia SI Begin */
2138
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002139 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002140
2141 return abis_rsl_sendmsg(msg);
2142}
2143
2144int rsl_nokia_si_end(struct gsm_bts_trx *trx)
2145{
2146 struct abis_rsl_common_hdr *ch;
2147 struct msgb *msg = rsl_msgb_alloc();
2148
2149 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2150 ch->msg_discr = ABIS_RSL_MDISC_TRX;
2151 ch->msg_type = 0x41; /* Nokia SI End */
2152
2153 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
2154
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002155 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002156
2157 return abis_rsl_sendmsg(msg);
2158}
2159
2160int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
2161{
2162 struct abis_rsl_common_hdr *ch;
2163 struct msgb *msg = rsl_msgb_alloc();
2164
2165 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
2166 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
2167 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
2168
2169 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
2170 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
2171
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002172 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002173
2174 return abis_rsl_sendmsg(msg);
2175}
Holger Hans Peter Freyther85825352011-12-27 22:24:17 +01002176
2177/**
2178 * Release all allocated SAPIs starting from @param start and
2179 * release them with the given release mode. Once the release
2180 * confirmation arrives it will be attempted to release the
2181 * the RF channel.
2182 */
2183int rsl_release_sapis_from(struct gsm_lchan *lchan, int start,
2184 enum rsl_rel_mode release_mode)
2185{
2186 int no_sapi = 1;
2187 int sapi;
2188
2189 for (sapi = start; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
2190 uint8_t link_id;
2191 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
2192 continue;
2193
2194 link_id = sapi;
2195 if (lchan->type == GSM_LCHAN_TCH_F || lchan->type == GSM_LCHAN_TCH_H)
2196 link_id |= 0x40;
2197 rsl_release_request(lchan, link_id, release_mode);
2198 no_sapi = 0;
2199 }
2200
2201 return no_sapi;
2202}
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +01002203
2204int rsl_start_t3109(struct gsm_lchan *lchan)
2205{
2206 struct gsm_bts *bts = lchan->ts->trx->bts;
2207
2208 /* Disabled, mostly legacy code */
2209 if (bts->network->T3109 == 0)
2210 return -1;
2211
2212 lchan->T3109.cb = t3109_expired;
2213 lchan->T3109.data = lchan;
2214 osmo_timer_schedule(&lchan->T3109, bts->network->T3109, 0);
2215 return 0;
2216}
Holger Hans Peter Freyther006e3d82012-12-25 23:45:14 +01002217
2218/**
2219 * \brief directly RF Channel Release the lchan
2220 *
2221 * When no SAPI was allocated, directly release the logical channel. This
2222 * should only be called from chan_alloc.c on channel release handling. In
2223 * case no SAPI was established the RF Channel can be directly released,
2224 */
2225int rsl_direct_rf_release(struct gsm_lchan *lchan)
2226{
2227 int i;
2228 for (i = 0; i < ARRAY_SIZE(lchan->sapis); ++i) {
2229 if (lchan->sapis[i] != LCHAN_SAPI_UNUSED) {
2230 LOGP(DRSL, LOGL_ERROR, "%s SAPI(%d) still allocated.\n",
2231 gsm_lchan_name(lchan), i);
2232 return -1;
2233 }
2234 }
2235
2236 /* Now release it */
2237 return rsl_rf_chan_release(lchan, 0, SACCH_NONE);
2238}