blob: 029b62b7f69d791afb5d2500be7819c0e6959317 [file] [log] [blame]
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte59b04682009-06-10 05:40:52 +08002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Weltea22d36b2010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte59b04682009-06-10 05:40:52 +08005 *
6 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
Harald Welte0e3e88e2011-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 Welte59b04682009-06-10 05:40:52 +080011 * (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 Welte0e3e88e2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte59b04682009-06-10 05:40:52 +080017 *
Harald Welte0e3e88e2011-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 Welte59b04682009-06-10 05:40:52 +080020 *
21 */
22
23#include <stdio.h>
24#include <stdlib.h>
25#include <errno.h>
Harald Welte59b04682009-06-10 05:40:52 +080026#include <netinet/in.h>
27#include <arpa/inet.h>
28
29#include <openbsc/gsm_data.h>
30#include <openbsc/gsm_04_08.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010031#include <osmocom/gsm/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080032#include <openbsc/abis_rsl.h>
33#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020034#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080035#include <openbsc/debug.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010036#include <osmocom/gsm/tlv.h>
Harald Welte59b04682009-06-10 05:40:52 +080037#include <openbsc/paging.h>
38#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010039#include <openbsc/meas_rep.h>
Harald Welte50517742009-12-20 15:42:44 +010040#include <openbsc/rtp_proxy.h>
Pablo Neira Ayuso42e41df2011-08-17 22:44:07 +020041#include <osmocom/abis/e1_input.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010042#include <osmocom/gsm/rsl.h>
Pablo Neira Ayusodd5fff42011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080044
Harald Welte59b04682009-06-10 05:40:52 +080045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
47
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +080048static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
49
Holger Hans Peter Freyther645b3832010-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 Ayusoef717c62011-05-06 12:12:31 +020056 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +010057}
58
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020059static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080060{
61 /* mask off the transparent bit ? */
62 msg_type &= 0xfe;
63
64 if ((msg_type & 0xf0) == 0x00)
65 return ABIS_RSL_MDISC_RLL;
66 if ((msg_type & 0xf0) == 0x10) {
67 if (msg_type >= 0x19 && msg_type <= 0x22)
68 return ABIS_RSL_MDISC_TRX;
69 else
70 return ABIS_RSL_MDISC_COM_CHAN;
71 }
72 if ((msg_type & 0xe0) == 0x20)
73 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 Freyther7eb8a9a2011-04-18 17:04:00 +020079 uint8_t msg_type)
Harald Welte59b04682009-06-10 05:40:52 +080080{
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 Welte59b04682009-06-10 05:40:52 +080086/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +020087struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte59b04682009-06-10 05:40:52 +080088{
89 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-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 Welte59b04682009-06-10 05:40:52 +080093 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
94
95 if (cbits == 0x01) {
96 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-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 Weltecf2ec4a2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800101 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 Weltecf2ec4a2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800106 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 Weltecf2ec4a2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800111 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 Weltecf2ec4a2009-12-17 23:10:46 +0100115 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800116 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 Weltecf2ec4a2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800122 chan_nr, ts->pchan);
123 /* FIXME: we should not return first sdcch4 !!! */
124 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100125 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800126 return NULL;
127 }
128
129 lchan = &ts->lchan[lch_idx];
Harald Welte51d2a592010-03-26 21:28:59 +0800130 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther1a95fa82010-06-28 15:47:12 +0800131 if (lchan->conn)
132 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800133
134 return lchan;
135}
136
Harald Welte59b04682009-06-10 05:40:52 +0800137/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200138uint64_t str_to_imsi(const char *imsi_str)
Harald Welte59b04682009-06-10 05:40:52 +0800139{
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200140 uint64_t ret;
Harald Welte59b04682009-06-10 05:40:52 +0800141
142 ret = strtoull(imsi_str, NULL, 10);
143
144 return ret;
145}
146
Harald Welte59b04682009-06-10 05:40:52 +0800147static struct msgb *rsl_msgb_alloc(void)
148{
Harald Welte9cfc9352009-06-26 19:39:35 +0200149 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
150 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800151}
152
153#define MACBLOCK_SIZE 23
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200154static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800155{
156 memcpy(out, in, len);
157
158 if (len < MACBLOCK_SIZE)
159 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
160}
161
Harald Welted2dd9de2009-08-30 15:37:11 +0900162/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200163static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welted2dd9de2009-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 Freyther7eb8a9a2011-04-18 17:04:00 +0200171static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200172{
Harald Welte59b04682009-06-10 05:40:52 +0800173 int i;
174
Harald Weltede4477a2009-12-24 12:20:20 +0100175 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200176 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200177 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100178 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800179}
180
Harald Welte32951ea2011-08-10 23:26:33 +0200181static void lchan_act_tmr_cb(void *data)
182{
183 struct gsm_lchan *lchan = data;
184
185 LOGP(DRSL, LOGL_NOTICE, "%s Timeout during activation!\n",
186 gsm_lchan_name(lchan));
187
Daniel Willmann2731e732011-08-11 04:44:12 +0200188 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
189 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200190}
191
192static void lchan_deact_tmr_cb(void *data)
193{
194 struct gsm_lchan *lchan = data;
195
196 LOGP(DRSL, LOGL_NOTICE, "%s Timeout during deactivation!\n",
197 gsm_lchan_name(lchan));
198
Daniel Willmann2731e732011-08-11 04:44:12 +0200199 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
200 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200201}
202
203
Harald Welte59b04682009-06-10 05:40:52 +0800204/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200205int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
206 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800207{
208 struct abis_rsl_dchan_hdr *dh;
209 struct msgb *msg = rsl_msgb_alloc();
210
211 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
212 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
213 dh->chan_nr = RSL_CHAN_BCCH;
214
215 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
216 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
217
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200218 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800219
220 return abis_rsl_sendmsg(msg);
221}
222
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200223int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
224 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800225{
226 struct abis_rsl_common_hdr *ch;
227 struct msgb *msg = rsl_msgb_alloc();
228
229 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
230 ch->msg_discr = ABIS_RSL_MDISC_TRX;
231 ch->msg_type = RSL_MT_SACCH_FILL;
232
233 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
234 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
235
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200236 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800237
238 return abis_rsl_sendmsg(msg);
239}
240
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200241int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
242 const uint8_t *data, int len)
Harald Welte10b7d8f2011-01-13 23:16:03 +0100243{
244 struct abis_rsl_dchan_hdr *dh;
245 struct msgb *msg = rsl_msgb_alloc();
Harald Weltee6d51f92011-06-25 10:02:33 +0200246 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte10b7d8f2011-01-13 23:16:03 +0100247
248 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
249 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
250 dh->chan_nr = chan_nr;
251
252 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
253 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
254
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200255 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte10b7d8f2011-01-13 23:16:03 +0100256
257 return abis_rsl_sendmsg(msg);
258}
259
Harald Welte91afe4c2009-06-20 18:15:19 +0200260int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
261{
262 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200263 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200264 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200265
266 db = abs(db);
267 if (db > 30)
268 return -EINVAL;
269
Harald Welteed831842009-06-27 03:09:08 +0200270 msg = rsl_msgb_alloc();
271
Harald Welte91afe4c2009-06-20 18:15:19 +0200272 lchan->bs_power = db/2;
273 if (fpc)
274 lchan->bs_power |= 0x10;
275
276 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
277 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
278 dh->chan_nr = chan_nr;
279
280 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
281
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200282 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200283
284 return abis_rsl_sendmsg(msg);
285}
286
Harald Welte91afe4c2009-06-20 18:15:19 +0200287int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
288{
289 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200290 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200291 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200292 int ctl_lvl;
293
Harald Weltec4dcda02009-08-09 14:45:18 +0200294 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200295 if (ctl_lvl < 0)
296 return ctl_lvl;
297
Harald Welteed831842009-06-27 03:09:08 +0200298 msg = rsl_msgb_alloc();
299
Harald Welte91afe4c2009-06-20 18:15:19 +0200300 lchan->ms_power = ctl_lvl;
301
302 if (fpc)
303 lchan->ms_power |= 0x20;
304
305 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
306 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
307 dh->chan_nr = chan_nr;
308
309 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
310
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200311 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200312
313 return abis_rsl_sendmsg(msg);
314}
315
Harald Welte39274f42009-07-29 15:41:29 +0200316static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
317 struct gsm_lchan *lchan)
318{
319 memset(cm, 0, sizeof(cm));
320
321 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800322 if (lchan->ts->trx->bts->network->dtx_enabled)
323 cm->dtx_dtu = 0x03;
324 else
325 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200326
327 /* set TCH Speech/Data */
328 cm->spd_ind = lchan->rsl_cmode;
329
Harald Welte951e3512009-11-27 08:55:16 +0100330 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
331 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100332 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100333 "but tch_mode != signalling\n");
334
Harald Welte39274f42009-07-29 15:41:29 +0200335 switch (lchan->type) {
336 case GSM_LCHAN_SDCCH:
337 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
338 break;
339 case GSM_LCHAN_TCH_F:
340 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
341 break;
342 case GSM_LCHAN_TCH_H:
343 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
344 break;
345 case GSM_LCHAN_NONE:
346 case GSM_LCHAN_UNKNOWN:
347 default:
348 return -EINVAL;
349 }
350
351 switch (lchan->tch_mode) {
352 case GSM48_CMODE_SIGN:
353 cm->chan_rate = 0;
354 break;
355 case GSM48_CMODE_SPEECH_V1:
356 cm->chan_rate = RSL_CMOD_SP_GSM1;
357 break;
358 case GSM48_CMODE_SPEECH_EFR:
359 cm->chan_rate = RSL_CMOD_SP_GSM2;
360 break;
361 case GSM48_CMODE_SPEECH_AMR:
362 cm->chan_rate = RSL_CMOD_SP_GSM3;
363 break;
364 case GSM48_CMODE_DATA_14k5:
365 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
366 break;
367 case GSM48_CMODE_DATA_12k0:
368 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
369 break;
370 case GSM48_CMODE_DATA_6k0:
371 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
372 break;
373 default:
374 return -EINVAL;
375 }
376
377 return 0;
378}
379
Harald Welte59b04682009-06-10 05:40:52 +0800380/* Chapter 8.4.1 */
381#if 0
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200382int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
383 uint8_t act_type,
Harald Welte59b04682009-06-10 05:40:52 +0800384 struct rsl_ie_chan_mode *chan_mode,
385 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200386 uint8_t bs_power, uint8_t ms_power,
387 uint8_t ta)
Harald Welte59b04682009-06-10 05:40:52 +0800388{
389 struct abis_rsl_dchan_hdr *dh;
390 struct msgb *msg = rsl_msgb_alloc();
391
392 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
393 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
394 dh->chan_nr = chan_nr;
395
396 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
397 /* For compatibility with Phase 1 */
398 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200399 (uint8_t *) chan_mode);
Harald Welte59b04682009-06-10 05:40:52 +0800400 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200401 (uint8_t *) chan_ident);
Harald Welte59b04682009-06-10 05:40:52 +0800402#if 0
403 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200404 (uint8_t *) &encr_info);
Harald Welte59b04682009-06-10 05:40:52 +0800405#endif
406 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
407 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
408 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
409
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200410 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800411
412 return abis_rsl_sendmsg(msg);
413}
414#endif
415
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200416int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
417 uint8_t ta, uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800418{
419 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200420 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200421 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200422 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800423
Harald Weltee6d51f92011-06-25 10:02:33 +0200424 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800425 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200426 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800427
Harald Welte39274f42009-07-29 15:41:29 +0200428 rc = channel_mode_from_lchan(&cm, lchan);
429 if (rc < 0)
430 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800431
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800432 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200433 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800434
Harald Welteed831842009-06-27 03:09:08 +0200435 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800436 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
437 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
438 dh->chan_nr = chan_nr;
439
440 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800441 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200442 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800443
444 /*
445 * The Channel Identification is needed for Phase1 phones
446 * and it contains the GSM48 Channel Description and the
447 * Mobile Allocation. The GSM 08.58 asks for the Mobile
448 * Allocation to have a length of zero. We are using the
449 * msgb_l3len to calculate the length of both messages.
450 */
laforgef723cf02010-06-20 21:38:19 +0200451 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200452 len = msgb_put(msg, 1);
Dieter Spaar18a55f62011-07-27 23:40:33 +0200453 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800454
455 if (lchan->ts->hopping.enabled)
456 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
457 lchan->ts->hopping.ma_data);
458 else
459 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800460
461 /* update the calculated size */
462 msg->l3h = len + 1;
463 *len = msgb_l3len(msg);
464
Harald Welted2dd9de2009-08-30 15:37:11 +0900465 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200466 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900467 rc = build_encr_info(encr_info, lchan);
468 if (rc > 0)
469 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
470 }
471
Harald Welteb90d7bd2009-12-17 00:31:10 +0100472 switch (act_type) {
473 case RSL_ACT_INTER_ASYNC:
474 case RSL_ACT_INTER_SYNC:
475 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
476 break;
477 default:
478 break;
479 }
480
Harald Welte59b04682009-06-10 05:40:52 +0800481 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
482 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
483 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
484
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100485 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
486 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200487 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100488
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200489 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800490
491 return abis_rsl_sendmsg(msg);
492}
493
Harald Welte8e770492009-07-29 11:38:15 +0200494/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800495int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
496{
497 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200498 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200499 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800500
Harald Weltee6d51f92011-06-25 10:02:33 +0200501 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800502 struct rsl_ie_chan_mode cm;
503
Harald Welte39274f42009-07-29 15:41:29 +0200504 rc = channel_mode_from_lchan(&cm, lchan);
505 if (rc < 0)
506 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800507
Harald Welteed831842009-06-27 03:09:08 +0200508 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800509 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
510 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
511 dh->chan_nr = chan_nr;
512
513 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200514 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900515
516 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200517 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900518 rc = build_encr_info(encr_info, lchan);
519 if (rc > 0)
520 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
521 }
522
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100523 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
524 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200525 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100526 }
527
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200528 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dd9de2009-08-30 15:37:11 +0900529
530 return abis_rsl_sendmsg(msg);
531}
532
533/* Chapter 8.4.6: Send the encryption command with given L3 info */
534int rsl_encryption_cmd(struct msgb *msg)
535{
536 struct abis_rsl_dchan_hdr *dh;
537 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200538 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200539 uint8_t encr_info[MAX_A5_KEY_LEN+2];
540 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900541 int rc;
542
543 /* First push the L3 IE tag and length */
544 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
545
546 /* then the link identifier (SAPI0, main sign link) */
547 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
548
549 /* then encryption information */
550 rc = build_encr_info(encr_info, lchan);
551 if (rc <= 0)
552 return rc;
553 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
554
555 /* and finally the DCHAN header */
556 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
557 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
558 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800559
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200560 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800561
562 return abis_rsl_sendmsg(msg);
563}
564
Harald Welte85a163c2009-08-10 11:43:22 +0200565/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200566int rsl_deact_sacch(struct gsm_lchan *lchan)
567{
568 struct abis_rsl_dchan_hdr *dh;
569 struct msgb *msg = rsl_msgb_alloc();
570
571 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
572 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200573 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200574
575 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200576 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteafe3c232009-07-19 18:36:49 +0200577
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100578 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200579
580 return abis_rsl_sendmsg(msg);
581}
582
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800583static void error_timeout_cb(void *data)
584{
585 struct gsm_lchan *lchan = data;
586 if (lchan->state != LCHAN_S_REL_ERR) {
587 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
588 gsm_lchan_name(lchan), lchan->state);
589 return;
590 }
591
592 /* go back to the none state */
593 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800594 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800595}
596
Harald Welte08011e22011-03-04 13:41:31 +0100597static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
598
Harald Welte85a163c2009-08-10 11:43:22 +0200599/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800600static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800601{
602 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800603 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100604 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800605
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800606 if (lchan->state == LCHAN_S_REL_ERR) {
607 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
608 gsm_lchan_name(lchan));
609 return -1;
610 }
611
612 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800613 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
614 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200615 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800616
617 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200618 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800619
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800620 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
621
622 if (error) {
623 /*
624 * the nanoBTS sends RLL release indications after the channel release. This can
625 * be a problem when we have reassigned the channel to someone else and then can
626 * not figure out who used this channel.
627 */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200628 struct e1inp_sign_link *sign_link = msg->dst;
629
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800630 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800631 lchan->error_timer.data = lchan;
632 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200633 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200634 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800635 }
Harald Welte59b04682009-06-10 05:40:52 +0800636
Harald Welte32951ea2011-08-10 23:26:33 +0200637 /* Start another timer or assume the BTS sends a ACK/NACK? */
638 lchan->act_timer.cb = lchan_deact_tmr_cb;
639 lchan->act_timer.data = lchan;
640 osmo_timer_schedule(&lchan->act_timer, 4, 0);
641
Harald Welte08011e22011-03-04 13:41:31 +0100642 rc = abis_rsl_sendmsg(msg);
643
Harald Welte85a163c2009-08-10 11:43:22 +0200644 /* BTS will respond by RF CHAN REL ACK */
Harald Welte6bddd822011-01-14 23:18:59 +0100645#ifdef HSL_SR_1_0
Harald Welte08011e22011-03-04 13:41:31 +0100646 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
647 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
648 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte6bddd822011-01-14 23:18:59 +0100649#endif
Harald Welte08011e22011-03-04 13:41:31 +0100650
651 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800652}
653
Harald Welte9773f6c2011-01-14 14:16:16 +0100654static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
655{
656
657 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
658
Harald Welte32951ea2011-08-10 23:26:33 +0200659 osmo_timer_del(&lchan->act_timer);
660
Harald Welte9773f6c2011-01-14 14:16:16 +0100661 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
662 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
663 gsm_lchan_name(lchan),
664 gsm_lchans_name(lchan->state));
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200665 osmo_timer_del(&lchan->T3111);
Harald Welte9773f6c2011-01-14 14:16:16 +0100666 /* we have an error timer pending to release that */
667 if (lchan->state != LCHAN_S_REL_ERR)
668 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
669 lchan_free(lchan);
670
671 return 0;
672}
673
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200674int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
675 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800676{
677 struct abis_rsl_dchan_hdr *dh;
678 struct msgb *msg = rsl_msgb_alloc();
679
680 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
681 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
682 dh->chan_nr = RSL_CHAN_PCH_AGCH;
683
684 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
685 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
686 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
687
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200688 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800689
690 return abis_rsl_sendmsg(msg);
691}
692
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200693int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800694{
695 int i, len = strlen(str_in);
696
697 for (i = 0; i < len; i++) {
698 int num = str_in[i] - 0x30;
699 if (num < 0 || num > 9)
700 return -1;
701 if (i % 2 == 0)
702 bcd_out[i/2] = num;
703 else
704 bcd_out[i/2] |= (num << 4);
705 }
706
707 return 0;
708}
709
710/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200711int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800712{
713 struct msgb *msg = rsl_msgb_alloc();
714 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200715 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800716
717 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
718 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
719 dh->chan_nr = RSL_CHAN_PCH_AGCH;
720
721 switch (bts->type) {
722 case GSM_BTS_TYPE_BS11:
723 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
724 break;
725 default:
726 /* If phase 2, construct a FULL_IMM_ASS_INFO */
727 pad_macblock(buf, val, len);
728 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
729 break;
730 }
731
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200732 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800733
734 return abis_rsl_sendmsg(msg);
735}
736
Harald Welte4684e632009-08-10 09:51:40 +0200737/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200738int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200739{
740 struct msgb *msg = rsl_msgb_alloc();
741 struct abis_rsl_dchan_hdr *dh;
742
743 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
744 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200745 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200746 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200747 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200748
Harald Weltede4477a2009-12-24 12:20:20 +0100749 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200750 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200751
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200752 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte874a5b42009-08-10 11:26:14 +0200753
Harald Welte4684e632009-08-10 09:51:40 +0200754 return abis_rsl_sendmsg(msg);
755}
756
757
Harald Welte59b04682009-06-10 05:40:52 +0800758/* Send "DATA REQUEST" message with given L3 Info payload */
759/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200760int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800761{
Harald Welte59b04682009-06-10 05:40:52 +0800762 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100763 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800764 return -EINVAL;
765 }
766
Harald Weltee6d51f92011-06-25 10:02:33 +0200767 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100768 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800769
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200770 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800771
772 return abis_rsl_sendmsg(msg);
773}
774
Harald Welteed9a5ab2009-08-09 13:47:35 +0200775/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
776/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200777int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200778{
Harald Weltea22d36b2010-03-04 10:33:10 +0100779 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200780
Harald Weltee6d51f92011-06-25 10:02:33 +0200781 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100782 link_id, 0);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200783 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200784
785 return abis_rsl_sendmsg(msg);
786}
787
Harald Welte0f2e3c12009-08-08 13:15:07 +0200788/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
789 This is what higher layers should call. The BTS then responds with
790 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
791 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
792 lchan_free() */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200793int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200794{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200795
Harald Weltea22d36b2010-03-04 10:33:10 +0100796 struct msgb *msg;
797
Harald Weltee6d51f92011-06-25 10:02:33 +0200798 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100799 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800800 /* 0 is normal release, 1 is local end */
801 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200802
Harald Weltec88a4432009-12-29 10:44:17 +0100803 /* FIXME: start some timer in case we don't receive a REL ACK ? */
804
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200805 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200806
807 return abis_rsl_sendmsg(msg);
808}
809
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200810int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
811{
812 lchan->state = state;
813 return 0;
814}
815
Harald Welte59b04682009-06-10 05:40:52 +0800816/* Chapter 8.4.2: Channel Activate Acknowledge */
817static int rsl_rx_chan_act_ack(struct msgb *msg)
818{
819 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
820
821 /* BTS has confirmed channel activation, we now need
822 * to assign the activated channel to the MS */
823 if (rslh->ie_chan != RSL_IE_CHAN_NR)
824 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100825
Harald Welte32951ea2011-08-10 23:26:33 +0200826 osmo_timer_del(&msg->lchan->act_timer);
827
Harald Weltec88a4432009-12-29 10:44:17 +0100828 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100829 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
830 gsm_lchan_name(msg->lchan),
831 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200832 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100833
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800834 if (msg->lchan->rqd_ref) {
835 rsl_send_imm_assignment(msg->lchan);
836 talloc_free(msg->lchan->rqd_ref);
837 msg->lchan->rqd_ref = NULL;
838 msg->lchan->rqd_ta = 0;
839 }
840
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100841 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100842
Harald Welte59b04682009-06-10 05:40:52 +0800843 return 0;
844}
845
846/* Chapter 8.4.3: Channel Activate NACK */
847static int rsl_rx_chan_act_nack(struct msgb *msg)
848{
849 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
850 struct tlv_parsed tp;
851
Harald Welte32951ea2011-08-10 23:26:33 +0200852 osmo_timer_del(&msg->lchan->act_timer);
853
Daniel Willmann9e9d44c2011-08-11 04:54:23 +0200854 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100855 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100856
Harald Welte59b04682009-06-10 05:40:52 +0800857 /* BTS has rejected channel activation ?!? */
858 if (dh->ie_chan != RSL_IE_CHAN_NR)
859 return -EINVAL;
860
861 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100862 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200863 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100864 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200865 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100866 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200867 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Daniel Willmann245ee032011-08-11 04:47:11 +0200868 else
869 rsl_rf_chan_release(msg->lchan, 1);
870
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100871 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200872 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200873
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100874 LOGPC(DRSL, LOGL_ERROR, "\n");
875
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100876 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100877
Harald Weltecddb9802009-08-09 19:50:08 +0200878 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800879 return 0;
880}
881
882/* Chapter 8.4.4: Connection Failure Indication */
883static int rsl_rx_conn_fail(struct msgb *msg)
884{
885 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
886 struct tlv_parsed tp;
887
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100888 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100889 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100890 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800891
892 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
893
Harald Weltef1a168d2009-07-28 17:58:09 +0200894 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100895 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200896 TLVP_LEN(&tp, RSL_IE_CAUSE));
897
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100898 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800899 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200900 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800901 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800902}
903
Harald Weltec20bd1d2009-11-29 19:07:28 +0100904static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
905 const char *prefix)
906{
Harald Welte0e4fa782009-12-16 16:52:07 +0100907 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
908 prefix, rxlev2dbm(mru->full.rx_lev),
909 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100910 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
911 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
912}
913
914static void print_meas_rep(struct gsm_meas_rep *mr)
915{
Harald Welte0e4fa782009-12-16 16:52:07 +0100916 int i;
917
Harald Weltec20bd1d2009-11-29 19:07:28 +0100918 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
919
920 if (mr->flags & MEAS_REP_F_DL_DTX)
921 DEBUGPC(DMEAS, "DTXd ");
922
923 print_meas_rep_uni(&mr->ul, "ul");
924 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
925 if (mr->flags & MEAS_REP_F_MS_TO)
926 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
927
928 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100929 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100930 DEBUGPC(DMEAS, "L1_FPC=%u ",
931 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
932 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
933 }
934
935 if (mr->flags & MEAS_REP_F_UL_DTX)
936 DEBUGPC(DMEAS, "DTXu ");
937 if (mr->flags & MEAS_REP_F_BA1)
938 DEBUGPC(DMEAS, "BA1 ");
939 if (!(mr->flags & MEAS_REP_F_DL_VALID))
940 DEBUGPC(DMEAS, "NOT VALID ");
941 else
942 print_meas_rep_uni(&mr->dl, "dl");
943
944 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100945 if (mr->num_cell == 7)
946 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100947 for (i = 0; i < mr->num_cell; i++) {
948 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100949 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
950 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100951 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100952}
953
Harald Welte59b04682009-06-10 05:40:52 +0800954static int rsl_rx_meas_res(struct msgb *msg)
955{
956 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
957 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100958 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200959 uint8_t len;
960 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +0100961 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800962
Harald Welte4baa9c52009-12-21 13:27:11 +0100963 /* check if this channel is actually active */
964 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100965 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800966 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100967 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100968 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100969 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100970
Harald Weltef9476812009-12-15 21:36:05 +0100971 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100972 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100973
Harald Welte59b04682009-06-10 05:40:52 +0800974 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
975
Harald Weltec20bd1d2009-11-29 19:07:28 +0100976 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
977 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
978 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
979 return -EIO;
980
981 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100982 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100983
984 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
985 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
986 if (len >= 3) {
987 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +0100988 mr->flags |= MEAS_REP_F_DL_DTX;
989 mr->ul.full.rx_lev = val[0] & 0x3f;
990 mr->ul.sub.rx_lev = val[1] & 0x3f;
991 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
992 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +0800993 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100994
Harald Weltef9476812009-12-15 21:36:05 +0100995 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100996
997 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800998 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +0100999 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001000 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1001
Harald Weltea1467eb2009-06-20 18:44:35 +02001002 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001003 struct e1inp_sign_link *sign_link = msg->dst;
1004
Harald Weltec20bd1d2009-11-29 19:07:28 +01001005 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001006 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001007 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001008 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001009 mr->flags |= MEAS_REP_F_FPC;
1010 mr->ms_l1.ta = val[1];
Andreas Eversbergfe56cf82011-12-24 11:49:05 +01001011 /* BS11 and Nokia reports TA shifted by 2 bits */
1012 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1013 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001014 mr->ms_l1.ta >>= 2;
Harald Weltea1467eb2009-06-20 18:44:35 +02001015 }
Harald Welte59b04682009-06-10 05:40:52 +08001016 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001017 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001018 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001019 if (rc < 0)
1020 return rc;
1021 }
1022
Harald Weltef9476812009-12-15 21:36:05 +01001023 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001024
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001025 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001026
Harald Welte59b04682009-06-10 05:40:52 +08001027 return 0;
1028}
1029
Harald Welte6720a432009-11-29 22:45:52 +01001030/* Chapter 8.4.7 */
1031static int rsl_rx_hando_det(struct msgb *msg)
1032{
1033 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1034 struct tlv_parsed tp;
1035
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001036 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001037
1038 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1039
1040 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1041 DEBUGPC(DRSL, "access delay = %u\n",
1042 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1043 else
1044 DEBUGPC(DRSL, "\n");
1045
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001046 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001047
1048 return 0;
1049}
1050
Harald Welte59b04682009-06-10 05:40:52 +08001051static int abis_rsl_rx_dchan(struct msgb *msg)
1052{
1053 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1054 int rc = 0;
1055 char *ts_name;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001056 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001057
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001058 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001059 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001060
Harald Welte59b04682009-06-10 05:40:52 +08001061 switch (rslh->c.msg_type) {
1062 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001063 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001064 rc = rsl_rx_chan_act_ack(msg);
1065 break;
1066 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001067 rc = rsl_rx_chan_act_nack(msg);
1068 break;
1069 case RSL_MT_CONN_FAIL:
1070 rc = rsl_rx_conn_fail(msg);
1071 break;
1072 case RSL_MT_MEAS_RES:
1073 rc = rsl_rx_meas_res(msg);
1074 break;
Harald Welte6720a432009-11-29 22:45:52 +01001075 case RSL_MT_HANDO_DET:
1076 rc = rsl_rx_hando_det(msg);
1077 break;
Harald Welte59b04682009-06-10 05:40:52 +08001078 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001079 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001080 break;
1081 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001082 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001083 break;
1084 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001085 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001086 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001087 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001088 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001089 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001090 break;
1091 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001092 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001093 break;
1094 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001095 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001096 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001097 break;
1098 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001099 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001100 break;
Harald Welte59b04682009-06-10 05:40:52 +08001101 case RSL_MT_PHY_CONTEXT_CONF:
1102 case RSL_MT_PREPROC_MEAS_RES:
1103 case RSL_MT_TALKER_DET:
1104 case RSL_MT_LISTENER_DET:
1105 case RSL_MT_REMOTE_CODEC_CONF_REP:
1106 case RSL_MT_MR_CODEC_MOD_ACK:
1107 case RSL_MT_MR_CODEC_MOD_NACK:
1108 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001109 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1110 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001111 break;
1112 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001113 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1114 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001115 return -EINVAL;
1116 }
1117
1118 return rc;
1119}
1120
1121static int rsl_rx_error_rep(struct msgb *msg)
1122{
1123 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001124 struct tlv_parsed tp;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001125 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001126
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001127 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001128
1129 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1130
1131 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001132 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001133 TLVP_LEN(&tp, RSL_IE_CAUSE));
1134
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001135 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001136
1137 return 0;
1138}
1139
1140static int abis_rsl_rx_trx(struct msgb *msg)
1141{
1142 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001143 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001144 int rc = 0;
1145
1146 switch (rslh->msg_type) {
1147 case RSL_MT_ERROR_REPORT:
1148 rc = rsl_rx_error_rep(msg);
1149 break;
1150 case RSL_MT_RF_RES_IND:
1151 /* interference on idle channels of TRX */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001152 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001153 break;
1154 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001155 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001156 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001157 gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001158 break;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001159 case 0x42: /* Nokia specific: SI End ACK */
1160 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1161 break;
1162 case 0x43: /* Nokia specific: SI End NACK */
1163 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1164 break;
Harald Welte59b04682009-06-10 05:40:52 +08001165 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001166 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001167 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001168 return -EINVAL;
1169 }
1170 return rc;
1171}
1172
Harald Welte427dbc42009-08-10 00:26:10 +02001173/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1174static void t3101_expired(void *data)
1175{
1176 struct gsm_lchan *lchan = data;
1177
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001178 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001179}
1180
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001181/* If T3111 expires, we will send the RF Channel Request */
1182static void t3111_expired(void *data)
1183{
1184 struct gsm_lchan *lchan = data;
1185
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001186 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001187}
1188
laforge50312e82010-06-21 12:08:52 +02001189#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1190
Harald Weltea00fdd72010-12-23 14:39:29 +01001191/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1192static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1193 unsigned int num_req_refs,
1194 struct gsm48_req_ref *rqd_refs,
1195 uint8_t wait_ind)
1196{
1197 uint8_t buf[GSM_MACBLOCK_LEN];
1198 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1199
1200 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1201 memset(iar, 0, sizeof(*iar));
1202 iar->proto_discr = GSM48_PDISC_RR;
1203 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1204 iar->page_mode = GSM48_PM_SAME;
1205
1206 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1207 iar->wait_ind1 = wait_ind;
1208
1209 if (num_req_refs >= 2)
1210 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1211 else
1212 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1213 iar->wait_ind2 = wait_ind;
1214
1215 if (num_req_refs >= 3)
1216 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1217 else
1218 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1219 iar->wait_ind3 = wait_ind;
1220
1221 if (num_req_refs >= 4)
1222 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1223 else
1224 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1225 iar->wait_ind4 = wait_ind;
1226
1227 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1228}
1229
Harald Welte59b04682009-06-10 05:40:52 +08001230/* MS has requested a channel on the RACH */
1231static int rsl_rx_chan_rqd(struct msgb *msg)
1232{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001233 struct e1inp_sign_link *sign_link = msg->dst;
1234 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001235 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1236 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001237 enum gsm_chan_t lctype;
1238 enum gsm_chreq_reason_t chreq_reason;
1239 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001240 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001241 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001242
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001243 uint16_t arfcn;
1244 uint8_t ts_number, subch;
Harald Welte59b04682009-06-10 05:40:52 +08001245
1246 /* parse request reference to be used in immediate assign */
1247 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1248 return -EINVAL;
1249
1250 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1251
1252 /* parse access delay and use as TA */
1253 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1254 return -EINVAL;
1255 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1256
1257 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1258 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001259 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1260 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001261
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001262 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001263
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001264 /*
1265 * We want LOCATION UPDATES to succeed and will assign a TCH
1266 * if we have no SDCCH available.
1267 */
1268 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1269
Harald Welte59b04682009-06-10 05:40:52 +08001270 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001271 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001272 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001273 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001274 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001275 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001276 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1277 if (bts->network->T3122)
1278 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001279 return -ENOMEM;
1280 }
1281
Harald Weltec88a4432009-12-29 10:44:17 +01001282 if (lchan->state != LCHAN_S_NONE)
1283 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001284 "in state %s\n", gsm_lchan_name(lchan),
1285 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +02001286 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +01001287
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001288 /* save the RACH data as we need it after the CHAN ACT ACK */
1289 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1290 if (!lchan->rqd_ref) {
1291 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1292 lchan_free(lchan);
1293 return -ENOMEM;
1294 }
1295
1296 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1297 lchan->rqd_ta = rqd_ta;
1298
Harald Welte59b04682009-06-10 05:40:52 +08001299 ts_number = lchan->ts->nr;
1300 arfcn = lchan->ts->trx->arfcn;
1301 subch = lchan->nr;
1302
Harald Welted2dd9de2009-08-30 15:37:11 +09001303 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001304 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001305 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001306 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001307 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001308
Harald Welte32951ea2011-08-10 23:26:33 +02001309 /* Start another timer or assume the BTS sends a ACK/NACK? */
1310 lchan->act_timer.cb = lchan_act_tmr_cb;
1311 lchan->act_timer.data = lchan;
1312 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1313
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001314 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1315 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1316 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1317 rqd_ref->ra, rqd_ta);
1318
1319 /* BS11 requires TA shifted by 2 bits */
1320 if (bts->type == GSM_BTS_TYPE_BS11)
1321 rqd_ta <<= 2;
Harald Welteb90d7bd2009-12-17 00:31:10 +01001322 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001323
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001324 return 0;
1325}
1326
1327static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1328{
1329 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001330 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001331 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1332
Harald Welte59b04682009-06-10 05:40:52 +08001333 /* create IMMEDIATE ASSIGN 04.08 messge */
laforgee06d5982010-06-20 15:18:46 +02001334 memset(ia, 0, sizeof(*ia));
laforge50312e82010-06-21 12:08:52 +02001335 /* we set ia->l2_plen once we know the length of the MA below */
laforgee06d5982010-06-20 15:18:46 +02001336 ia->proto_discr = GSM48_PDISC_RR;
1337 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1338 ia->page_mode = GSM48_PM_SAME;
1339 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea42a93f2010-06-14 22:26:10 +02001340
Harald Welte59b04682009-06-10 05:40:52 +08001341 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001342 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1343 ia->timing_advance = lchan->rqd_ta;
Harald Weltea42a93f2010-06-14 22:26:10 +02001344 if (!lchan->ts->hopping.enabled) {
laforgee06d5982010-06-20 15:18:46 +02001345 ia->mob_alloc_len = 0;
Harald Weltea42a93f2010-06-14 22:26:10 +02001346 } else {
laforgee06d5982010-06-20 15:18:46 +02001347 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1348 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea42a93f2010-06-14 22:26:10 +02001349 }
Harald Welte07f32182010-06-28 18:41:27 +02001350 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1351 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte59b04682009-06-10 05:40:52 +08001352
Harald Welte427dbc42009-08-10 00:26:10 +02001353 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1354 lchan->T3101.cb = t3101_expired;
1355 lchan->T3101.data = lchan;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001356 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001357
1358 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001359 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte59b04682009-06-10 05:40:52 +08001360}
1361
1362/* MS has requested a channel on the RACH */
1363static int rsl_rx_ccch_load(struct msgb *msg)
1364{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001365 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001366 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001367 uint16_t pg_buf_space;
1368 uint16_t rach_slot_count = -1;
1369 uint16_t rach_busy_count = -1;
1370 uint16_t rach_access_count = -1;
Harald Welte59b04682009-06-10 05:40:52 +08001371
1372 switch (rslh->data[0]) {
1373 case RSL_IE_PAGING_LOAD:
1374 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001375 if (is_ipaccess_bts(sign_link->trx->bts) && pg_buf_space == 0xffff) {
Harald Welte008a4922010-04-19 10:24:07 +02001376 /* paging load below configured threshold, use 50 as default */
1377 pg_buf_space = 50;
1378 }
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001379 paging_update_buffer_space(sign_link->trx->bts, pg_buf_space);
Harald Welte59b04682009-06-10 05:40:52 +08001380 break;
1381 case RSL_IE_RACH_LOAD:
1382 if (msg->data_len >= 7) {
1383 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1384 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1385 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1386 }
1387 break;
1388 default:
1389 break;
1390 }
1391
1392 return 0;
1393}
1394
1395static int abis_rsl_rx_cchan(struct msgb *msg)
1396{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001397 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001398 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1399 int rc = 0;
1400
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001401 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +08001402
1403 switch (rslh->c.msg_type) {
1404 case RSL_MT_CHAN_RQD:
1405 /* MS has requested a channel on the RACH */
1406 rc = rsl_rx_chan_rqd(msg);
1407 break;
1408 case RSL_MT_CCCH_LOAD_IND:
1409 /* current load on the CCCH */
1410 rc = rsl_rx_ccch_load(msg);
1411 break;
1412 case RSL_MT_DELETE_IND:
1413 /* CCCH overloaded, IMM_ASSIGN was dropped */
1414 case RSL_MT_CBCH_LOAD_IND:
1415 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001416 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1417 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001418 break;
1419 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001420 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1421 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001422 return -EINVAL;
1423 }
1424
1425 return rc;
1426}
1427
1428static int rsl_rx_rll_err_ind(struct msgb *msg)
1429{
1430 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001431 uint8_t *rlm_cause = rllh->data;
Harald Welte59b04682009-06-10 05:40:52 +08001432
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001433 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001434 gsm_lchan_name(msg->lchan),
Harald Welteb30935e2010-03-25 12:13:02 +08001435 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteed9a5ab2009-08-09 13:47:35 +02001436
1437 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)bd76cce2009-12-26 23:55:00 +01001438
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001439 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001440 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001441 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther27942e92010-04-17 06:48:29 +02001442 }
Harald Welte692f5852009-07-04 09:40:05 +02001443
Harald Welte59b04682009-06-10 05:40:52 +08001444 return 0;
1445}
1446
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001447static void rsl_handle_release(struct gsm_lchan *lchan)
1448{
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001449 int sapi;
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001450 struct gsm_bts *bts;
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001451
1452 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001453 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001454 return;
1455
1456 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1457 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1458 continue;
Harald Welte497aa982010-12-24 12:51:07 +01001459 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001460 gsm_lchan_name(lchan), sapi);
1461 return;
1462 }
1463
Holger Hans Peter Freytherd26cbc82010-04-08 22:47:44 +02001464
1465
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001466 /* wait a bit to send the RF Channel Release */
1467 lchan->T3111.cb = t3111_expired;
1468 lchan->T3111.data = lchan;
1469 bts = lchan->ts->trx->bts;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001470 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001471}
1472
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001473/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte59b04682009-06-10 05:40:52 +08001474 0x02, 0x06,
1475 0x01, 0x20,
1476 0x02, 0x00,
1477 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1478
1479static int abis_rsl_rx_rll(struct msgb *msg)
1480{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001481 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001482 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1483 int rc = 0;
1484 char *ts_name;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001485 uint8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001486
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001487 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001488 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltede4477a2009-12-24 12:20:20 +01001489 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001490
1491 switch (rllh->c.msg_type) {
1492 case RSL_MT_DATA_IND:
1493 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001494 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001495 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1496 rllh->data[0] == RSL_IE_L3_INFO) {
1497 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001498 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001499 }
1500 break;
1501 case RSL_MT_EST_IND:
1502 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001503 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001504 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +02001505 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001506 if (msgb_l2len(msg) >
Harald Welte59b04682009-06-10 05:40:52 +08001507 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1508 rllh->data[0] == RSL_IE_L3_INFO) {
1509 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001510 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001511 }
1512 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001513 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001514 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001515 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001516 rll_indication(msg->lchan, rllh->link_id,
1517 BSC_RLLR_IND_EST_CONF);
1518 break;
Harald Welte59b04682009-06-10 05:40:52 +08001519 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001520 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001521 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001522 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001523 rll_indication(msg->lchan, rllh->link_id,
1524 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001525 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001526 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001527 break;
1528 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001529 /* BTS informs us of having received UA from MS,
1530 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001531 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001532 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freyther65f08522010-04-08 22:39:34 +02001533 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther3fdf5b92010-07-29 17:09:36 +08001534 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001535 break;
1536 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001537 rc = rsl_rx_rll_err_ind(msg);
1538 break;
1539 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001540 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1541 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001542 break;
1543 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001544 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1545 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001546 }
Harald Welte59b04682009-06-10 05:40:52 +08001547 return rc;
1548}
1549
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001550static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001551{
Harald Welteb284b472009-12-02 01:58:23 +05301552 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001553 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301554 switch (lchan->type) {
1555 case GSM_LCHAN_TCH_F:
1556 return 0x00;
1557 case GSM_LCHAN_TCH_H:
1558 return 0x03;
1559 default:
1560 break;
1561 }
Harald Welte98d79f92009-07-28 18:11:56 +02001562 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301563 switch (lchan->type) {
1564 case GSM_LCHAN_TCH_F:
1565 return 0x01;
1566 /* there's no half-rate EFR */
1567 default:
1568 break;
1569 }
Harald Welte98d79f92009-07-28 18:11:56 +02001570 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301571 switch (lchan->type) {
1572 case GSM_LCHAN_TCH_F:
1573 return 0x02;
1574 case GSM_LCHAN_TCH_H:
1575 return 0x05;
1576 default:
1577 break;
1578 }
1579 default:
1580 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001581 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001582 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301583 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001584 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001585}
1586
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001587static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munaut1338a552009-12-20 22:06:40 +01001588{
Holger Hans Peter Freyther6651b692010-11-14 21:09:08 +01001589 struct gsm_network *net = lchan->ts->trx->bts->network;
1590
Sylvain Munaut1338a552009-12-20 22:06:40 +01001591 switch (lchan->tch_mode) {
1592 case GSM48_CMODE_SPEECH_V1:
1593 switch (lchan->type) {
1594 case GSM_LCHAN_TCH_F:
1595 return RTP_PT_GSM_FULL;
1596 case GSM_LCHAN_TCH_H:
1597 return RTP_PT_GSM_HALF;
1598 default:
1599 break;
1600 }
1601 case GSM48_CMODE_SPEECH_EFR:
1602 switch (lchan->type) {
1603 case GSM_LCHAN_TCH_F:
1604 return RTP_PT_GSM_EFR;
1605 /* there's no half-rate EFR */
1606 default:
1607 break;
1608 }
1609 case GSM48_CMODE_SPEECH_AMR:
1610 switch (lchan->type) {
1611 case GSM_LCHAN_TCH_F:
Sylvain Munaut1338a552009-12-20 22:06:40 +01001612 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freytherd78bee82011-07-21 10:24:46 +02001613 return RTP_PT_AMR;
Sylvain Munaut1338a552009-12-20 22:06:40 +01001614 default:
1615 break;
1616 }
1617 default:
1618 break;
1619 }
1620 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1621 "tch_mode == 0x%02x\n & lchan_type == %d",
1622 lchan->tch_mode, lchan->type);
1623 return 0;
1624}
1625
Harald Welte59b04682009-06-10 05:40:52 +08001626/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001627static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1628{
1629 struct in_addr ip;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001630 uint16_t port, conn_id;
Harald Weltebffa4992009-12-19 16:42:06 +01001631
1632 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001633 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001634 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1635 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1636 }
1637
1638 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001639 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001640 port = ntohs(port);
1641 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1642 lchan->abis_ip.bound_port = port;
1643 }
1644
1645 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001646 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Weltebffa4992009-12-19 16:42:06 +01001647 conn_id = ntohs(conn_id);
1648 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1649 lchan->abis_ip.conn_id = conn_id;
1650 }
1651
1652 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1653 lchan->abis_ip.rtp_payload2 =
1654 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1655 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1656 lchan->abis_ip.rtp_payload2);
1657 }
1658
1659 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1660 lchan->abis_ip.speech_mode =
1661 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1662 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1663 lchan->abis_ip.speech_mode);
1664 }
1665
1666 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001667 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Weltebffa4992009-12-19 16:42:06 +01001668 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1669 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1670 }
1671
1672 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001673 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Weltebffa4992009-12-19 16:42:06 +01001674 port = ntohs(port);
1675 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1676 lchan->abis_ip.connect_port = port;
1677 }
1678}
1679
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001680int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001681{
1682 struct msgb *msg = rsl_msgb_alloc();
1683 struct abis_rsl_dchan_hdr *dh;
1684
1685 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001686 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001687 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001688 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001689
Harald Welte98d79f92009-07-28 18:11:56 +02001690 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001691 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001692 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001693 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001694 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001695
Sylvain Munaut1338a552009-12-20 22:06:40 +01001696 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1697 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1698 lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001699
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001700 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001701
1702 return abis_rsl_sendmsg(msg);
1703}
1704
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001705int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1706 uint8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001707{
1708 struct msgb *msg = rsl_msgb_alloc();
1709 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001710 uint32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001711 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001712
1713 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001714 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001715 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltee6d51f92011-06-25 10:02:33 +02001716 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001717
Harald Weltebffa4992009-12-19 16:42:06 +01001718 /* we need to store these now as MDCX_ACK does not return them :( */
1719 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1720 lchan->abis_ip.connect_port = port;
1721 lchan->abis_ip.connect_ip = ip;
1722
Harald Weltefb4a9e92009-07-29 12:12:18 +02001723 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001724 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001725 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001726
Harald Welte98d79f92009-07-28 18:11:56 +02001727 ia.s_addr = htonl(ip);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001728 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1729 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1730 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1731 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001732
Harald Weltebffa4992009-12-19 16:42:06 +01001733 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1734 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001735 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Weltebffa4992009-12-19 16:42:06 +01001736 *att_ip = ia.s_addr;
1737 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1738 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munaut1338a552009-12-20 22:06:40 +01001739 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Welte98d79f92009-07-28 18:11:56 +02001740 if (rtp_payload2)
1741 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001742
1743 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +08001744
1745 return abis_rsl_sendmsg(msg);
1746}
1747
Harald Welte9947d9f2009-12-20 16:51:09 +01001748/* tell BTS to connect RTP stream to our local RTP socket */
1749int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1750{
1751 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1752 int rc;
1753
1754 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1755 ntohs(rs->rtp.sin_local.sin_port),
1756 /* FIXME: use RTP payload of bound socket, not BTS*/
1757 lchan->abis_ip.rtp_payload2);
1758
1759 return rc;
1760}
1761
Harald Welte6f40df02010-12-23 12:59:52 +01001762int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welteaed946e2009-10-24 10:29:22 +02001763{
1764 struct msgb *msg = rsl_msgb_alloc();
1765 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001766 uint8_t msg_type;
Harald Welte2b361522010-03-28 14:42:09 +08001767
1768 if (act)
1769 msg_type = RSL_MT_IPAC_PDCH_ACT;
1770 else
1771 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welteaed946e2009-10-24 10:29:22 +02001772
1773 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte2b361522010-03-28 14:42:09 +08001774 init_dchan_hdr(dh, msg_type);
Harald Welteaed946e2009-10-24 10:29:22 +02001775 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +02001776 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welteaed946e2009-10-24 10:29:22 +02001777
Harald Welte6f40df02010-12-23 12:59:52 +01001778 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte2b361522010-03-28 14:42:09 +08001779 act ? "" : "DE");
Harald Welteaed946e2009-10-24 10:29:22 +02001780
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001781 msg->dst = ts->trx->rsl_link;
Harald Welteaed946e2009-10-24 10:29:22 +02001782
1783 return abis_rsl_sendmsg(msg);
1784}
1785
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001786static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001787{
1788 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1789 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301790 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001791
1792 /* the BTS has acknowledged a local bind, it now tells us the IP
1793 * address and port number to which it has bound the given logical
1794 * channel */
1795
1796 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1797 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1798 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001799 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001800 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001801 return -EINVAL;
1802 }
Harald Welte50517742009-12-20 15:42:44 +01001803
Harald Weltebffa4992009-12-19 16:42:06 +01001804 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001805
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001806 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001807
1808 return 0;
1809}
1810
Harald Weltebffa4992009-12-19 16:42:06 +01001811static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1812{
1813 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1814 struct tlv_parsed tv;
1815 struct gsm_lchan *lchan = msg->lchan;
1816
1817 /* the BTS has acknowledged a remote connect request and
1818 * it now tells us the IP address and port number to which it has
1819 * connected the given logical channel */
1820
1821 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1822 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001823 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Weltebffa4992009-12-19 16:42:06 +01001824
1825 return 0;
1826}
1827
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001828static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001829{
1830 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1831 struct tlv_parsed tv;
1832
1833 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001834
Harald Weltef1a168d2009-07-28 17:58:09 +02001835 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001836 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001837 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001838
Pablo Neira Ayusoef717c62011-05-06 12:12:31 +02001839 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001840
Harald Welte59b04682009-06-10 05:40:52 +08001841 return 0;
1842}
1843
1844static int abis_rsl_rx_ipacc(struct msgb *msg)
1845{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001846 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001847 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001848 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001849 int rc = 0;
1850
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001851 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001852 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001853
1854 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001855 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001856 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001857 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001858 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001859 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001860 /* somehow the BTS was unable to bind the lchan to its local
1861 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001862 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001863 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001864 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001865 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001866 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001867 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001868 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001869 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001870 /* somehow the BTS was unable to connect the lchan to a remote
1871 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001872 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001873 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001874 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001875 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001876 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001877 break;
1878 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001879 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001880 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001881 break;
1882 }
1883 DEBUGPC(DRSL, "\n");
1884
1885 return rc;
1886}
1887
1888
1889/* Entry-point where L2 RSL from BTS enters */
1890int abis_rsl_rcvmsg(struct msgb *msg)
1891{
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001892 struct abis_rsl_common_hdr *rslh;
Harald Welte59b04682009-06-10 05:40:52 +08001893 int rc = 0;
1894
Holger Hans Peter Freytherc7d94092009-11-20 15:14:01 +01001895 if (!msg) {
1896 DEBUGP(DRSL, "Empty RSL msg?..\n");
1897 return -1;
1898 }
1899
1900 if (msgb_l2len(msg) < sizeof(*rslh)) {
1901 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1902 return -1;
1903 }
1904
1905 rslh = msgb_l2(msg);
1906
Harald Welte59b04682009-06-10 05:40:52 +08001907 switch (rslh->msg_discr & 0xfe) {
1908 case ABIS_RSL_MDISC_RLL:
1909 rc = abis_rsl_rx_rll(msg);
1910 break;
1911 case ABIS_RSL_MDISC_DED_CHAN:
1912 rc = abis_rsl_rx_dchan(msg);
1913 break;
1914 case ABIS_RSL_MDISC_COM_CHAN:
1915 rc = abis_rsl_rx_cchan(msg);
1916 break;
1917 case ABIS_RSL_MDISC_TRX:
1918 rc = abis_rsl_rx_trx(msg);
1919 break;
1920 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001921 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001922 rslh->msg_discr);
1923 break;
1924 case ABIS_RSL_MDISC_IPACCESS:
1925 rc = abis_rsl_rx_ipacc(msg);
1926 break;
1927 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001928 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1929 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001930 return -EINVAL;
1931 }
1932 msgb_free(msg);
1933 return rc;
1934}
1935
Holger Hans Peter Freytherb67f4082010-07-21 15:54:32 +08001936int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1937 uint8_t cb_command, const uint8_t *data, int len)
1938{
1939 struct abis_rsl_dchan_hdr *dh;
1940 struct msgb *cb_cmd;
1941
1942 cb_cmd = rsl_msgb_alloc();
1943 if (!cb_cmd)
1944 return -1;
1945
1946 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1947 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1948 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1949
1950 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1951 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1952
1953 cb_cmd->trx = bts->c0;
1954
1955 return abis_rsl_sendmsg(cb_cmd);
1956}
Dieter Spaar49c843e2011-07-28 00:01:50 +02001957
1958int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
1959{
1960 struct abis_rsl_common_hdr *ch;
1961 struct msgb *msg = rsl_msgb_alloc();
1962
1963 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1964 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1965 ch->msg_type = 0x40; /* Nokia SI Begin */
1966
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001967 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001968
1969 return abis_rsl_sendmsg(msg);
1970}
1971
1972int rsl_nokia_si_end(struct gsm_bts_trx *trx)
1973{
1974 struct abis_rsl_common_hdr *ch;
1975 struct msgb *msg = rsl_msgb_alloc();
1976
1977 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1978 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1979 ch->msg_type = 0x41; /* Nokia SI End */
1980
1981 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
1982
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001983 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001984
1985 return abis_rsl_sendmsg(msg);
1986}
1987
1988int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
1989{
1990 struct abis_rsl_common_hdr *ch;
1991 struct msgb *msg = rsl_msgb_alloc();
1992
1993 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1994 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1995 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
1996
1997 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
1998 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
1999
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02002000 msg->dst = trx->rsl_link;
Dieter Spaar49c843e2011-07-28 00:01:50 +02002001
2002 return abis_rsl_sendmsg(msg);
2003}