blob: e155a34754bb4bec1b3ef2ccdddfc8cc2028d9d7 [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
Holger Hans Peter Freyther7a663792012-01-14 21:56:37 +0100199 if (lchan->state != LCHAN_S_REL_ERR)
200 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Daniel Willmann2731e732011-08-11 04:44:12 +0200201 lchan_free(lchan);
Harald Welte32951ea2011-08-10 23:26:33 +0200202}
203
204
Harald Welte59b04682009-06-10 05:40:52 +0800205/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200206int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
207 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800208{
209 struct abis_rsl_dchan_hdr *dh;
210 struct msgb *msg = rsl_msgb_alloc();
211
212 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
213 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
214 dh->chan_nr = RSL_CHAN_BCCH;
215
216 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
217 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
218
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200219 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800220
221 return abis_rsl_sendmsg(msg);
222}
223
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200224int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
225 const uint8_t *data, int len)
Harald Welte59b04682009-06-10 05:40:52 +0800226{
227 struct abis_rsl_common_hdr *ch;
228 struct msgb *msg = rsl_msgb_alloc();
229
230 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
231 ch->msg_discr = ABIS_RSL_MDISC_TRX;
232 ch->msg_type = RSL_MT_SACCH_FILL;
233
234 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
235 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
236
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200237 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800238
239 return abis_rsl_sendmsg(msg);
240}
241
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200242int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
243 const uint8_t *data, int len)
Harald Welte10b7d8f2011-01-13 23:16:03 +0100244{
245 struct abis_rsl_dchan_hdr *dh;
246 struct msgb *msg = rsl_msgb_alloc();
Harald Weltee6d51f92011-06-25 10:02:33 +0200247 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte10b7d8f2011-01-13 23:16:03 +0100248
249 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
250 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
251 dh->chan_nr = chan_nr;
252
253 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
254 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
255
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200256 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte10b7d8f2011-01-13 23:16:03 +0100257
258 return abis_rsl_sendmsg(msg);
259}
260
Harald Welte91afe4c2009-06-20 18:15:19 +0200261int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
262{
263 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200264 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200265 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200266
267 db = abs(db);
268 if (db > 30)
269 return -EINVAL;
270
Harald Welteed831842009-06-27 03:09:08 +0200271 msg = rsl_msgb_alloc();
272
Harald Welte91afe4c2009-06-20 18:15:19 +0200273 lchan->bs_power = db/2;
274 if (fpc)
275 lchan->bs_power |= 0x10;
276
277 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
278 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
279 dh->chan_nr = chan_nr;
280
281 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
282
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200283 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200284
285 return abis_rsl_sendmsg(msg);
286}
287
Harald Welte91afe4c2009-06-20 18:15:19 +0200288int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
289{
290 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200291 struct msgb *msg;
Harald Weltee6d51f92011-06-25 10:02:33 +0200292 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte91afe4c2009-06-20 18:15:19 +0200293 int ctl_lvl;
294
Harald Weltec4dcda02009-08-09 14:45:18 +0200295 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200296 if (ctl_lvl < 0)
297 return ctl_lvl;
298
Harald Welteed831842009-06-27 03:09:08 +0200299 msg = rsl_msgb_alloc();
300
Harald Welte91afe4c2009-06-20 18:15:19 +0200301 lchan->ms_power = ctl_lvl;
302
303 if (fpc)
304 lchan->ms_power |= 0x20;
305
306 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
307 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
308 dh->chan_nr = chan_nr;
309
310 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
311
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200312 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte91afe4c2009-06-20 18:15:19 +0200313
314 return abis_rsl_sendmsg(msg);
315}
316
Harald Welte39274f42009-07-29 15:41:29 +0200317static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
318 struct gsm_lchan *lchan)
319{
320 memset(cm, 0, sizeof(cm));
321
322 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther21d63ff2010-09-06 09:25:48 +0800323 if (lchan->ts->trx->bts->network->dtx_enabled)
324 cm->dtx_dtu = 0x03;
325 else
326 cm->dtx_dtu = 0x00;
Harald Welte39274f42009-07-29 15:41:29 +0200327
328 /* set TCH Speech/Data */
329 cm->spd_ind = lchan->rsl_cmode;
330
Harald Welte951e3512009-11-27 08:55:16 +0100331 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
332 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100333 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100334 "but tch_mode != signalling\n");
335
Harald Welte39274f42009-07-29 15:41:29 +0200336 switch (lchan->type) {
337 case GSM_LCHAN_SDCCH:
338 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
339 break;
340 case GSM_LCHAN_TCH_F:
341 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
342 break;
343 case GSM_LCHAN_TCH_H:
344 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
345 break;
346 case GSM_LCHAN_NONE:
347 case GSM_LCHAN_UNKNOWN:
348 default:
349 return -EINVAL;
350 }
351
352 switch (lchan->tch_mode) {
353 case GSM48_CMODE_SIGN:
354 cm->chan_rate = 0;
355 break;
356 case GSM48_CMODE_SPEECH_V1:
357 cm->chan_rate = RSL_CMOD_SP_GSM1;
358 break;
359 case GSM48_CMODE_SPEECH_EFR:
360 cm->chan_rate = RSL_CMOD_SP_GSM2;
361 break;
362 case GSM48_CMODE_SPEECH_AMR:
363 cm->chan_rate = RSL_CMOD_SP_GSM3;
364 break;
365 case GSM48_CMODE_DATA_14k5:
366 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
367 break;
368 case GSM48_CMODE_DATA_12k0:
369 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
370 break;
371 case GSM48_CMODE_DATA_6k0:
372 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
373 break;
374 default:
375 return -EINVAL;
376 }
377
378 return 0;
379}
380
Harald Welte59b04682009-06-10 05:40:52 +0800381/* Chapter 8.4.1 */
382#if 0
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200383int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
384 uint8_t act_type,
Harald Welte59b04682009-06-10 05:40:52 +0800385 struct rsl_ie_chan_mode *chan_mode,
386 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200387 uint8_t bs_power, uint8_t ms_power,
388 uint8_t ta)
Harald Welte59b04682009-06-10 05:40:52 +0800389{
390 struct abis_rsl_dchan_hdr *dh;
391 struct msgb *msg = rsl_msgb_alloc();
392
393 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
394 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
395 dh->chan_nr = chan_nr;
396
397 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
398 /* For compatibility with Phase 1 */
399 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200400 (uint8_t *) chan_mode);
Harald Welte59b04682009-06-10 05:40:52 +0800401 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200402 (uint8_t *) chan_ident);
Harald Welte59b04682009-06-10 05:40:52 +0800403#if 0
404 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200405 (uint8_t *) &encr_info);
Harald Welte59b04682009-06-10 05:40:52 +0800406#endif
407 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
408 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
409 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
410
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200411 msg->dst = trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800412
413 return abis_rsl_sendmsg(msg);
414}
415#endif
416
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200417int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
418 uint8_t ta, uint8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800419{
420 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200421 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200422 int rc;
Harald Weltedea24e92010-06-29 17:53:45 +0200423 uint8_t *len;
Harald Welte59b04682009-06-10 05:40:52 +0800424
Harald Weltee6d51f92011-06-25 10:02:33 +0200425 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800426 struct rsl_ie_chan_mode cm;
laforgef723cf02010-06-20 21:38:19 +0200427 struct gsm48_chan_desc cd;
Harald Welte59b04682009-06-10 05:40:52 +0800428
Harald Welte39274f42009-07-29 15:41:29 +0200429 rc = channel_mode_from_lchan(&cm, lchan);
430 if (rc < 0)
431 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800432
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800433 memset(&cd, 0, sizeof(cd));
laforgef723cf02010-06-20 21:38:19 +0200434 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800435
Harald Welteed831842009-06-27 03:09:08 +0200436 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800437 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
438 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
439 dh->chan_nr = chan_nr;
440
441 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800442 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200443 (uint8_t *) &cm);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800444
445 /*
446 * The Channel Identification is needed for Phase1 phones
447 * and it contains the GSM48 Channel Description and the
448 * Mobile Allocation. The GSM 08.58 asks for the Mobile
449 * Allocation to have a length of zero. We are using the
450 * msgb_l3len to calculate the length of both messages.
451 */
laforgef723cf02010-06-20 21:38:19 +0200452 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Weltedea24e92010-06-29 17:53:45 +0200453 len = msgb_put(msg, 1);
Dieter Spaar18a55f62011-07-27 23:40:33 +0200454 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther4cab4422010-06-30 12:06:20 +0800455
456 if (lchan->ts->hopping.enabled)
457 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
458 lchan->ts->hopping.ma_data);
459 else
460 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freyther11b01402010-06-30 11:56:43 +0800461
462 /* update the calculated size */
463 msg->l3h = len + 1;
464 *len = msgb_l3len(msg);
465
Harald Welted2dd9de2009-08-30 15:37:11 +0900466 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200467 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900468 rc = build_encr_info(encr_info, lchan);
469 if (rc > 0)
470 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
471 }
472
Harald Welteb90d7bd2009-12-17 00:31:10 +0100473 switch (act_type) {
474 case RSL_ACT_INTER_ASYNC:
475 case RSL_ACT_INTER_SYNC:
476 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
477 break;
478 default:
479 break;
480 }
481
Harald Welte59b04682009-06-10 05:40:52 +0800482 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
483 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
484 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
485
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100486 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
487 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200488 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther6fe8ab92010-01-28 04:45:05 +0100489
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200490 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800491
492 return abis_rsl_sendmsg(msg);
493}
494
Harald Welte8e770492009-07-29 11:38:15 +0200495/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800496int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
497{
498 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200499 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200500 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800501
Harald Weltee6d51f92011-06-25 10:02:33 +0200502 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800503 struct rsl_ie_chan_mode cm;
504
Harald Welte39274f42009-07-29 15:41:29 +0200505 rc = channel_mode_from_lchan(&cm, lchan);
506 if (rc < 0)
507 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800508
Harald Welteed831842009-06-27 03:09:08 +0200509 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800510 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
511 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
512 dh->chan_nr = chan_nr;
513
514 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200515 (uint8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900516
517 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200518 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welted2dd9de2009-08-30 15:37:11 +0900519 rc = build_encr_info(encr_info, lchan);
520 if (rc > 0)
521 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
522 }
523
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100524 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
525 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200526 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100527 }
528
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200529 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dd9de2009-08-30 15:37:11 +0900530
531 return abis_rsl_sendmsg(msg);
532}
533
534/* Chapter 8.4.6: Send the encryption command with given L3 info */
535int rsl_encryption_cmd(struct msgb *msg)
536{
537 struct abis_rsl_dchan_hdr *dh;
538 struct gsm_lchan *lchan = msg->lchan;
Harald Weltee6d51f92011-06-25 10:02:33 +0200539 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200540 uint8_t encr_info[MAX_A5_KEY_LEN+2];
541 uint8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900542 int rc;
543
544 /* First push the L3 IE tag and length */
545 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
546
547 /* then the link identifier (SAPI0, main sign link) */
548 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
549
550 /* then encryption information */
551 rc = build_encr_info(encr_info, lchan);
552 if (rc <= 0)
553 return rc;
554 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
555
556 /* and finally the DCHAN header */
557 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
558 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
559 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800560
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200561 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800562
563 return abis_rsl_sendmsg(msg);
564}
565
Harald Welte85a163c2009-08-10 11:43:22 +0200566/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200567int rsl_deact_sacch(struct gsm_lchan *lchan)
568{
569 struct abis_rsl_dchan_hdr *dh;
570 struct msgb *msg = rsl_msgb_alloc();
571
572 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
573 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltee6d51f92011-06-25 10:02:33 +0200574 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteafe3c232009-07-19 18:36:49 +0200575
576 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200577 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteafe3c232009-07-19 18:36:49 +0200578
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100579 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteafe3c232009-07-19 18:36:49 +0200580
581 return abis_rsl_sendmsg(msg);
582}
583
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800584static void error_timeout_cb(void *data)
585{
586 struct gsm_lchan *lchan = data;
587 if (lchan->state != LCHAN_S_REL_ERR) {
588 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
589 gsm_lchan_name(lchan), lchan->state);
590 return;
591 }
592
593 /* go back to the none state */
594 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800595 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800596}
597
Harald Welte08011e22011-03-04 13:41:31 +0100598static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
599
Harald Welte85a163c2009-08-10 11:43:22 +0200600/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800601static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte59b04682009-06-10 05:40:52 +0800602{
603 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800604 struct msgb *msg;
Harald Welte08011e22011-03-04 13:41:31 +0100605 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800606
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800607 if (lchan->state == LCHAN_S_REL_ERR) {
608 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
609 gsm_lchan_name(lchan));
610 return -1;
611 }
612
613 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800614 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
615 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltee6d51f92011-06-25 10:02:33 +0200616 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800617
618 msg->lchan = lchan;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200619 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800620
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800621 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
622
623 if (error) {
624 /*
625 * the nanoBTS sends RLL release indications after the channel release. This can
626 * be a problem when we have reassigned the channel to someone else and then can
627 * not figure out who used this channel.
628 */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200629 struct e1inp_sign_link *sign_link = msg->dst;
630
Holger Hans Peter Freyther456fb9d2010-06-08 11:53:33 +0800631 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800632 lchan->error_timer.data = lchan;
633 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200634 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200635 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800636 }
Harald Welte59b04682009-06-10 05:40:52 +0800637
Harald Welte32951ea2011-08-10 23:26:33 +0200638 /* Start another timer or assume the BTS sends a ACK/NACK? */
639 lchan->act_timer.cb = lchan_deact_tmr_cb;
640 lchan->act_timer.data = lchan;
641 osmo_timer_schedule(&lchan->act_timer, 4, 0);
642
Harald Welte08011e22011-03-04 13:41:31 +0100643 rc = abis_rsl_sendmsg(msg);
644
Harald Welte85a163c2009-08-10 11:43:22 +0200645 /* BTS will respond by RF CHAN REL ACK */
Harald Welte6bddd822011-01-14 23:18:59 +0100646#ifdef HSL_SR_1_0
Harald Welte08011e22011-03-04 13:41:31 +0100647 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
648 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
649 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte6bddd822011-01-14 23:18:59 +0100650#endif
Harald Welte08011e22011-03-04 13:41:31 +0100651
652 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800653}
654
Harald Welte9773f6c2011-01-14 14:16:16 +0100655static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
656{
657
658 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
659
Harald Welte32951ea2011-08-10 23:26:33 +0200660 osmo_timer_del(&lchan->act_timer);
661
Harald Welte9773f6c2011-01-14 14:16:16 +0100662 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
663 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
664 gsm_lchan_name(lchan),
665 gsm_lchans_name(lchan->state));
Pablo Neira Ayuso840ccf62011-05-06 12:11:06 +0200666 osmo_timer_del(&lchan->T3111);
Harald Welte9773f6c2011-01-14 14:16:16 +0100667 /* we have an error timer pending to release that */
668 if (lchan->state != LCHAN_S_REL_ERR)
669 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
670 lchan_free(lchan);
671
672 return 0;
673}
674
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200675int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
676 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte59b04682009-06-10 05:40:52 +0800677{
678 struct abis_rsl_dchan_hdr *dh;
679 struct msgb *msg = rsl_msgb_alloc();
680
681 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
682 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
683 dh->chan_nr = RSL_CHAN_PCH_AGCH;
684
685 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
686 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
687 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
688
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200689 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800690
691 return abis_rsl_sendmsg(msg);
692}
693
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200694int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte59b04682009-06-10 05:40:52 +0800695{
696 int i, len = strlen(str_in);
697
698 for (i = 0; i < len; i++) {
699 int num = str_in[i] - 0x30;
700 if (num < 0 || num > 9)
701 return -1;
702 if (i % 2 == 0)
703 bcd_out[i/2] = num;
704 else
705 bcd_out[i/2] |= (num << 4);
706 }
707
708 return 0;
709}
710
711/* Chapter 8.5.6 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200712int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte59b04682009-06-10 05:40:52 +0800713{
714 struct msgb *msg = rsl_msgb_alloc();
715 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200716 uint8_t buf[MACBLOCK_SIZE];
Harald Welte59b04682009-06-10 05:40:52 +0800717
718 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
719 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
720 dh->chan_nr = RSL_CHAN_PCH_AGCH;
721
722 switch (bts->type) {
723 case GSM_BTS_TYPE_BS11:
724 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
725 break;
726 default:
727 /* If phase 2, construct a FULL_IMM_ASS_INFO */
728 pad_macblock(buf, val, len);
729 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
730 break;
731 }
732
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200733 msg->dst = bts->c0->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800734
735 return abis_rsl_sendmsg(msg);
736}
737
Harald Welte4684e632009-08-10 09:51:40 +0200738/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200739int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200740{
741 struct msgb *msg = rsl_msgb_alloc();
742 struct abis_rsl_dchan_hdr *dh;
743
744 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
745 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200746 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltee6d51f92011-06-25 10:02:33 +0200747 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200748 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200749
Harald Weltede4477a2009-12-24 12:20:20 +0100750 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200751 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200752
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200753 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte874a5b42009-08-10 11:26:14 +0200754
Harald Welte4684e632009-08-10 09:51:40 +0200755 return abis_rsl_sendmsg(msg);
756}
757
758
Harald Welte59b04682009-06-10 05:40:52 +0800759/* Send "DATA REQUEST" message with given L3 Info payload */
760/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200761int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte59b04682009-06-10 05:40:52 +0800762{
Harald Welte59b04682009-06-10 05:40:52 +0800763 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100764 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800765 return -EINVAL;
766 }
767
Harald Weltee6d51f92011-06-25 10:02:33 +0200768 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100769 link_id, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800770
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200771 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte59b04682009-06-10 05:40:52 +0800772
773 return abis_rsl_sendmsg(msg);
774}
775
Harald Welteed9a5ab2009-08-09 13:47:35 +0200776/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
777/* Chapter 8.3.1 */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200778int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteed9a5ab2009-08-09 13:47:35 +0200779{
Harald Weltea22d36b2010-03-04 10:33:10 +0100780 struct msgb *msg;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200781
Harald Weltee6d51f92011-06-25 10:02:33 +0200782 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100783 link_id, 0);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200784 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteed9a5ab2009-08-09 13:47:35 +0200785
786 return abis_rsl_sendmsg(msg);
787}
788
Harald Welte0f2e3c12009-08-08 13:15:07 +0200789/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
790 This is what higher layers should call. The BTS then responds with
791 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
792 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
793 lchan_free() */
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200794int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welte0f2e3c12009-08-08 13:15:07 +0200795{
Harald Welte0f2e3c12009-08-08 13:15:07 +0200796
Harald Weltea22d36b2010-03-04 10:33:10 +0100797 struct msgb *msg;
798
Harald Weltee6d51f92011-06-25 10:02:33 +0200799 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Weltea22d36b2010-03-04 10:33:10 +0100800 link_id, 0);
Holger Hans Peter Freytherbcea9a72010-06-08 11:57:45 +0800801 /* 0 is normal release, 1 is local end */
802 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welte0f2e3c12009-08-08 13:15:07 +0200803
Harald Weltec88a4432009-12-29 10:44:17 +0100804 /* FIXME: start some timer in case we don't receive a REL ACK ? */
805
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +0200806 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte0f2e3c12009-08-08 13:15:07 +0200807
808 return abis_rsl_sendmsg(msg);
809}
810
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200811int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
812{
813 lchan->state = state;
814 return 0;
815}
816
Harald Welte59b04682009-06-10 05:40:52 +0800817/* Chapter 8.4.2: Channel Activate Acknowledge */
818static int rsl_rx_chan_act_ack(struct msgb *msg)
819{
820 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
821
822 /* BTS has confirmed channel activation, we now need
823 * to assign the activated channel to the MS */
824 if (rslh->ie_chan != RSL_IE_CHAN_NR)
825 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100826
Harald Welte32951ea2011-08-10 23:26:33 +0200827 osmo_timer_del(&msg->lchan->act_timer);
828
Harald Weltec88a4432009-12-29 10:44:17 +0100829 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welteab2534c2009-12-29 10:52:38 +0100830 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
831 gsm_lchan_name(msg->lchan),
832 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200833 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welte4baa9c52009-12-21 13:27:11 +0100834
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +0800835 if (msg->lchan->rqd_ref) {
836 rsl_send_imm_assignment(msg->lchan);
837 talloc_free(msg->lchan->rqd_ref);
838 msg->lchan->rqd_ref = NULL;
839 msg->lchan->rqd_ta = 0;
840 }
841
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100842 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100843
Harald Welte59b04682009-06-10 05:40:52 +0800844 return 0;
845}
846
847/* Chapter 8.4.3: Channel Activate NACK */
848static int rsl_rx_chan_act_nack(struct msgb *msg)
849{
850 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
851 struct tlv_parsed tp;
852
Harald Welte32951ea2011-08-10 23:26:33 +0200853 osmo_timer_del(&msg->lchan->act_timer);
854
Daniel Willmann9e9d44c2011-08-11 04:54:23 +0200855 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100856 gsm_lchan_name(msg->lchan));
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100857
Harald Welte59b04682009-06-10 05:40:52 +0800858 /* BTS has rejected channel activation ?!? */
859 if (dh->ie_chan != RSL_IE_CHAN_NR)
860 return -EINVAL;
861
862 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100863 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200864 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100865 print_rsl_cause(LOGL_ERROR, cause,
Harald Weltef1a168d2009-07-28 17:58:09 +0200866 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100867 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200868 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Daniel Willmann245ee032011-08-11 04:47:11 +0200869 else
870 rsl_rf_chan_release(msg->lchan, 1);
871
Harald Welte (local)c3be50c2009-12-27 18:12:29 +0100872 } else
Holger Hans Peter Freyther68914a02010-04-10 00:12:31 +0200873 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +0200874
Harald Welte (local)ed6d7622009-12-27 11:48:11 +0100875 LOGPC(DRSL, LOGL_ERROR, "\n");
876
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +0100877 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +0100878
Harald Weltecddb9802009-08-09 19:50:08 +0200879 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800880 return 0;
881}
882
883/* Chapter 8.4.4: Connection Failure Indication */
884static int rsl_rx_conn_fail(struct msgb *msg)
885{
886 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
887 struct tlv_parsed tp;
888
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100889 /* FIXME: print which channel */
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100890 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +0100891 gsm_lchan_name(msg->lchan));
Harald Welte59b04682009-06-10 05:40:52 +0800892
893 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
894
Harald Weltef1a168d2009-07-28 17:58:09 +0200895 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100896 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200897 TLVP_LEN(&tp, RSL_IE_CAUSE));
898
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100899 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800900 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +0200901 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +0800902 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte59b04682009-06-10 05:40:52 +0800903}
904
Harald Weltec20bd1d2009-11-29 19:07:28 +0100905static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
906 const char *prefix)
907{
Harald Welte0e4fa782009-12-16 16:52:07 +0100908 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
909 prefix, rxlev2dbm(mru->full.rx_lev),
910 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100911 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
912 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
913}
914
915static void print_meas_rep(struct gsm_meas_rep *mr)
916{
Harald Welte0e4fa782009-12-16 16:52:07 +0100917 int i;
918
Harald Weltec20bd1d2009-11-29 19:07:28 +0100919 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
920
921 if (mr->flags & MEAS_REP_F_DL_DTX)
922 DEBUGPC(DMEAS, "DTXd ");
923
924 print_meas_rep_uni(&mr->ul, "ul");
925 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
926 if (mr->flags & MEAS_REP_F_MS_TO)
927 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
928
929 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100930 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100931 DEBUGPC(DMEAS, "L1_FPC=%u ",
932 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
933 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
934 }
935
936 if (mr->flags & MEAS_REP_F_UL_DTX)
937 DEBUGPC(DMEAS, "DTXu ");
938 if (mr->flags & MEAS_REP_F_BA1)
939 DEBUGPC(DMEAS, "BA1 ");
940 if (!(mr->flags & MEAS_REP_F_DL_VALID))
941 DEBUGPC(DMEAS, "NOT VALID ");
942 else
943 print_meas_rep_uni(&mr->dl, "dl");
944
945 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +0100946 if (mr->num_cell == 7)
947 return;
Harald Welte0e4fa782009-12-16 16:52:07 +0100948 for (i = 0; i < mr->num_cell; i++) {
949 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +0100950 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
951 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +0100952 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100953}
954
Harald Welte59b04682009-06-10 05:40:52 +0800955static int rsl_rx_meas_res(struct msgb *msg)
956{
957 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
958 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +0100959 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +0200960 uint8_t len;
961 const uint8_t *val;
Harald Weltec20bd1d2009-11-29 19:07:28 +0100962 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800963
Harald Welte4baa9c52009-12-21 13:27:11 +0100964 /* check if this channel is actually active */
965 /* FIXME: maybe this check should be way more generic/centralized */
Harald Weltec88a4432009-12-29 10:44:17 +0100966 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freyther67a2e292010-07-29 14:50:57 +0800967 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Weltec88a4432009-12-29 10:44:17 +0100968 gsm_lchan_name(msg->lchan));
Harald Welte4baa9c52009-12-21 13:27:11 +0100969 return 0;
Harald Weltec88a4432009-12-29 10:44:17 +0100970 }
Harald Welte4baa9c52009-12-21 13:27:11 +0100971
Harald Weltef9476812009-12-15 21:36:05 +0100972 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +0100973 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +0100974
Harald Welte59b04682009-06-10 05:40:52 +0800975 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
976
Harald Weltec20bd1d2009-11-29 19:07:28 +0100977 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
978 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
979 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
980 return -EIO;
981
982 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +0100983 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100984
985 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
986 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
987 if (len >= 3) {
988 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +0100989 mr->flags |= MEAS_REP_F_DL_DTX;
990 mr->ul.full.rx_lev = val[0] & 0x3f;
991 mr->ul.sub.rx_lev = val[1] & 0x3f;
992 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
993 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +0800994 }
Harald Weltec20bd1d2009-11-29 19:07:28 +0100995
Harald Weltef9476812009-12-15 21:36:05 +0100996 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100997
998 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +0800999 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001000 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001001 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1002
Harald Weltea1467eb2009-06-20 18:44:35 +02001003 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001004 struct e1inp_sign_link *sign_link = msg->dst;
1005
Harald Weltec20bd1d2009-11-29 19:07:28 +01001006 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001007 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001008 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001009 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001010 mr->flags |= MEAS_REP_F_FPC;
1011 mr->ms_l1.ta = val[1];
Andreas Eversbergfe56cf82011-12-24 11:49:05 +01001012 /* BS11 and Nokia reports TA shifted by 2 bits */
1013 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1014 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg0f18e5e2011-12-16 17:45:37 +01001015 mr->ms_l1.ta >>= 2;
Harald Weltea1467eb2009-06-20 18:44:35 +02001016 }
Harald Welte59b04682009-06-10 05:40:52 +08001017 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001018 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001019 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001020 if (rc < 0)
1021 return rc;
1022 }
1023
Harald Weltef9476812009-12-15 21:36:05 +01001024 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001025
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001026 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001027
Harald Welte59b04682009-06-10 05:40:52 +08001028 return 0;
1029}
1030
Harald Welte6720a432009-11-29 22:45:52 +01001031/* Chapter 8.4.7 */
1032static int rsl_rx_hando_det(struct msgb *msg)
1033{
1034 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1035 struct tlv_parsed tp;
1036
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001037 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welte6720a432009-11-29 22:45:52 +01001038
1039 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1040
1041 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1042 DEBUGPC(DRSL, "access delay = %u\n",
1043 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1044 else
1045 DEBUGPC(DRSL, "\n");
1046
Holger Hans Peter Freyther645b3832010-12-27 13:28:20 +01001047 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welte6720a432009-11-29 22:45:52 +01001048
1049 return 0;
1050}
1051
Harald Welte59b04682009-06-10 05:40:52 +08001052static int abis_rsl_rx_dchan(struct msgb *msg)
1053{
1054 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1055 int rc = 0;
1056 char *ts_name;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001057 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001058
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001059 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)c4e9c9c2009-12-27 18:16:36 +01001060 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001061
Harald Welte59b04682009-06-10 05:40:52 +08001062 switch (rslh->c.msg_type) {
1063 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001064 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001065 rc = rsl_rx_chan_act_ack(msg);
1066 break;
1067 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001068 rc = rsl_rx_chan_act_nack(msg);
1069 break;
1070 case RSL_MT_CONN_FAIL:
1071 rc = rsl_rx_conn_fail(msg);
1072 break;
1073 case RSL_MT_MEAS_RES:
1074 rc = rsl_rx_meas_res(msg);
1075 break;
Harald Welte6720a432009-11-29 22:45:52 +01001076 case RSL_MT_HANDO_DET:
1077 rc = rsl_rx_hando_det(msg);
1078 break;
Harald Welte59b04682009-06-10 05:40:52 +08001079 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte9773f6c2011-01-14 14:16:16 +01001080 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001081 break;
1082 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001083 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001084 break;
1085 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001086 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001087 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001088 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001089 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001090 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001091 break;
1092 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001093 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001094 break;
1095 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001096 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte2b361522010-03-28 14:42:09 +08001097 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welteaed946e2009-10-24 10:29:22 +02001098 break;
1099 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001100 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001101 break;
Harald Welte59b04682009-06-10 05:40:52 +08001102 case RSL_MT_PHY_CONTEXT_CONF:
1103 case RSL_MT_PREPROC_MEAS_RES:
1104 case RSL_MT_TALKER_DET:
1105 case RSL_MT_LISTENER_DET:
1106 case RSL_MT_REMOTE_CODEC_CONF_REP:
1107 case RSL_MT_MR_CODEC_MOD_ACK:
1108 case RSL_MT_MR_CODEC_MOD_NACK:
1109 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001110 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1111 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001112 break;
1113 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001114 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1115 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001116 return -EINVAL;
1117 }
1118
1119 return rc;
1120}
1121
1122static int rsl_rx_error_rep(struct msgb *msg)
1123{
1124 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001125 struct tlv_parsed tp;
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001126 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001127
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001128 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Weltef1a168d2009-07-28 17:58:09 +02001129
1130 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1131
1132 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001133 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001134 TLVP_LEN(&tp, RSL_IE_CAUSE));
1135
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001136 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001137
1138 return 0;
1139}
1140
1141static int abis_rsl_rx_trx(struct msgb *msg)
1142{
1143 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001144 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte59b04682009-06-10 05:40:52 +08001145 int rc = 0;
1146
1147 switch (rslh->msg_type) {
1148 case RSL_MT_ERROR_REPORT:
1149 rc = rsl_rx_error_rep(msg);
1150 break;
1151 case RSL_MT_RF_RES_IND:
1152 /* interference on idle channels of TRX */
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001153 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001154 break;
1155 case RSL_MT_OVERLOAD:
Holger Hans Peter Freyther71135142010-03-29 08:47:44 +02001156 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001157 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001158 gsm_trx_name(sign_link->trx));
Harald Welte59b04682009-06-10 05:40:52 +08001159 break;
Dieter Spaar49c843e2011-07-28 00:01:50 +02001160 case 0x42: /* Nokia specific: SI End ACK */
1161 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1162 break;
1163 case 0x43: /* Nokia specific: SI End NACK */
1164 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1165 break;
Harald Welte59b04682009-06-10 05:40:52 +08001166 default:
Harald Welte (local)ab788cf2009-12-28 23:14:22 +01001167 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001168 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001169 return -EINVAL;
1170 }
1171 return rc;
1172}
1173
Harald Welte427dbc42009-08-10 00:26:10 +02001174/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1175static void t3101_expired(void *data)
1176{
1177 struct gsm_lchan *lchan = data;
1178
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001179 rsl_rf_chan_release(lchan, 1);
Harald Welte427dbc42009-08-10 00:26:10 +02001180}
1181
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001182/* If T3111 expires, we will send the RF Channel Request */
1183static void t3111_expired(void *data)
1184{
1185 struct gsm_lchan *lchan = data;
1186
Holger Hans Peter Freyther10ea12f2010-05-31 21:38:24 +08001187 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freyther4a00c062010-05-31 21:33:15 +08001188}
1189
laforge50312e82010-06-21 12:08:52 +02001190#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1191
Harald Weltea00fdd72010-12-23 14:39:29 +01001192/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1193static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1194 unsigned int num_req_refs,
1195 struct gsm48_req_ref *rqd_refs,
1196 uint8_t wait_ind)
1197{
1198 uint8_t buf[GSM_MACBLOCK_LEN];
1199 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1200
1201 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1202 memset(iar, 0, sizeof(*iar));
1203 iar->proto_discr = GSM48_PDISC_RR;
1204 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1205 iar->page_mode = GSM48_PM_SAME;
1206
1207 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1208 iar->wait_ind1 = wait_ind;
1209
1210 if (num_req_refs >= 2)
1211 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1212 else
1213 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1214 iar->wait_ind2 = wait_ind;
1215
1216 if (num_req_refs >= 3)
1217 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1218 else
1219 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1220 iar->wait_ind3 = wait_ind;
1221
1222 if (num_req_refs >= 4)
1223 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1224 else
1225 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1226 iar->wait_ind4 = wait_ind;
1227
1228 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1229}
1230
Harald Welte59b04682009-06-10 05:40:52 +08001231/* MS has requested a channel on the RACH */
1232static int rsl_rx_chan_rqd(struct msgb *msg)
1233{
Pablo Neira Ayuso88c9bba2011-08-17 22:43:54 +02001234 struct e1inp_sign_link *sign_link = msg->dst;
1235 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte59b04682009-06-10 05:40:52 +08001236 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1237 struct gsm48_req_ref *rqd_ref;
Harald Welte59b04682009-06-10 05:40:52 +08001238 enum gsm_chan_t lctype;
1239 enum gsm_chreq_reason_t chreq_reason;
1240 struct gsm_lchan *lchan;
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001241 uint8_t rqd_ta;
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001242 int is_lu;
Harald Welte59b04682009-06-10 05:40:52 +08001243
Holger Hans Peter Freyther7eb8a9a2011-04-18 17:04:00 +02001244 uint16_t arfcn;
Holger Hans Peter Freytherefd75b52012-02-03 20:10:13 +01001245 uint8_t subch;
Harald Welte59b04682009-06-10 05:40:52 +08001246
1247 /* parse request reference to be used in immediate assign */
1248 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1249 return -EINVAL;
1250
1251 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1252
1253 /* parse access delay and use as TA */
1254 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1255 return -EINVAL;
1256 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1257
1258 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1259 * request reference RA */
Holger Hans Peter Freytherf0f37f12010-09-06 09:36:02 +08001260 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1261 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001262
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001263 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001264
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001265 /*
1266 * We want LOCATION UPDATES to succeed and will assign a TCH
1267 * if we have no SDCCH available.
1268 */
1269 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1270
Harald Welte59b04682009-06-10 05:40:52 +08001271 /* check availability / allocate channel */
Holger Hans Peter Freytherdb392032010-09-06 08:58:42 +08001272 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte59b04682009-06-10 05:40:52 +08001273 if (!lchan) {
Harald Welte (local)e0bb5fa2009-12-27 13:48:09 +01001274 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)02204d02009-12-27 18:05:25 +01001275 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayuso1c450742011-05-06 12:13:10 +02001276 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Weltea00fdd72010-12-23 14:39:29 +01001277 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1278 if (bts->network->T3122)
1279 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte59b04682009-06-10 05:40:52 +08001280 return -ENOMEM;
1281 }
1282
Harald Weltec88a4432009-12-29 10:44:17 +01001283 if (lchan->state != LCHAN_S_NONE)
1284 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welteab2534c2009-12-29 10:52:38 +01001285 "in state %s\n", gsm_lchan_name(lchan),
1286 gsm_lchans_name(lchan->state));
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
Holger Hans Peter Freyther161cec12011-12-29 23:33:04 +01001296 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freytherc08f6f02010-06-22 12:11:59 +08001297 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1298 lchan->rqd_ta = rqd_ta;
1299
Harald Welte59b04682009-06-10 05:40:52 +08001300 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}