blob: f20b4f2b528f9a12b3793257acef6a8de896bdb2 [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>
Harald Welte8470bf22008-12-25 23:28:35 +00005 *
Harald Welte52b1f982008-12-23 20:25:15 +00006 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +01009 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
Harald Welte52b1f982008-12-23 20:25:15 +000011 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000017 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010018 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte52b1f982008-12-23 20:25:15 +000020 *
21 */
22
23#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000024#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000025#include <errno.h>
Harald Welte75099262009-02-16 21:12:08 +000026#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000027#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000028
Harald Welte8470bf22008-12-25 23:28:35 +000029#include <openbsc/gsm_data.h>
30#include <openbsc/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010031#include <osmocom/gsm/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000032#include <openbsc/abis_rsl.h>
33#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020034#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000035#include <openbsc/debug.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010036#include <osmocom/gsm/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000037#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000038#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010039#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010040#include <openbsc/rtp_proxy.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010041#include <osmocom/gsm/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000042
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080044
Harald Welte8470bf22008-12-25 23:28:35 +000045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000047
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080048static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
49
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010050static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
51 struct gsm_meas_rep *resp)
52{
53 struct lchan_signal_data sig;
54 sig.lchan = lchan;
55 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020056 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010057}
58
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020059static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000060{
61 /* mask off the transparent bit ? */
62 msg_type &= 0xfe;
63
Harald Welte8470bf22008-12-25 23:28:35 +000064 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000065 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000066 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000067 if (msg_type >= 0x19 && msg_type <= 0x22)
68 return ABIS_RSL_MDISC_TRX;
69 else
70 return ABIS_RSL_MDISC_COM_CHAN;
71 }
Harald Welte2d5b6382008-12-27 19:46:06 +000072 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000073 return ABIS_RSL_MDISC_DED_CHAN;
74
75 return ABIS_RSL_MDISC_LOC;
76}
77
78static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020079 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000080{
81 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
82 dh->c.msg_type = msg_type;
83 dh->ie_chan = RSL_IE_CHAN_NR;
84}
85
Harald Welte8470bf22008-12-25 23:28:35 +000086/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020087struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +000088{
89 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020090 uint8_t ts_nr = chan_nr & 0x07;
91 uint8_t cbits = chan_nr >> 3;
92 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +000093 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
94
95 if (cbits == 0x01) {
96 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020097 if (ts->pchan != GSM_PCHAN_TCH_F &&
98 ts->pchan != GSM_PCHAN_PDCH &&
99 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000101 chan_nr, ts->pchan);
102 } else if ((cbits & 0x1e) == 0x02) {
103 lch_idx = cbits & 0x1; /* TCH/H */
104 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000106 chan_nr, ts->pchan);
107 } else if ((cbits & 0x1c) == 0x04) {
108 lch_idx = cbits & 0x3; /* SDCCH/4 */
109 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000111 chan_nr, ts->pchan);
112 } else if ((cbits & 0x18) == 0x08) {
113 lch_idx = cbits & 0x7; /* SDCCH/8 */
114 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100115 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000116 chan_nr, ts->pchan);
117 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
118 lch_idx = 0;
119 if (ts->pchan != GSM_PCHAN_CCCH &&
120 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000122 chan_nr, ts->pchan);
123 /* FIXME: we should not return first sdcch4 !!! */
124 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100125 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000126 return NULL;
127 }
128
129 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800130 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800131 if (lchan->conn)
132 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000133
134 return lchan;
135}
136
Harald Welte52b1f982008-12-23 20:25:15 +0000137/* 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 +0200138uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000139{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200140 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000141
142 ret = strtoull(imsi_str, NULL, 10);
143
144 return ret;
145}
146
Harald Welte8470bf22008-12-25 23:28:35 +0000147static struct msgb *rsl_msgb_alloc(void)
148{
Harald Welte966636f2009-06-26 19:39:35 +0200149 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
150 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000151}
152
Harald Welte362322e2009-02-15 14:36:38 +0000153#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200154static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000155{
156 memcpy(out, in, len);
157
158 if (len < MACBLOCK_SIZE)
159 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
160}
161
Harald Welte08d91a52009-08-30 15:37:11 +0900162/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200163static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900164{
165 *out++ = lchan->encr.alg_id & 0xff;
166 if (lchan->encr.key_len)
167 memcpy(out, lchan->encr.key, lchan->encr.key_len);
168 return lchan->encr.key_len + 1;
169}
170
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200171static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200172{
Harald Welte7f93cea2009-02-23 00:02:59 +0000173 int i;
174
Harald Welte5b8ed432009-12-24 12:20:20 +0100175 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200176 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200177 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100178 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000179}
180
Harald Welte52b1f982008-12-23 20:25:15 +0000181/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200182int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
183 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000184{
185 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000186 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000187
188 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
189 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
190 dh->chan_nr = RSL_CHAN_BCCH;
191
192 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
193 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
194
Harald Weltee79769b2009-02-07 00:48:17 +0000195 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000196
197 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000198}
199
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200200int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
201 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000202{
203 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000204 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000205
206 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
207 ch->msg_discr = ABIS_RSL_MDISC_TRX;
208 ch->msg_type = RSL_MT_SACCH_FILL;
209
210 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000211 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000212
Harald Weltee79769b2009-02-07 00:48:17 +0000213 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000214
215 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000216}
217
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200218int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
219 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100220{
221 struct abis_rsl_dchan_hdr *dh;
222 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200223 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100224
225 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
226 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
227 dh->chan_nr = chan_nr;
228
229 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
230 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
231
232 msg->trx = lchan->ts->trx;
233
234 return abis_rsl_sendmsg(msg);
235}
236
Harald Weltefcd24452009-06-20 18:15:19 +0200237int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
238{
239 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200240 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200241 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200242
243 db = abs(db);
244 if (db > 30)
245 return -EINVAL;
246
Harald Welteeab33352009-06-27 03:09:08 +0200247 msg = rsl_msgb_alloc();
248
Harald Weltefcd24452009-06-20 18:15:19 +0200249 lchan->bs_power = db/2;
250 if (fpc)
251 lchan->bs_power |= 0x10;
252
253 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
254 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
255 dh->chan_nr = chan_nr;
256
257 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
258
259 msg->trx = lchan->ts->trx;
260
261 return abis_rsl_sendmsg(msg);
262}
263
Harald Weltefcd24452009-06-20 18:15:19 +0200264int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
265{
266 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200267 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200268 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200269 int ctl_lvl;
270
Harald Welte66b6a8d2009-08-09 14:45:18 +0200271 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200272 if (ctl_lvl < 0)
273 return ctl_lvl;
274
Harald Welteeab33352009-06-27 03:09:08 +0200275 msg = rsl_msgb_alloc();
276
Harald Weltefcd24452009-06-20 18:15:19 +0200277 lchan->ms_power = ctl_lvl;
278
279 if (fpc)
280 lchan->ms_power |= 0x20;
281
282 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
283 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
284 dh->chan_nr = chan_nr;
285
286 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
287
288 msg->trx = lchan->ts->trx;
289
290 return abis_rsl_sendmsg(msg);
291}
292
Harald Welte9943c5b2009-07-29 15:41:29 +0200293static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
294 struct gsm_lchan *lchan)
295{
296 memset(cm, 0, sizeof(cm));
297
298 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800299 if (lchan->ts->trx->bts->network->dtx_enabled)
300 cm->dtx_dtu = 0x03;
301 else
302 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200303
304 /* set TCH Speech/Data */
305 cm->spd_ind = lchan->rsl_cmode;
306
Harald Welte1a79d362009-11-27 08:55:16 +0100307 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
308 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100309 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100310 "but tch_mode != signalling\n");
311
Harald Welte9943c5b2009-07-29 15:41:29 +0200312 switch (lchan->type) {
313 case GSM_LCHAN_SDCCH:
314 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
315 break;
316 case GSM_LCHAN_TCH_F:
317 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
318 break;
319 case GSM_LCHAN_TCH_H:
320 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
321 break;
322 case GSM_LCHAN_NONE:
323 case GSM_LCHAN_UNKNOWN:
324 default:
325 return -EINVAL;
326 }
327
328 switch (lchan->tch_mode) {
329 case GSM48_CMODE_SIGN:
330 cm->chan_rate = 0;
331 break;
332 case GSM48_CMODE_SPEECH_V1:
333 cm->chan_rate = RSL_CMOD_SP_GSM1;
334 break;
335 case GSM48_CMODE_SPEECH_EFR:
336 cm->chan_rate = RSL_CMOD_SP_GSM2;
337 break;
338 case GSM48_CMODE_SPEECH_AMR:
339 cm->chan_rate = RSL_CMOD_SP_GSM3;
340 break;
341 case GSM48_CMODE_DATA_14k5:
342 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
343 break;
344 case GSM48_CMODE_DATA_12k0:
345 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
346 break;
347 case GSM48_CMODE_DATA_6k0:
348 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
349 break;
350 default:
351 return -EINVAL;
352 }
353
354 return 0;
355}
356
Harald Welte52b1f982008-12-23 20:25:15 +0000357/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000358#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200359int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
360 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000361 struct rsl_ie_chan_mode *chan_mode,
362 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200363 uint8_t bs_power, uint8_t ms_power,
364 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000365{
366 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000367 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000368
369 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
370 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
371 dh->chan_nr = chan_nr;
372
373 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
374 /* For compatibility with Phase 1 */
375 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200376 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000377 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200378 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000379#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000380 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200381 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000382#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000383 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000384 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
385 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
386
Harald Weltee79769b2009-02-07 00:48:17 +0000387 msg->trx = trx;
388
Harald Welte8470bf22008-12-25 23:28:35 +0000389 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000390}
Harald Welteddab3c72009-02-28 13:19:15 +0000391#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000392
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200393int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
394 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000395{
396 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200397 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200398 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200399 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000400
Harald Weltef6093a42011-06-25 10:02:33 +0200401 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000402 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200403 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000404
Harald Welte9943c5b2009-07-29 15:41:29 +0200405 rc = channel_mode_from_lchan(&cm, lchan);
406 if (rc < 0)
407 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000408
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800409 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200410 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000411
Harald Welteeab33352009-06-27 03:09:08 +0200412 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000413 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
414 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
415 dh->chan_nr = chan_nr;
416
417 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000418 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200419 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800420
421 /*
422 * The Channel Identification is needed for Phase1 phones
423 * and it contains the GSM48 Channel Description and the
424 * Mobile Allocation. The GSM 08.58 asks for the Mobile
425 * Allocation to have a length of zero. We are using the
426 * msgb_l3len to calculate the length of both messages.
427 */
laforge694a5cf2010-06-20 21:38:19 +0200428 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200429 len = msgb_put(msg, 1);
Dieter Spaareabb6e32011-07-27 23:40:33 +0200430 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800431
432 if (lchan->ts->hopping.enabled)
433 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
434 lchan->ts->hopping.ma_data);
435 else
436 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800437
438 /* update the calculated size */
439 msg->l3h = len + 1;
440 *len = msgb_l3len(msg);
441
Harald Welte08d91a52009-08-30 15:37:11 +0900442 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200443 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900444 rc = build_encr_info(encr_info, lchan);
445 if (rc > 0)
446 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
447 }
448
Harald Welte8d77b952009-12-17 00:31:10 +0100449 switch (act_type) {
450 case RSL_ACT_INTER_ASYNC:
451 case RSL_ACT_INTER_SYNC:
452 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
453 break;
454 default:
455 break;
456 }
457
Harald Welted4c9bf32009-02-15 16:56:18 +0000458 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
459 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000460 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
461
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100462 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
463 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200464 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100465
Harald Weltee79769b2009-02-07 00:48:17 +0000466 msg->trx = lchan->ts->trx;
467
Harald Welte4b634542008-12-27 01:55:51 +0000468 return abis_rsl_sendmsg(msg);
469}
470
Harald Welte470abb72009-07-29 11:38:15 +0200471/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000472int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
473{
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 Welteda783762009-02-18 03:29:53 +0000477
Harald Weltef6093a42011-06-25 10:02:33 +0200478 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000479 struct rsl_ie_chan_mode cm;
480
Harald Welte9943c5b2009-07-29 15:41:29 +0200481 rc = channel_mode_from_lchan(&cm, lchan);
482 if (rc < 0)
483 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000484
Harald Welteeab33352009-06-27 03:09:08 +0200485 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000486 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
487 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
488 dh->chan_nr = chan_nr;
489
490 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200491 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900492
493 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200494 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900495 rc = build_encr_info(encr_info, lchan);
496 if (rc > 0)
497 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
498 }
499
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100500 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
501 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200502 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100503 }
504
Harald Welte08d91a52009-08-30 15:37:11 +0900505 msg->trx = lchan->ts->trx;
506
507 return abis_rsl_sendmsg(msg);
508}
509
510/* Chapter 8.4.6: Send the encryption command with given L3 info */
511int rsl_encryption_cmd(struct msgb *msg)
512{
513 struct abis_rsl_dchan_hdr *dh;
514 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200515 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200516 uint8_t encr_info[MAX_A5_KEY_LEN+2];
517 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900518 int rc;
519
520 /* First push the L3 IE tag and length */
521 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
522
523 /* then the link identifier (SAPI0, main sign link) */
524 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
525
526 /* then encryption information */
527 rc = build_encr_info(encr_info, lchan);
528 if (rc <= 0)
529 return rc;
530 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
531
532 /* and finally the DCHAN header */
533 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
534 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
535 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000536
537 msg->trx = lchan->ts->trx;
538
539 return abis_rsl_sendmsg(msg);
540}
541
Harald Welte115d1032009-08-10 11:43:22 +0200542/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200543int rsl_deact_sacch(struct gsm_lchan *lchan)
544{
545 struct abis_rsl_dchan_hdr *dh;
546 struct msgb *msg = rsl_msgb_alloc();
547
548 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
549 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200550 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200551
552 msg->lchan = lchan;
553 msg->trx = lchan->ts->trx;
554
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100555 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200556
557 return abis_rsl_sendmsg(msg);
558}
559
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800560static void error_timeout_cb(void *data)
561{
562 struct gsm_lchan *lchan = data;
563 if (lchan->state != LCHAN_S_REL_ERR) {
564 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
565 gsm_lchan_name(lchan), lchan->state);
566 return;
567 }
568
569 /* go back to the none state */
570 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800571 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800572}
573
Harald Weltefd355a32011-03-04 13:41:31 +0100574static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
575
Harald Welte115d1032009-08-10 11:43:22 +0200576/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800577static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000578{
579 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800580 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100581 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000582
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800583 if (lchan->state == LCHAN_S_REL_ERR) {
584 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
585 gsm_lchan_name(lchan));
586 return -1;
587 }
588
589 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000590 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
591 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200592 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000593
Harald Welte8470bf22008-12-25 23:28:35 +0000594 msg->lchan = lchan;
595 msg->trx = lchan->ts->trx;
596
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800597 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
598
599 if (error) {
600 /*
601 * the nanoBTS sends RLL release indications after the channel release. This can
602 * be a problem when we have reassigned the channel to someone else and then can
603 * not figure out who used this channel.
604 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800605 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800606 lchan->error_timer.data = lchan;
607 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200608 osmo_timer_schedule(&lchan->error_timer,
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800609 msg->trx->bts->network->T3111 + 2, 0);
610 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000611
Harald Weltefd355a32011-03-04 13:41:31 +0100612 rc = abis_rsl_sendmsg(msg);
613
Harald Welte115d1032009-08-10 11:43:22 +0200614 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100615#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100616 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
617 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
618 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100619#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100620
621 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000622}
623
Harald Welte64bb7542011-01-14 14:16:16 +0100624static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
625{
626
627 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
628
629 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
630 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
631 gsm_lchan_name(lchan),
632 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200633 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100634 /* we have an error timer pending to release that */
635 if (lchan->state != LCHAN_S_REL_ERR)
636 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
637 lchan_free(lchan);
638
639 return 0;
640}
641
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200642int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
643 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000644{
645 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000646 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000647
648 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
649 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
650 dh->chan_nr = RSL_CHAN_PCH_AGCH;
651
652 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000653 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000654 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
655
Harald Welte8470bf22008-12-25 23:28:35 +0000656 msg->trx = bts->c0;
657
658 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000659}
660
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200661int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000662{
663 int i, len = strlen(str_in);
664
665 for (i = 0; i < len; i++) {
666 int num = str_in[i] - 0x30;
667 if (num < 0 || num > 9)
668 return -1;
669 if (i % 2 == 0)
670 bcd_out[i/2] = num;
671 else
672 bcd_out[i/2] |= (num << 4);
673 }
674
675 return 0;
676}
677
Harald Welte702d8702008-12-26 20:25:35 +0000678/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200679int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000680{
Harald Welte8470bf22008-12-25 23:28:35 +0000681 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000682 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200683 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000684
685 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
686 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
687 dh->chan_nr = RSL_CHAN_PCH_AGCH;
688
Harald Welte362322e2009-02-15 14:36:38 +0000689 switch (bts->type) {
690 case GSM_BTS_TYPE_BS11:
691 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
692 break;
693 default:
694 /* If phase 2, construct a FULL_IMM_ASS_INFO */
695 pad_macblock(buf, val, len);
696 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
697 break;
698 }
Harald Welte52b1f982008-12-23 20:25:15 +0000699
Harald Welte8470bf22008-12-25 23:28:35 +0000700 msg->trx = bts->c0;
701
702 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000703}
704
Harald Welte67fa91b2009-08-10 09:51:40 +0200705/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200706int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200707{
708 struct msgb *msg = rsl_msgb_alloc();
709 struct abis_rsl_dchan_hdr *dh;
710
711 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
712 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200713 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200714 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200715 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200716
Harald Welte5b8ed432009-12-24 12:20:20 +0100717 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200718 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200719
720 msg->trx = lchan->ts->trx;
721
Harald Welte67fa91b2009-08-10 09:51:40 +0200722 return abis_rsl_sendmsg(msg);
723}
724
725
Harald Welte8470bf22008-12-25 23:28:35 +0000726/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000727/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200728int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000729{
Harald Welte8470bf22008-12-25 23:28:35 +0000730 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100731 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000732 return -EINVAL;
733 }
Harald Welte52b1f982008-12-23 20:25:15 +0000734
Harald Weltef6093a42011-06-25 10:02:33 +0200735 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100736 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000737
Harald Welte8470bf22008-12-25 23:28:35 +0000738 msg->trx = msg->lchan->ts->trx;
739
740 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000741}
742
Harald Welteedcc5272009-08-09 13:47:35 +0200743/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
744/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200745int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200746{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100747 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200748
Harald Weltef6093a42011-06-25 10:02:33 +0200749 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100750 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200751 msg->trx = lchan->ts->trx;
752
753 return abis_rsl_sendmsg(msg);
754}
755
Harald Welted2dc1de2009-08-08 13:15:07 +0200756/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
757 This is what higher layers should call. The BTS then responds with
758 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
759 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
760 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200761int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200762{
Harald Welted2dc1de2009-08-08 13:15:07 +0200763
Harald Welte3c9c5f92010-03-04 10:33:10 +0100764 struct msgb *msg;
765
Harald Weltef6093a42011-06-25 10:02:33 +0200766 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100767 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800768 /* 0 is normal release, 1 is local end */
769 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200770
Harald Welte8e93b792009-12-29 10:44:17 +0100771 /* FIXME: start some timer in case we don't receive a REL ACK ? */
772
Harald Welted2dc1de2009-08-08 13:15:07 +0200773 msg->trx = lchan->ts->trx;
774
775 return abis_rsl_sendmsg(msg);
776}
777
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200778int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
779{
780 lchan->state = state;
781 return 0;
782}
783
Harald Welte702d8702008-12-26 20:25:35 +0000784/* Chapter 8.4.2: Channel Activate Acknowledge */
785static int rsl_rx_chan_act_ack(struct msgb *msg)
786{
787 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
788
789 /* BTS has confirmed channel activation, we now need
790 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000791 if (rslh->ie_chan != RSL_IE_CHAN_NR)
792 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100793
Harald Welte8e93b792009-12-29 10:44:17 +0100794 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100795 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
796 gsm_lchan_name(msg->lchan),
797 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200798 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100799
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800800 if (msg->lchan->rqd_ref) {
801 rsl_send_imm_assignment(msg->lchan);
802 talloc_free(msg->lchan->rqd_ref);
803 msg->lchan->rqd_ref = NULL;
804 msg->lchan->rqd_ta = 0;
805 }
806
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100807 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100808
Harald Welte4b634542008-12-27 01:55:51 +0000809 return 0;
810}
Harald Welte702d8702008-12-26 20:25:35 +0000811
Harald Welte4b634542008-12-27 01:55:51 +0000812/* Chapter 8.4.3: Channel Activate NACK */
813static int rsl_rx_chan_act_nack(struct msgb *msg)
814{
Harald Welte6dab0552009-05-01 17:21:37 +0000815 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
816 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000817
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100818 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100819 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100820
Harald Welte6dab0552009-05-01 17:21:37 +0000821 /* BTS has rejected channel activation ?!? */
822 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000823 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000824
825 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100826 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200827 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100828 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200829 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100830 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200831 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100832 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200833 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200834
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100835 LOGPC(DRSL, LOGL_ERROR, "\n");
836
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100837 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100838
Harald Welte3073a9f2009-08-09 19:50:08 +0200839 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000840 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000841}
842
Harald Welte7f93cea2009-02-23 00:02:59 +0000843/* Chapter 8.4.4: Connection Failure Indication */
844static int rsl_rx_conn_fail(struct msgb *msg)
845{
846 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
847 struct tlv_parsed tp;
848
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100849 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100850 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100851 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000852
853 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
854
Harald Welte8830e072009-07-28 17:58:09 +0200855 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100856 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200857 TLVP_LEN(&tp, RSL_IE_CAUSE));
858
Harald Welte (local)fc057502009-12-26 22:33:09 +0100859 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000860 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200861 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800862 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000863}
864
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100865static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
866 const char *prefix)
867{
Harald Welte6739dfb2009-12-16 16:52:07 +0100868 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
869 prefix, rxlev2dbm(mru->full.rx_lev),
870 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100871 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
872 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
873}
874
875static void print_meas_rep(struct gsm_meas_rep *mr)
876{
Harald Welte6739dfb2009-12-16 16:52:07 +0100877 int i;
878
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100879 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
880
881 if (mr->flags & MEAS_REP_F_DL_DTX)
882 DEBUGPC(DMEAS, "DTXd ");
883
884 print_meas_rep_uni(&mr->ul, "ul");
885 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
886 if (mr->flags & MEAS_REP_F_MS_TO)
887 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
888
889 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100890 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100891 DEBUGPC(DMEAS, "L1_FPC=%u ",
892 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
893 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
894 }
895
896 if (mr->flags & MEAS_REP_F_UL_DTX)
897 DEBUGPC(DMEAS, "DTXu ");
898 if (mr->flags & MEAS_REP_F_BA1)
899 DEBUGPC(DMEAS, "BA1 ");
900 if (!(mr->flags & MEAS_REP_F_DL_VALID))
901 DEBUGPC(DMEAS, "NOT VALID ");
902 else
903 print_meas_rep_uni(&mr->dl, "dl");
904
905 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100906 if (mr->num_cell == 7)
907 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100908 for (i = 0; i < mr->num_cell; i++) {
909 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100910 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
911 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100912 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100913}
914
Harald Welte440fed02009-05-01 18:43:47 +0000915static int rsl_rx_meas_res(struct msgb *msg)
916{
917 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
918 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100919 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200920 uint8_t len;
921 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100922 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000923
Harald Welteb8bfc562009-12-21 13:27:11 +0100924 /* check if this channel is actually active */
925 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100926 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800927 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100928 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100929 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100930 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100931
Harald Welted12b0fd2009-12-15 21:36:05 +0100932 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100933 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100934
Harald Welte440fed02009-05-01 18:43:47 +0000935 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
936
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100937 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
938 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
939 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
940 return -EIO;
941
942 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100943 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100944
945 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
946 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
947 if (len >= 3) {
948 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100949 mr->flags |= MEAS_REP_F_DL_DTX;
950 mr->ul.full.rx_lev = val[0] & 0x3f;
951 mr->ul.sub.rx_lev = val[1] & 0x3f;
952 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
953 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000954 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100955
Harald Welted12b0fd2009-12-15 21:36:05 +0100956 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100957
958 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000959 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100960 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100961 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
962
Harald Weltefe9af262009-06-20 18:44:35 +0200963 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100964 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100965 mr->flags |= MEAS_REP_F_MS_L1;
966 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100967 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +0100968 mr->flags |= MEAS_REP_F_FPC;
969 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +0200970 }
Harald Weltef7c43522009-06-09 20:24:21 +0000971 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200972 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +0100973 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100974 if (rc < 0)
975 return rc;
976 }
977
Harald Welted12b0fd2009-12-15 21:36:05 +0100978 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +0000979
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100980 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +0100981
Harald Welte75d34a82009-05-23 06:11:13 +0000982 return 0;
Harald Welte440fed02009-05-01 18:43:47 +0000983}
984
Harald Welted011e8b2009-11-29 22:45:52 +0100985/* Chapter 8.4.7 */
986static int rsl_rx_hando_det(struct msgb *msg)
987{
988 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
989 struct tlv_parsed tp;
990
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100991 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +0100992
993 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
994
995 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
996 DEBUGPC(DRSL, "access delay = %u\n",
997 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
998 else
999 DEBUGPC(DRSL, "\n");
1000
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001001 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001002
1003 return 0;
1004}
1005
Harald Welte52b1f982008-12-23 20:25:15 +00001006static int abis_rsl_rx_dchan(struct msgb *msg)
1007{
Harald Welte8470bf22008-12-25 23:28:35 +00001008 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1009 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001010 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001011
Harald Welte8470bf22008-12-25 23:28:35 +00001012 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001013 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001014
Harald Welte8470bf22008-12-25 23:28:35 +00001015 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001016 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001017 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001018 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001019 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001020 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001021 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001022 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001023 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001024 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001025 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001026 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001027 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001028 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001029 case RSL_MT_HANDO_DET:
1030 rc = rsl_rx_hando_det(msg);
1031 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001032 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001033 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001034 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001035 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001036 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001037 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001038 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001039 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001040 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001041 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001042 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001043 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001044 break;
1045 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001046 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001047 break;
1048 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001049 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001050 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001051 break;
1052 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001053 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001054 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001055 case RSL_MT_PHY_CONTEXT_CONF:
1056 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001057 case RSL_MT_TALKER_DET:
1058 case RSL_MT_LISTENER_DET:
1059 case RSL_MT_REMOTE_CODEC_CONF_REP:
1060 case RSL_MT_MR_CODEC_MOD_ACK:
1061 case RSL_MT_MR_CODEC_MOD_NACK:
1062 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001063 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1064 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001065 break;
1066 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001067 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1068 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001069 return -EINVAL;
1070 }
Harald Weltef325eb42009-02-19 17:07:39 +00001071
Harald Welte8470bf22008-12-25 23:28:35 +00001072 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001073}
1074
Harald Welte702d8702008-12-26 20:25:35 +00001075static int rsl_rx_error_rep(struct msgb *msg)
1076{
1077 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001078 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001079
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001080 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001081
1082 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1083
1084 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001085 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001086 TLVP_LEN(&tp, RSL_IE_CAUSE));
1087
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001088 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001089
1090 return 0;
1091}
1092
Harald Welte52b1f982008-12-23 20:25:15 +00001093static int abis_rsl_rx_trx(struct msgb *msg)
1094{
Harald Welte702d8702008-12-26 20:25:35 +00001095 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001096 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001097
1098 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001099 case RSL_MT_ERROR_REPORT:
1100 rc = rsl_rx_error_rep(msg);
1101 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001102 case RSL_MT_RF_RES_IND:
1103 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001104 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001105 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001106 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001107 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001108 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1109 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001110 break;
Dieter Spaar16646022011-07-28 00:01:50 +02001111 case 0x42: /* Nokia specific: SI End ACK */
1112 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1113 break;
1114 case 0x43: /* Nokia specific: SI End NACK */
1115 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1116 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001117 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001118 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1119 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001120 return -EINVAL;
1121 }
Harald Welte8470bf22008-12-25 23:28:35 +00001122 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001123}
1124
Harald Welteb7e81162009-08-10 00:26:10 +02001125/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1126static void t3101_expired(void *data)
1127{
1128 struct gsm_lchan *lchan = data;
1129
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001130 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001131}
1132
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001133/* If T3111 expires, we will send the RF Channel Request */
1134static void t3111_expired(void *data)
1135{
1136 struct gsm_lchan *lchan = data;
1137
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001138 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001139}
1140
laforgecfa4a012010-06-21 12:08:52 +02001141#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1142
Harald Welte2862dca2010-12-23 14:39:29 +01001143/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1144static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1145 unsigned int num_req_refs,
1146 struct gsm48_req_ref *rqd_refs,
1147 uint8_t wait_ind)
1148{
1149 uint8_t buf[GSM_MACBLOCK_LEN];
1150 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1151
1152 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1153 memset(iar, 0, sizeof(*iar));
1154 iar->proto_discr = GSM48_PDISC_RR;
1155 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1156 iar->page_mode = GSM48_PM_SAME;
1157
1158 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1159 iar->wait_ind1 = wait_ind;
1160
1161 if (num_req_refs >= 2)
1162 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1163 else
1164 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1165 iar->wait_ind2 = wait_ind;
1166
1167 if (num_req_refs >= 3)
1168 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1169 else
1170 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1171 iar->wait_ind3 = wait_ind;
1172
1173 if (num_req_refs >= 4)
1174 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1175 else
1176 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1177 iar->wait_ind4 = wait_ind;
1178
1179 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1180}
1181
Harald Welte8470bf22008-12-25 23:28:35 +00001182/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001183static int rsl_rx_chan_rqd(struct msgb *msg)
1184{
Harald Welte702d8702008-12-26 20:25:35 +00001185 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001186 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1187 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001188 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001189 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001190 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001191 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001192 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001193
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001194 uint16_t arfcn;
1195 uint8_t ts_number, subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001196
Harald Welte8470bf22008-12-25 23:28:35 +00001197 /* parse request reference to be used in immediate assign */
1198 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1199 return -EINVAL;
1200
1201 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1202
1203 /* parse access delay and use as TA */
1204 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1205 return -EINVAL;
1206 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1207
1208 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1209 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001210 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1211 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001212
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001213 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001214
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001215 /*
1216 * We want LOCATION UPDATES to succeed and will assign a TCH
1217 * if we have no SDCCH available.
1218 */
1219 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1220
Harald Welte8470bf22008-12-25 23:28:35 +00001221 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001222 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001223 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001224 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001225 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001226 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001227 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1228 if (bts->network->T3122)
1229 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001230 return -ENOMEM;
1231 }
1232
Harald Welte8e93b792009-12-29 10:44:17 +01001233 if (lchan->state != LCHAN_S_NONE)
1234 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001235 "in state %s\n", gsm_lchan_name(lchan),
1236 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001237 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001238
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001239 /* save the RACH data as we need it after the CHAN ACT ACK */
1240 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1241 if (!lchan->rqd_ref) {
1242 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1243 lchan_free(lchan);
1244 return -ENOMEM;
1245 }
1246
1247 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1248 lchan->rqd_ta = rqd_ta;
1249
Harald Welte8470bf22008-12-25 23:28:35 +00001250 ts_number = lchan->ts->nr;
1251 arfcn = lchan->ts->trx->arfcn;
1252 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001253
Harald Welte08d91a52009-08-30 15:37:11 +09001254 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001255 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001256 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001257 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001258 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001259
1260 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001261 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001262
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001263 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1264 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1265 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1266 rqd_ref->ra);
1267 return 0;
1268}
1269
1270static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1271{
1272 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001273 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001274 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1275
Harald Welte52b1f982008-12-23 20:25:15 +00001276 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001277 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001278 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001279 ia->proto_discr = GSM48_PDISC_RR;
1280 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1281 ia->page_mode = GSM48_PM_SAME;
1282 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001283
Harald Welte8470bf22008-12-25 23:28:35 +00001284 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001285 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1286 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001287 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001288 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001289 } else {
laforge09108bf2010-06-20 15:18:46 +02001290 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1291 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001292 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001293 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1294 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001295
Harald Welteb7e81162009-08-10 00:26:10 +02001296 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1297 lchan->T3101.cb = t3101_expired;
1298 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001299 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001300
Harald Welte52b1f982008-12-23 20:25:15 +00001301 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001302 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001303}
1304
Harald Welteea280442009-02-02 22:29:56 +00001305/* MS has requested a channel on the RACH */
1306static int rsl_rx_ccch_load(struct msgb *msg)
1307{
1308 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001309 uint16_t pg_buf_space;
1310 uint16_t rach_slot_count = -1;
1311 uint16_t rach_busy_count = -1;
1312 uint16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001313
1314 switch (rslh->data[0]) {
1315 case RSL_IE_PAGING_LOAD:
1316 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001317 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1318 /* paging load below configured threshold, use 50 as default */
1319 pg_buf_space = 50;
1320 }
Holger Freyther392209c2009-02-10 00:06:19 +00001321 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001322 break;
1323 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001324 if (msg->data_len >= 7) {
1325 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1326 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1327 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1328 }
Harald Welteea280442009-02-02 22:29:56 +00001329 break;
1330 default:
1331 break;
1332 }
1333
1334 return 0;
1335}
1336
Harald Welte52b1f982008-12-23 20:25:15 +00001337static int abis_rsl_rx_cchan(struct msgb *msg)
1338{
Harald Welteea280442009-02-02 22:29:56 +00001339 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001340 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001341
Harald Welte8470bf22008-12-25 23:28:35 +00001342 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1343
1344 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001345 case RSL_MT_CHAN_RQD:
1346 /* MS has requested a channel on the RACH */
1347 rc = rsl_rx_chan_rqd(msg);
1348 break;
Harald Welteea280442009-02-02 22:29:56 +00001349 case RSL_MT_CCCH_LOAD_IND:
1350 /* current load on the CCCH */
1351 rc = rsl_rx_ccch_load(msg);
1352 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001353 case RSL_MT_DELETE_IND:
1354 /* CCCH overloaded, IMM_ASSIGN was dropped */
1355 case RSL_MT_CBCH_LOAD_IND:
1356 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001357 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1358 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001359 break;
1360 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001361 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1362 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001363 return -EINVAL;
1364 }
Harald Welte8470bf22008-12-25 23:28:35 +00001365
1366 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001367}
1368
Harald Welte4b634542008-12-27 01:55:51 +00001369static int rsl_rx_rll_err_ind(struct msgb *msg)
1370{
1371 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001372 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001373
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001374 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001375 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001376 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001377
1378 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001379
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001380 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001381 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001382 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001383 }
Harald Welte81543bc2009-07-04 09:40:05 +02001384
Harald Welte4b634542008-12-27 01:55:51 +00001385 return 0;
1386}
Harald Weltef325eb42009-02-19 17:07:39 +00001387
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001388static void rsl_handle_release(struct gsm_lchan *lchan)
1389{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001390 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001391 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001392
1393 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001394 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001395 return;
1396
1397 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1398 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1399 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001400 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001401 gsm_lchan_name(lchan), sapi);
1402 return;
1403 }
1404
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001405
1406
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001407 /* wait a bit to send the RF Channel Release */
1408 lchan->T3111.cb = t3111_expired;
1409 lchan->T3111.data = lchan;
1410 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001411 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001412}
1413
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001414/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001415 0x02, 0x06,
1416 0x01, 0x20,
1417 0x02, 0x00,
1418 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1419
1420static int abis_rsl_rx_rll(struct msgb *msg)
1421{
1422 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001423 int rc = 0;
1424 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001425 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001426
1427 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001428 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001429 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001430
1431 switch (rllh->c.msg_type) {
1432 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001433 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001434 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001435 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1436 rllh->data[0] == RSL_IE_L3_INFO) {
1437 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001438 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001439 }
Harald Welte52b1f982008-12-23 20:25:15 +00001440 break;
1441 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001442 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001443 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001444 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001445 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001446 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001447 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1448 rllh->data[0] == RSL_IE_L3_INFO) {
1449 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001450 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001451 }
Harald Welte52b1f982008-12-23 20:25:15 +00001452 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001453 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001454 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001455 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001456 rll_indication(msg->lchan, rllh->link_id,
1457 BSC_RLLR_IND_EST_CONF);
1458 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001459 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001460 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001461 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001462 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001463 rll_indication(msg->lchan, rllh->link_id,
1464 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001465 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001466 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001467 break;
1468 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001469 /* BTS informs us of having received UA from MS,
1470 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001471 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001472 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001473 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001474 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001475 break;
1476 case RSL_MT_ERROR_IND:
1477 rc = rsl_rx_rll_err_ind(msg);
1478 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001479 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001480 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1481 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001482 break;
1483 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001484 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1485 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001486 }
Harald Welte8470bf22008-12-25 23:28:35 +00001487 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001488}
1489
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001490static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001491{
Harald Welte0603c9d2009-12-02 01:58:23 +05301492 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001493 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301494 switch (lchan->type) {
1495 case GSM_LCHAN_TCH_F:
1496 return 0x00;
1497 case GSM_LCHAN_TCH_H:
1498 return 0x03;
1499 default:
1500 break;
1501 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001502 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301503 switch (lchan->type) {
1504 case GSM_LCHAN_TCH_F:
1505 return 0x01;
1506 /* there's no half-rate EFR */
1507 default:
1508 break;
1509 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001510 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301511 switch (lchan->type) {
1512 case GSM_LCHAN_TCH_F:
1513 return 0x02;
1514 case GSM_LCHAN_TCH_H:
1515 return 0x05;
1516 default:
1517 break;
1518 }
1519 default:
1520 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001521 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001522 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301523 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001524 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001525}
1526
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001527static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001528{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001529 struct gsm_network *net = lchan->ts->trx->bts->network;
1530
1531 /* allow to hardcode the rtp payload */
1532 if (net->hardcoded_rtp_payload != 0)
1533 return net->hardcoded_rtp_payload;
1534
Sylvain Munautb54dda42009-12-20 22:06:40 +01001535 switch (lchan->tch_mode) {
1536 case GSM48_CMODE_SPEECH_V1:
1537 switch (lchan->type) {
1538 case GSM_LCHAN_TCH_F:
1539 return RTP_PT_GSM_FULL;
1540 case GSM_LCHAN_TCH_H:
1541 return RTP_PT_GSM_HALF;
1542 default:
1543 break;
1544 }
1545 case GSM48_CMODE_SPEECH_EFR:
1546 switch (lchan->type) {
1547 case GSM_LCHAN_TCH_F:
1548 return RTP_PT_GSM_EFR;
1549 /* there's no half-rate EFR */
1550 default:
1551 break;
1552 }
1553 case GSM48_CMODE_SPEECH_AMR:
1554 switch (lchan->type) {
1555 case GSM_LCHAN_TCH_F:
1556 return RTP_PT_AMR_FULL;
1557 case GSM_LCHAN_TCH_H:
1558 return RTP_PT_AMR_HALF;
1559 default:
1560 break;
1561 }
1562 default:
1563 break;
1564 }
1565 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1566 "tch_mode == 0x%02x\n & lchan_type == %d",
1567 lchan->tch_mode, lchan->type);
1568 return 0;
1569}
1570
Harald Welte75099262009-02-16 21:12:08 +00001571/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001572static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1573{
1574 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001575 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001576
1577 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001578 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001579 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1580 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1581 }
1582
1583 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001584 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001585 port = ntohs(port);
1586 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1587 lchan->abis_ip.bound_port = port;
1588 }
1589
1590 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001591 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001592 conn_id = ntohs(conn_id);
1593 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1594 lchan->abis_ip.conn_id = conn_id;
1595 }
1596
1597 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1598 lchan->abis_ip.rtp_payload2 =
1599 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1600 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1601 lchan->abis_ip.rtp_payload2);
1602 }
1603
1604 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1605 lchan->abis_ip.speech_mode =
1606 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1607 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1608 lchan->abis_ip.speech_mode);
1609 }
1610
1611 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001612 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001613 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1614 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1615 }
1616
1617 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001618 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001619 port = ntohs(port);
1620 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1621 lchan->abis_ip.connect_port = port;
1622 }
1623}
1624
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001625int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001626{
1627 struct msgb *msg = rsl_msgb_alloc();
1628 struct abis_rsl_dchan_hdr *dh;
1629
1630 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001631 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001632 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001633 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001634
Harald Weltef4e79f22009-07-28 18:11:56 +02001635 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001636 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001637 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001638 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001639 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001640
Sylvain Munautb54dda42009-12-20 22:06:40 +01001641 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1642 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1643 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001644
Harald Welte75099262009-02-16 21:12:08 +00001645 msg->trx = lchan->ts->trx;
1646
1647 return abis_rsl_sendmsg(msg);
1648}
1649
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001650int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1651 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001652{
1653 struct msgb *msg = rsl_msgb_alloc();
1654 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001655 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001656 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001657
1658 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001659 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001660 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001661 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001662
Harald Welte5e3d91b2009-12-19 16:42:06 +01001663 /* we need to store these now as MDCX_ACK does not return them :( */
1664 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1665 lchan->abis_ip.connect_port = port;
1666 lchan->abis_ip.connect_ip = ip;
1667
Harald Welte58ca5b72009-07-29 12:12:18 +02001668 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001669 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001670 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001671
Harald Weltef4e79f22009-07-28 18:11:56 +02001672 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001673 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1674 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1675 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1676 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001677
Harald Welte5e3d91b2009-12-19 16:42:06 +01001678 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1679 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001680 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001681 *att_ip = ia.s_addr;
1682 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1683 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001684 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001685 if (rtp_payload2)
1686 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1687
Harald Welte75099262009-02-16 21:12:08 +00001688 msg->trx = lchan->ts->trx;
1689
1690 return abis_rsl_sendmsg(msg);
1691}
1692
Harald Weltea72273e2009-12-20 16:51:09 +01001693/* tell BTS to connect RTP stream to our local RTP socket */
1694int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1695{
1696 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1697 int rc;
1698
1699 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1700 ntohs(rs->rtp.sin_local.sin_port),
1701 /* FIXME: use RTP payload of bound socket, not BTS*/
1702 lchan->abis_ip.rtp_payload2);
1703
1704 return rc;
1705}
1706
Harald Welte53cd7ac2010-12-23 12:59:52 +01001707int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001708{
1709 struct msgb *msg = rsl_msgb_alloc();
1710 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001711 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001712
1713 if (act)
1714 msg_type = RSL_MT_IPAC_PDCH_ACT;
1715 else
1716 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001717
1718 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001719 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001720 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001721 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001722
Harald Welte53cd7ac2010-12-23 12:59:52 +01001723 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001724 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001725
Harald Welte53cd7ac2010-12-23 12:59:52 +01001726 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001727
1728 return abis_rsl_sendmsg(msg);
1729}
1730
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001731static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001732{
1733 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1734 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301735 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001736
1737 /* the BTS has acknowledged a local bind, it now tells us the IP
1738 * address and port number to which it has bound the given logical
1739 * channel */
1740
1741 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1742 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1743 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001744 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001745 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001746 return -EINVAL;
1747 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001748
Harald Welte5e3d91b2009-12-19 16:42:06 +01001749 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001750
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001751 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001752
Harald Welte75099262009-02-16 21:12:08 +00001753 return 0;
1754}
1755
Harald Welte5e3d91b2009-12-19 16:42:06 +01001756static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1757{
1758 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1759 struct tlv_parsed tv;
1760 struct gsm_lchan *lchan = msg->lchan;
1761
1762 /* the BTS has acknowledged a remote connect request and
1763 * it now tells us the IP address and port number to which it has
1764 * connected the given logical channel */
1765
1766 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1767 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001768 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001769
1770 return 0;
1771}
1772
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001773static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001774{
1775 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1776 struct tlv_parsed tv;
1777
1778 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001779
Harald Welte8830e072009-07-28 17:58:09 +02001780 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001781 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001782 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001783
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001784 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001785
Harald Welte75099262009-02-16 21:12:08 +00001786 return 0;
1787}
1788
1789static int abis_rsl_rx_ipacc(struct msgb *msg)
1790{
1791 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001792 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001793 int rc = 0;
1794
1795 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001796 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001797
1798 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001799 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001800 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001801 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001802 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001803 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001804 /* somehow the BTS was unable to bind the lchan to its local
1805 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001806 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001807 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001808 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001809 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001810 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001811 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001812 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001813 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001814 /* somehow the BTS was unable to connect the lchan to a remote
1815 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001816 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001817 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001818 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001819 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001820 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001821 break;
1822 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001823 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001824 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001825 break;
1826 }
Harald Welte6dab0552009-05-01 17:21:37 +00001827 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001828
1829 return rc;
1830}
1831
1832
Harald Welte52b1f982008-12-23 20:25:15 +00001833/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001834int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001835{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001836 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001837 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001838
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001839 if (!msg) {
1840 DEBUGP(DRSL, "Empty RSL msg?..\n");
1841 return -1;
1842 }
1843
1844 if (msgb_l2len(msg) < sizeof(*rslh)) {
1845 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1846 return -1;
1847 }
1848
1849 rslh = msgb_l2(msg);
1850
Harald Welte52b1f982008-12-23 20:25:15 +00001851 switch (rslh->msg_discr & 0xfe) {
1852 case ABIS_RSL_MDISC_RLL:
1853 rc = abis_rsl_rx_rll(msg);
1854 break;
1855 case ABIS_RSL_MDISC_DED_CHAN:
1856 rc = abis_rsl_rx_dchan(msg);
1857 break;
1858 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001859 rc = abis_rsl_rx_cchan(msg);
1860 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001861 case ABIS_RSL_MDISC_TRX:
1862 rc = abis_rsl_rx_trx(msg);
1863 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001864 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001865 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001866 rslh->msg_discr);
1867 break;
Harald Welte75099262009-02-16 21:12:08 +00001868 case ABIS_RSL_MDISC_IPACCESS:
1869 rc = abis_rsl_rx_ipacc(msg);
1870 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001871 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001872 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1873 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001874 return -EINVAL;
1875 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001876 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001877 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001878}
Holger Freyther3b72a892009-02-04 00:31:39 +00001879
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001880int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1881 uint8_t cb_command, const uint8_t *data, int len)
1882{
1883 struct abis_rsl_dchan_hdr *dh;
1884 struct msgb *cb_cmd;
1885
1886 cb_cmd = rsl_msgb_alloc();
1887 if (!cb_cmd)
1888 return -1;
1889
1890 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1891 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1892 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1893
1894 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1895 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1896
1897 cb_cmd->trx = bts->c0;
1898
1899 return abis_rsl_sendmsg(cb_cmd);
1900}
Dieter Spaar16646022011-07-28 00:01:50 +02001901
1902int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
1903{
1904 struct abis_rsl_common_hdr *ch;
1905 struct msgb *msg = rsl_msgb_alloc();
1906
1907 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1908 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1909 ch->msg_type = 0x40; /* Nokia SI Begin */
1910
1911 msg->trx = trx;
1912
1913 return abis_rsl_sendmsg(msg);
1914}
1915
1916int rsl_nokia_si_end(struct gsm_bts_trx *trx)
1917{
1918 struct abis_rsl_common_hdr *ch;
1919 struct msgb *msg = rsl_msgb_alloc();
1920
1921 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1922 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1923 ch->msg_type = 0x41; /* Nokia SI End */
1924
1925 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
1926
1927 msg->trx = trx;
1928
1929 return abis_rsl_sendmsg(msg);
1930}
1931
1932int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
1933{
1934 struct abis_rsl_common_hdr *ch;
1935 struct msgb *msg = rsl_msgb_alloc();
1936
1937 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1938 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1939 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
1940
1941 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
1942 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
1943
1944 msg->trx = trx;
1945
1946 return abis_rsl_sendmsg(msg);
1947}