blob: 4d61dc05d22ed50c698f923a6e1ca8aa04285e53 [file] [log] [blame]
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001/* GSM Radio Signalling Link messages on the A-bis interface
Harald Welte52b1f982008-12-23 20:25:15 +00002 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Welte3c9c5f92010-03-04 10:33:10 +01004/* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
Harald Welte8470bf22008-12-25 23:28:35 +00005 *
Harald Welte52b1f982008-12-23 20:25:15 +00006 * All Rights Reserved
7 *
8 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +01009 * it under the terms of the GNU Affero General Public License as published by
10 * the Free Software Foundation; either version 3 of the License, or
Harald Welte52b1f982008-12-23 20:25:15 +000011 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010016 * GNU Affero General Public License for more details.
Harald Welte52b1f982008-12-23 20:25:15 +000017 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010018 * You should have received a copy of the GNU Affero General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Harald Welte52b1f982008-12-23 20:25:15 +000020 *
21 */
22
23#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000024#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000025#include <errno.h>
Harald Welte75099262009-02-16 21:12:08 +000026#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000027#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000028
Harald Welte8470bf22008-12-25 23:28:35 +000029#include <openbsc/gsm_data.h>
30#include <openbsc/gsm_04_08.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010031#include <osmocom/gsm/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000032#include <openbsc/abis_rsl.h>
33#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020034#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000035#include <openbsc/debug.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010036#include <osmocom/gsm/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000037#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000038#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010039#include <openbsc/meas_rep.h>
Harald Welte17f5bf62009-12-20 15:42:44 +010040#include <openbsc/rtp_proxy.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010041#include <osmocom/gsm/rsl.h>
Harald Welte52b1f982008-12-23 20:25:15 +000042
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080044
Harald Welte8470bf22008-12-25 23:28:35 +000045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000047
Holger Freyther3b72a892009-02-04 00:31:39 +000048#define MAX(a, b) (a) >= (b) ? (a) : (b)
49
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080050static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
51
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010052static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
53 struct gsm_meas_rep *resp)
54{
55 struct lchan_signal_data sig;
56 sig.lchan = lchan;
57 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020058 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010059}
60
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020061static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000062{
63 /* mask off the transparent bit ? */
64 msg_type &= 0xfe;
65
Harald Welte8470bf22008-12-25 23:28:35 +000066 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000067 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000068 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000069 if (msg_type >= 0x19 && msg_type <= 0x22)
70 return ABIS_RSL_MDISC_TRX;
71 else
72 return ABIS_RSL_MDISC_COM_CHAN;
73 }
Harald Welte2d5b6382008-12-27 19:46:06 +000074 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000075 return ABIS_RSL_MDISC_DED_CHAN;
76
77 return ABIS_RSL_MDISC_LOC;
78}
79
80static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020081 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000082{
83 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
84 dh->c.msg_type = msg_type;
85 dh->ie_chan = RSL_IE_CHAN_NR;
86}
87
Harald Welte8470bf22008-12-25 23:28:35 +000088/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020089struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +000090{
91 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020092 uint8_t ts_nr = chan_nr & 0x07;
93 uint8_t cbits = chan_nr >> 3;
94 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +000095 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
96
97 if (cbits == 0x01) {
98 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020099 if (ts->pchan != GSM_PCHAN_TCH_F &&
100 ts->pchan != GSM_PCHAN_PDCH &&
101 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100102 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000103 chan_nr, ts->pchan);
104 } else if ((cbits & 0x1e) == 0x02) {
105 lch_idx = cbits & 0x1; /* TCH/H */
106 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100107 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000108 chan_nr, ts->pchan);
109 } else if ((cbits & 0x1c) == 0x04) {
110 lch_idx = cbits & 0x3; /* SDCCH/4 */
111 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100112 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000113 chan_nr, ts->pchan);
114 } else if ((cbits & 0x18) == 0x08) {
115 lch_idx = cbits & 0x7; /* SDCCH/8 */
116 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100117 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000118 chan_nr, ts->pchan);
119 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
120 lch_idx = 0;
121 if (ts->pchan != GSM_PCHAN_CCCH &&
122 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100123 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000124 chan_nr, ts->pchan);
125 /* FIXME: we should not return first sdcch4 !!! */
126 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100127 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000128 return NULL;
129 }
130
131 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800132 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800133 if (lchan->conn)
134 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000135
136 return lchan;
137}
138
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200139/* See Table 10.5.25 of GSM04.08 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200140static uint8_t ts2chan_nr(const struct gsm_bts_trx_ts *ts, uint8_t lchan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +0000141{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200142 uint8_t cbits, chan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000143
144 switch (ts->pchan) {
145 case GSM_PCHAN_TCH_F:
Harald Weltea1499d02009-10-24 10:25:50 +0200146 case GSM_PCHAN_PDCH:
147 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000148 cbits = 0x01;
149 break;
150 case GSM_PCHAN_TCH_H:
151 cbits = 0x02;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100152 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000153 break;
154 case GSM_PCHAN_CCCH_SDCCH4:
155 cbits = 0x04;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100156 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000157 break;
158 case GSM_PCHAN_SDCCH8_SACCH8C:
159 cbits = 0x08;
Harald Welte53cd7ac2010-12-23 12:59:52 +0100160 cbits += lchan_nr;
Harald Welte8470bf22008-12-25 23:28:35 +0000161 break;
162 default:
163 case GSM_PCHAN_CCCH:
164 cbits = 0x10;
165 break;
166 }
167
168 chan_nr = (cbits << 3) | (ts->nr & 0x7);
169
170 return chan_nr;
171}
172
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200173uint8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte53cd7ac2010-12-23 12:59:52 +0100174{
175 return ts2chan_nr(lchan->ts, lchan->nr);
176}
177
Harald Welte52b1f982008-12-23 20:25:15 +0000178/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200179uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000180{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200181 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000182
183 ret = strtoull(imsi_str, NULL, 10);
184
185 return ret;
186}
187
188/* Table 5 Clause 7 TS 05.02 */
189unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
190{
191 if (!bs_ccch_sdcch_comb)
192 return 9 - bs_ag_blks_res;
193 else
194 return 3 - bs_ag_blks_res;
195}
196
197/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200198unsigned int get_ccch_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000199 unsigned int n_pag_blocks)
200{
201 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
202}
203
204/* Chapter 6.5.2 of TS 05.02 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200205unsigned int get_paging_group(uint64_t imsi, unsigned int bs_cc_chans,
Harald Welte52b1f982008-12-23 20:25:15 +0000206 int n_pag_blocks)
207{
208 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
209}
210
Harald Welte8470bf22008-12-25 23:28:35 +0000211static struct msgb *rsl_msgb_alloc(void)
212{
Harald Welte966636f2009-06-26 19:39:35 +0200213 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
214 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000215}
216
Harald Welte362322e2009-02-15 14:36:38 +0000217#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200218static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000219{
220 memcpy(out, in, len);
221
222 if (len < MACBLOCK_SIZE)
223 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
224}
225
Harald Welte08d91a52009-08-30 15:37:11 +0900226/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200227static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900228{
229 *out++ = lchan->encr.alg_id & 0xff;
230 if (lchan->encr.key_len)
231 memcpy(out, lchan->encr.key, lchan->encr.key_len);
232 return lchan->encr.key_len + 1;
233}
234
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200235static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200236{
Harald Welte7f93cea2009-02-23 00:02:59 +0000237 int i;
238
Harald Welte5b8ed432009-12-24 12:20:20 +0100239 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200240 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200241 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100242 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000243}
244
Harald Welte52b1f982008-12-23 20:25:15 +0000245/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200246int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
247 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000248{
249 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000250 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000251
252 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
253 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
254 dh->chan_nr = RSL_CHAN_BCCH;
255
256 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
257 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
258
Harald Weltee79769b2009-02-07 00:48:17 +0000259 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000260
261 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000262}
263
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200264int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
265 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000266{
267 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000268 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000269
270 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
271 ch->msg_discr = ABIS_RSL_MDISC_TRX;
272 ch->msg_type = RSL_MT_SACCH_FILL;
273
274 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000275 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000276
Harald Weltee79769b2009-02-07 00:48:17 +0000277 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000278
279 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000280}
281
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200282int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
283 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100284{
285 struct abis_rsl_dchan_hdr *dh;
286 struct msgb *msg = rsl_msgb_alloc();
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200287 uint8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100288
289 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
290 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
291 dh->chan_nr = chan_nr;
292
293 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
294 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
295
296 msg->trx = lchan->ts->trx;
297
298 return abis_rsl_sendmsg(msg);
299}
300
Harald Weltefcd24452009-06-20 18:15:19 +0200301int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
302{
303 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200304 struct msgb *msg;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200305 uint8_t chan_nr = lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200306
307 db = abs(db);
308 if (db > 30)
309 return -EINVAL;
310
Harald Welteeab33352009-06-27 03:09:08 +0200311 msg = rsl_msgb_alloc();
312
Harald Weltefcd24452009-06-20 18:15:19 +0200313 lchan->bs_power = db/2;
314 if (fpc)
315 lchan->bs_power |= 0x10;
316
317 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
318 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
319 dh->chan_nr = chan_nr;
320
321 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
322
323 msg->trx = lchan->ts->trx;
324
325 return abis_rsl_sendmsg(msg);
326}
327
Harald Weltefcd24452009-06-20 18:15:19 +0200328int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
329{
330 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200331 struct msgb *msg;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200332 uint8_t chan_nr = lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200333 int ctl_lvl;
334
Harald Welte66b6a8d2009-08-09 14:45:18 +0200335 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200336 if (ctl_lvl < 0)
337 return ctl_lvl;
338
Harald Welteeab33352009-06-27 03:09:08 +0200339 msg = rsl_msgb_alloc();
340
Harald Weltefcd24452009-06-20 18:15:19 +0200341 lchan->ms_power = ctl_lvl;
342
343 if (fpc)
344 lchan->ms_power |= 0x20;
345
346 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
347 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
348 dh->chan_nr = chan_nr;
349
350 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
351
352 msg->trx = lchan->ts->trx;
353
354 return abis_rsl_sendmsg(msg);
355}
356
Harald Welte9943c5b2009-07-29 15:41:29 +0200357static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
358 struct gsm_lchan *lchan)
359{
360 memset(cm, 0, sizeof(cm));
361
362 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800363 if (lchan->ts->trx->bts->network->dtx_enabled)
364 cm->dtx_dtu = 0x03;
365 else
366 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200367
368 /* set TCH Speech/Data */
369 cm->spd_ind = lchan->rsl_cmode;
370
Harald Welte1a79d362009-11-27 08:55:16 +0100371 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
372 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100373 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100374 "but tch_mode != signalling\n");
375
Harald Welte9943c5b2009-07-29 15:41:29 +0200376 switch (lchan->type) {
377 case GSM_LCHAN_SDCCH:
378 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
379 break;
380 case GSM_LCHAN_TCH_F:
381 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
382 break;
383 case GSM_LCHAN_TCH_H:
384 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
385 break;
386 case GSM_LCHAN_NONE:
387 case GSM_LCHAN_UNKNOWN:
388 default:
389 return -EINVAL;
390 }
391
392 switch (lchan->tch_mode) {
393 case GSM48_CMODE_SIGN:
394 cm->chan_rate = 0;
395 break;
396 case GSM48_CMODE_SPEECH_V1:
397 cm->chan_rate = RSL_CMOD_SP_GSM1;
398 break;
399 case GSM48_CMODE_SPEECH_EFR:
400 cm->chan_rate = RSL_CMOD_SP_GSM2;
401 break;
402 case GSM48_CMODE_SPEECH_AMR:
403 cm->chan_rate = RSL_CMOD_SP_GSM3;
404 break;
405 case GSM48_CMODE_DATA_14k5:
406 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
407 break;
408 case GSM48_CMODE_DATA_12k0:
409 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
410 break;
411 case GSM48_CMODE_DATA_6k0:
412 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
413 break;
414 default:
415 return -EINVAL;
416 }
417
418 return 0;
419}
420
Harald Welte52b1f982008-12-23 20:25:15 +0000421/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000422#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200423int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
424 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000425 struct rsl_ie_chan_mode *chan_mode,
426 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200427 uint8_t bs_power, uint8_t ms_power,
428 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000429{
430 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000431 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000432
433 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
434 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
435 dh->chan_nr = chan_nr;
436
437 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
438 /* For compatibility with Phase 1 */
439 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200440 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000441 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200442 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000443#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000444 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200445 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000446#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000447 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000448 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
449 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
450
Harald Weltee79769b2009-02-07 00:48:17 +0000451 msg->trx = trx;
452
Harald Welte8470bf22008-12-25 23:28:35 +0000453 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000454}
Harald Welteddab3c72009-02-28 13:19:15 +0000455#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000456
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200457int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
458 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000459{
460 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200461 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200462 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200463 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000464
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200465 uint8_t chan_nr = lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000466 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200467 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000468
Harald Welte9943c5b2009-07-29 15:41:29 +0200469 rc = channel_mode_from_lchan(&cm, lchan);
470 if (rc < 0)
471 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000472
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800473 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200474 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000475
Harald Welteeab33352009-06-27 03:09:08 +0200476 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000477 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
478 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
479 dh->chan_nr = chan_nr;
480
481 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000482 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200483 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800484
485 /*
486 * The Channel Identification is needed for Phase1 phones
487 * and it contains the GSM48 Channel Description and the
488 * Mobile Allocation. The GSM 08.58 asks for the Mobile
489 * Allocation to have a length of zero. We are using the
490 * msgb_l3len to calculate the length of both messages.
491 */
laforge694a5cf2010-06-20 21:38:19 +0200492 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200493 len = msgb_put(msg, 1);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800494 msgb_tlv_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800495
496 if (lchan->ts->hopping.enabled)
497 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
498 lchan->ts->hopping.ma_data);
499 else
500 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800501
502 /* update the calculated size */
503 msg->l3h = len + 1;
504 *len = msgb_l3len(msg);
505
Harald Welte08d91a52009-08-30 15:37:11 +0900506 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200507 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900508 rc = build_encr_info(encr_info, lchan);
509 if (rc > 0)
510 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
511 }
512
Harald Welte8d77b952009-12-17 00:31:10 +0100513 switch (act_type) {
514 case RSL_ACT_INTER_ASYNC:
515 case RSL_ACT_INTER_SYNC:
516 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
517 break;
518 default:
519 break;
520 }
521
Harald Welted4c9bf32009-02-15 16:56:18 +0000522 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
523 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000524 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
525
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100526 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
527 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200528 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100529
Harald Weltee79769b2009-02-07 00:48:17 +0000530 msg->trx = lchan->ts->trx;
531
Harald Welte4b634542008-12-27 01:55:51 +0000532 return abis_rsl_sendmsg(msg);
533}
534
Harald Welte470abb72009-07-29 11:38:15 +0200535/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000536int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
537{
538 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200539 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200540 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000541
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200542 uint8_t chan_nr = lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000543 struct rsl_ie_chan_mode cm;
544
Harald Welte9943c5b2009-07-29 15:41:29 +0200545 rc = channel_mode_from_lchan(&cm, lchan);
546 if (rc < 0)
547 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000548
Harald Welteeab33352009-06-27 03:09:08 +0200549 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000550 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
551 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
552 dh->chan_nr = chan_nr;
553
554 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200555 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900556
557 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200558 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900559 rc = build_encr_info(encr_info, lchan);
560 if (rc > 0)
561 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
562 }
563
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100564 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
565 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200566 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100567 }
568
Harald Welte08d91a52009-08-30 15:37:11 +0900569 msg->trx = lchan->ts->trx;
570
571 return abis_rsl_sendmsg(msg);
572}
573
574/* Chapter 8.4.6: Send the encryption command with given L3 info */
575int rsl_encryption_cmd(struct msgb *msg)
576{
577 struct abis_rsl_dchan_hdr *dh;
578 struct gsm_lchan *lchan = msg->lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200579 uint8_t chan_nr = lchan2chan_nr(lchan);
580 uint8_t encr_info[MAX_A5_KEY_LEN+2];
581 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900582 int rc;
583
584 /* First push the L3 IE tag and length */
585 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
586
587 /* then the link identifier (SAPI0, main sign link) */
588 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
589
590 /* then encryption information */
591 rc = build_encr_info(encr_info, lchan);
592 if (rc <= 0)
593 return rc;
594 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
595
596 /* and finally the DCHAN header */
597 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
598 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
599 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000600
601 msg->trx = lchan->ts->trx;
602
603 return abis_rsl_sendmsg(msg);
604}
605
Harald Welte115d1032009-08-10 11:43:22 +0200606/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200607int rsl_deact_sacch(struct gsm_lchan *lchan)
608{
609 struct abis_rsl_dchan_hdr *dh;
610 struct msgb *msg = rsl_msgb_alloc();
611
612 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
613 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
614 dh->chan_nr = lchan2chan_nr(lchan);
615
616 msg->lchan = lchan;
617 msg->trx = lchan->ts->trx;
618
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100619 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200620
621 return abis_rsl_sendmsg(msg);
622}
623
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800624static void error_timeout_cb(void *data)
625{
626 struct gsm_lchan *lchan = data;
627 if (lchan->state != LCHAN_S_REL_ERR) {
628 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
629 gsm_lchan_name(lchan), lchan->state);
630 return;
631 }
632
633 /* go back to the none state */
634 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800635 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800636}
637
Harald Weltefd355a32011-03-04 13:41:31 +0100638static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
639
Harald Welte115d1032009-08-10 11:43:22 +0200640/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800641static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000642{
643 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800644 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100645 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000646
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800647 if (lchan->state == LCHAN_S_REL_ERR) {
648 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
649 gsm_lchan_name(lchan));
650 return -1;
651 }
652
653 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000654 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
655 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000656 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000657
Harald Welte8470bf22008-12-25 23:28:35 +0000658 msg->lchan = lchan;
659 msg->trx = lchan->ts->trx;
660
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800661 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
662
663 if (error) {
664 /*
665 * the nanoBTS sends RLL release indications after the channel release. This can
666 * be a problem when we have reassigned the channel to someone else and then can
667 * not figure out who used this channel.
668 */
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800669 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800670 lchan->error_timer.data = lchan;
671 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200672 osmo_timer_schedule(&lchan->error_timer,
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800673 msg->trx->bts->network->T3111 + 2, 0);
674 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000675
Harald Weltefd355a32011-03-04 13:41:31 +0100676 rc = abis_rsl_sendmsg(msg);
677
Harald Welte115d1032009-08-10 11:43:22 +0200678 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100679#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100680 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
681 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
682 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100683#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100684
685 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000686}
687
Harald Welte64bb7542011-01-14 14:16:16 +0100688static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
689{
690
691 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
692
693 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
694 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
695 gsm_lchan_name(lchan),
696 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200697 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100698 /* we have an error timer pending to release that */
699 if (lchan->state != LCHAN_S_REL_ERR)
700 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
701 lchan_free(lchan);
702
703 return 0;
704}
705
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200706int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
707 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000708{
709 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000710 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000711
712 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
713 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
714 dh->chan_nr = RSL_CHAN_PCH_AGCH;
715
716 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000717 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000718 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
719
Harald Welte8470bf22008-12-25 23:28:35 +0000720 msg->trx = bts->c0;
721
722 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000723}
724
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200725int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000726{
727 int i, len = strlen(str_in);
728
729 for (i = 0; i < len; i++) {
730 int num = str_in[i] - 0x30;
731 if (num < 0 || num > 9)
732 return -1;
733 if (i % 2 == 0)
734 bcd_out[i/2] = num;
735 else
736 bcd_out[i/2] |= (num << 4);
737 }
738
739 return 0;
740}
741
Harald Welte702d8702008-12-26 20:25:35 +0000742/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200743int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000744{
Harald Welte8470bf22008-12-25 23:28:35 +0000745 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000746 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200747 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000748
749 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
750 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
751 dh->chan_nr = RSL_CHAN_PCH_AGCH;
752
Harald Welte362322e2009-02-15 14:36:38 +0000753 switch (bts->type) {
754 case GSM_BTS_TYPE_BS11:
755 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
756 break;
757 default:
758 /* If phase 2, construct a FULL_IMM_ASS_INFO */
759 pad_macblock(buf, val, len);
760 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
761 break;
762 }
Harald Welte52b1f982008-12-23 20:25:15 +0000763
Harald Welte8470bf22008-12-25 23:28:35 +0000764 msg->trx = bts->c0;
765
766 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000767}
768
Harald Welte67fa91b2009-08-10 09:51:40 +0200769/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200770int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200771{
772 struct msgb *msg = rsl_msgb_alloc();
773 struct abis_rsl_dchan_hdr *dh;
774
775 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
776 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200777 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200778 dh->chan_nr = lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200779 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200780
Harald Welte5b8ed432009-12-24 12:20:20 +0100781 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200782 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200783
784 msg->trx = lchan->ts->trx;
785
Harald Welte67fa91b2009-08-10 09:51:40 +0200786 return abis_rsl_sendmsg(msg);
787}
788
789
Harald Welte8470bf22008-12-25 23:28:35 +0000790/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000791/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200792int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000793{
Harald Welte8470bf22008-12-25 23:28:35 +0000794 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100795 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000796 return -EINVAL;
797 }
Harald Welte52b1f982008-12-23 20:25:15 +0000798
Harald Welte3c9c5f92010-03-04 10:33:10 +0100799 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, lchan2chan_nr(msg->lchan),
800 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000801
Harald Welte8470bf22008-12-25 23:28:35 +0000802 msg->trx = msg->lchan->ts->trx;
803
804 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000805}
806
Harald Welteedcc5272009-08-09 13:47:35 +0200807/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
808/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200809int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200810{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100811 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200812
Harald Welte3c9c5f92010-03-04 10:33:10 +0100813 msg = rsl_rll_simple(RSL_MT_EST_REQ, lchan2chan_nr(lchan),
814 link_id, 0);
Harald Welteedcc5272009-08-09 13:47:35 +0200815 msg->trx = lchan->ts->trx;
816
817 return abis_rsl_sendmsg(msg);
818}
819
Harald Welted2dc1de2009-08-08 13:15:07 +0200820/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
821 This is what higher layers should call. The BTS then responds with
822 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
823 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
824 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200825int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200826{
Harald Welted2dc1de2009-08-08 13:15:07 +0200827
Harald Welte3c9c5f92010-03-04 10:33:10 +0100828 struct msgb *msg;
829
830 msg = rsl_rll_simple(RSL_MT_REL_REQ, lchan2chan_nr(lchan),
831 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800832 /* 0 is normal release, 1 is local end */
833 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200834
Harald Welte8e93b792009-12-29 10:44:17 +0100835 /* FIXME: start some timer in case we don't receive a REL ACK ? */
836
Harald Welted2dc1de2009-08-08 13:15:07 +0200837 msg->trx = lchan->ts->trx;
838
839 return abis_rsl_sendmsg(msg);
840}
841
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200842int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
843{
844 lchan->state = state;
845 return 0;
846}
847
Harald Welte702d8702008-12-26 20:25:35 +0000848/* Chapter 8.4.2: Channel Activate Acknowledge */
849static int rsl_rx_chan_act_ack(struct msgb *msg)
850{
851 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
852
853 /* BTS has confirmed channel activation, we now need
854 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000855 if (rslh->ie_chan != RSL_IE_CHAN_NR)
856 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100857
Harald Welte8e93b792009-12-29 10:44:17 +0100858 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100859 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
860 gsm_lchan_name(msg->lchan),
861 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200862 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100863
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800864 if (msg->lchan->rqd_ref) {
865 rsl_send_imm_assignment(msg->lchan);
866 talloc_free(msg->lchan->rqd_ref);
867 msg->lchan->rqd_ref = NULL;
868 msg->lchan->rqd_ta = 0;
869 }
870
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100871 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100872
Harald Welte4b634542008-12-27 01:55:51 +0000873 return 0;
874}
Harald Welte702d8702008-12-26 20:25:35 +0000875
Harald Welte4b634542008-12-27 01:55:51 +0000876/* Chapter 8.4.3: Channel Activate NACK */
877static int rsl_rx_chan_act_nack(struct msgb *msg)
878{
Harald Welte6dab0552009-05-01 17:21:37 +0000879 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
880 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000881
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100882 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100883 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100884
Harald Welte6dab0552009-05-01 17:21:37 +0000885 /* BTS has rejected channel activation ?!? */
886 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000887 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000888
889 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100890 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200891 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100892 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200893 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100894 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200895 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100896 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200897 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200898
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100899 LOGPC(DRSL, LOGL_ERROR, "\n");
900
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100901 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100902
Harald Welte3073a9f2009-08-09 19:50:08 +0200903 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000904 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000905}
906
Harald Welte7f93cea2009-02-23 00:02:59 +0000907/* Chapter 8.4.4: Connection Failure Indication */
908static int rsl_rx_conn_fail(struct msgb *msg)
909{
910 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
911 struct tlv_parsed tp;
912
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100913 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100914 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100915 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000916
917 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
918
Harald Welte8830e072009-07-28 17:58:09 +0200919 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100920 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200921 TLVP_LEN(&tp, RSL_IE_CAUSE));
922
Harald Welte (local)fc057502009-12-26 22:33:09 +0100923 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000924 /* FIXME: only free it after channel release ACK */
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +0200925 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800926 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000927}
928
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100929static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
930 const char *prefix)
931{
Harald Welte6739dfb2009-12-16 16:52:07 +0100932 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
933 prefix, rxlev2dbm(mru->full.rx_lev),
934 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100935 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
936 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
937}
938
939static void print_meas_rep(struct gsm_meas_rep *mr)
940{
Harald Welte6739dfb2009-12-16 16:52:07 +0100941 int i;
942
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100943 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
944
945 if (mr->flags & MEAS_REP_F_DL_DTX)
946 DEBUGPC(DMEAS, "DTXd ");
947
948 print_meas_rep_uni(&mr->ul, "ul");
949 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
950 if (mr->flags & MEAS_REP_F_MS_TO)
951 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
952
953 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100954 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100955 DEBUGPC(DMEAS, "L1_FPC=%u ",
956 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
957 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
958 }
959
960 if (mr->flags & MEAS_REP_F_UL_DTX)
961 DEBUGPC(DMEAS, "DTXu ");
962 if (mr->flags & MEAS_REP_F_BA1)
963 DEBUGPC(DMEAS, "BA1 ");
964 if (!(mr->flags & MEAS_REP_F_DL_VALID))
965 DEBUGPC(DMEAS, "NOT VALID ");
966 else
967 print_meas_rep_uni(&mr->dl, "dl");
968
969 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100970 if (mr->num_cell == 7)
971 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100972 for (i = 0; i < mr->num_cell; i++) {
973 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100974 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
975 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100976 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100977}
978
Harald Welte440fed02009-05-01 18:43:47 +0000979static int rsl_rx_meas_res(struct msgb *msg)
980{
981 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
982 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100983 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200984 uint8_t len;
985 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100986 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000987
Harald Welteb8bfc562009-12-21 13:27:11 +0100988 /* check if this channel is actually active */
989 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100990 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800991 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100992 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100993 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100994 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100995
Harald Welted12b0fd2009-12-15 21:36:05 +0100996 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100997 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100998
Harald Welte440fed02009-05-01 18:43:47 +0000999 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1000
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001001 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1002 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1003 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1004 return -EIO;
1005
1006 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +01001007 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001008
1009 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1010 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1011 if (len >= 3) {
1012 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +01001013 mr->flags |= MEAS_REP_F_DL_DTX;
1014 mr->ul.full.rx_lev = val[0] & 0x3f;
1015 mr->ul.sub.rx_lev = val[1] & 0x3f;
1016 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1017 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +00001018 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001019
Harald Welted12b0fd2009-12-15 21:36:05 +01001020 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001021
1022 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +00001023 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +01001024 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001025 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1026
Harald Weltefe9af262009-06-20 18:44:35 +02001027 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001028 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001029 mr->flags |= MEAS_REP_F_MS_L1;
1030 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001031 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001032 mr->flags |= MEAS_REP_F_FPC;
1033 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +02001034 }
Harald Weltef7c43522009-06-09 20:24:21 +00001035 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001036 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001037 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001038 if (rc < 0)
1039 return rc;
1040 }
1041
Harald Welted12b0fd2009-12-15 21:36:05 +01001042 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001043
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001044 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001045
Harald Welte75d34a82009-05-23 06:11:13 +00001046 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001047}
1048
Harald Welted011e8b2009-11-29 22:45:52 +01001049/* Chapter 8.4.7 */
1050static int rsl_rx_hando_det(struct msgb *msg)
1051{
1052 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1053 struct tlv_parsed tp;
1054
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001055 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001056
1057 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1058
1059 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1060 DEBUGPC(DRSL, "access delay = %u\n",
1061 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1062 else
1063 DEBUGPC(DRSL, "\n");
1064
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001065 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001066
1067 return 0;
1068}
1069
Harald Welte52b1f982008-12-23 20:25:15 +00001070static int abis_rsl_rx_dchan(struct msgb *msg)
1071{
Harald Welte8470bf22008-12-25 23:28:35 +00001072 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1073 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001074 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001075
Harald Welte8470bf22008-12-25 23:28:35 +00001076 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001077 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001078
Harald Welte8470bf22008-12-25 23:28:35 +00001079 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001080 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001081 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001082 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001083 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001084 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001085 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001086 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001087 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001088 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001089 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001090 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001091 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001092 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001093 case RSL_MT_HANDO_DET:
1094 rc = rsl_rx_hando_det(msg);
1095 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001096 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001097 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001098 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001099 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001100 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001101 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001102 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001103 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001104 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001105 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001106 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001107 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001108 break;
1109 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001110 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001111 break;
1112 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001113 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001114 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001115 break;
1116 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001117 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001118 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001119 case RSL_MT_PHY_CONTEXT_CONF:
1120 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001121 case RSL_MT_TALKER_DET:
1122 case RSL_MT_LISTENER_DET:
1123 case RSL_MT_REMOTE_CODEC_CONF_REP:
1124 case RSL_MT_MR_CODEC_MOD_ACK:
1125 case RSL_MT_MR_CODEC_MOD_NACK:
1126 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001127 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1128 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001129 break;
1130 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001131 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1132 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001133 return -EINVAL;
1134 }
Harald Weltef325eb42009-02-19 17:07:39 +00001135
Harald Welte8470bf22008-12-25 23:28:35 +00001136 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001137}
1138
Harald Welte702d8702008-12-26 20:25:35 +00001139static int rsl_rx_error_rep(struct msgb *msg)
1140{
1141 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001142 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001143
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001144 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(msg->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001145
1146 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1147
1148 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001149 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001150 TLVP_LEN(&tp, RSL_IE_CAUSE));
1151
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001152 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001153
1154 return 0;
1155}
1156
Harald Welte52b1f982008-12-23 20:25:15 +00001157static int abis_rsl_rx_trx(struct msgb *msg)
1158{
Harald Welte702d8702008-12-26 20:25:35 +00001159 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001160 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001161
1162 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001163 case RSL_MT_ERROR_REPORT:
1164 rc = rsl_rx_error_rep(msg);
1165 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001166 case RSL_MT_RF_RES_IND:
1167 /* interference on idle channels of TRX */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001168 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(msg->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001169 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001170 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001171 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001172 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
1173 gsm_trx_name(msg->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001174 break;
1175 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001176 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
1177 "type 0x%02x\n", gsm_trx_name(msg->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001178 return -EINVAL;
1179 }
Harald Welte8470bf22008-12-25 23:28:35 +00001180 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001181}
1182
Harald Welteb7e81162009-08-10 00:26:10 +02001183/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1184static void t3101_expired(void *data)
1185{
1186 struct gsm_lchan *lchan = data;
1187
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001188 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001189}
1190
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001191/* If T3111 expires, we will send the RF Channel Request */
1192static void t3111_expired(void *data)
1193{
1194 struct gsm_lchan *lchan = data;
1195
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001196 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001197}
1198
laforgecfa4a012010-06-21 12:08:52 +02001199#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1200
Harald Welte2862dca2010-12-23 14:39:29 +01001201/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1202static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1203 unsigned int num_req_refs,
1204 struct gsm48_req_ref *rqd_refs,
1205 uint8_t wait_ind)
1206{
1207 uint8_t buf[GSM_MACBLOCK_LEN];
1208 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1209
1210 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1211 memset(iar, 0, sizeof(*iar));
1212 iar->proto_discr = GSM48_PDISC_RR;
1213 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1214 iar->page_mode = GSM48_PM_SAME;
1215
1216 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1217 iar->wait_ind1 = wait_ind;
1218
1219 if (num_req_refs >= 2)
1220 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1221 else
1222 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1223 iar->wait_ind2 = wait_ind;
1224
1225 if (num_req_refs >= 3)
1226 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1227 else
1228 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1229 iar->wait_ind3 = wait_ind;
1230
1231 if (num_req_refs >= 4)
1232 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1233 else
1234 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1235 iar->wait_ind4 = wait_ind;
1236
1237 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1238}
1239
Harald Welte8470bf22008-12-25 23:28:35 +00001240/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001241static int rsl_rx_chan_rqd(struct msgb *msg)
1242{
Harald Welte702d8702008-12-26 20:25:35 +00001243 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001244 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1245 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001246 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001247 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001248 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001249 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001250 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001251
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001252 uint16_t arfcn;
1253 uint8_t ts_number, subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001254
Harald Welte8470bf22008-12-25 23:28:35 +00001255 /* parse request reference to be used in immediate assign */
1256 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1257 return -EINVAL;
1258
1259 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1260
1261 /* parse access delay and use as TA */
1262 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1263 return -EINVAL;
1264 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1265
1266 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1267 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001268 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1269 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001270
Harald Welteffa55a42009-12-22 19:07:32 +01001271 counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001272
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001273 /*
1274 * We want LOCATION UPDATES to succeed and will assign a TCH
1275 * if we have no SDCCH available.
1276 */
1277 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1278
Harald Welte8470bf22008-12-25 23:28:35 +00001279 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001280 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001281 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001282 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001283 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Harald Welteffa55a42009-12-22 19:07:32 +01001284 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001285 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1286 if (bts->network->T3122)
1287 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001288 return -ENOMEM;
1289 }
1290
Harald Welte8e93b792009-12-29 10:44:17 +01001291 if (lchan->state != LCHAN_S_NONE)
1292 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001293 "in state %s\n", gsm_lchan_name(lchan),
1294 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001295 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001296
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001297 /* save the RACH data as we need it after the CHAN ACT ACK */
1298 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1299 if (!lchan->rqd_ref) {
1300 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1301 lchan_free(lchan);
1302 return -ENOMEM;
1303 }
1304
1305 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1306 lchan->rqd_ta = rqd_ta;
1307
Harald Welte8470bf22008-12-25 23:28:35 +00001308 ts_number = lchan->ts->nr;
1309 arfcn = lchan->ts->trx->arfcn;
1310 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001311
Harald Welte08d91a52009-08-30 15:37:11 +09001312 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001313 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001314 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001315 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001316 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001317
1318 /* FIXME: Start another timer or assume the BTS sends a ACK/NACK? */
Harald Welte8d77b952009-12-17 00:31:10 +01001319 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001320
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001321 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1322 "r=%s ra=0x%02x\n", gsm_lchan_name(lchan), arfcn, subch,
1323 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1324 rqd_ref->ra);
1325 return 0;
1326}
1327
1328static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1329{
1330 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001331 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001332 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1333
Harald Welte52b1f982008-12-23 20:25:15 +00001334 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001335 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001336 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001337 ia->proto_discr = GSM48_PDISC_RR;
1338 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1339 ia->page_mode = GSM48_PM_SAME;
1340 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001341
Harald Welte8470bf22008-12-25 23:28:35 +00001342 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001343 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1344 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001345 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001346 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001347 } else {
laforge09108bf2010-06-20 15:18:46 +02001348 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1349 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001350 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001351 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1352 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001353
Harald Welteb7e81162009-08-10 00:26:10 +02001354 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1355 lchan->T3101.cb = t3101_expired;
1356 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001357 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001358
Harald Welte52b1f982008-12-23 20:25:15 +00001359 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001360 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001361}
1362
Harald Welteea280442009-02-02 22:29:56 +00001363/* MS has requested a channel on the RACH */
1364static int rsl_rx_ccch_load(struct msgb *msg)
1365{
1366 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-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 Welteea280442009-02-02 22:29:56 +00001371
1372 switch (rslh->data[0]) {
1373 case RSL_IE_PAGING_LOAD:
1374 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Harald Welte38e9c822010-04-19 10:24:07 +02001375 if (is_ipaccess_bts(msg->trx->bts) && pg_buf_space == 0xffff) {
1376 /* paging load below configured threshold, use 50 as default */
1377 pg_buf_space = 50;
1378 }
Holger Freyther392209c2009-02-10 00:06:19 +00001379 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001380 break;
1381 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001382 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 }
Harald Welteea280442009-02-02 22:29:56 +00001387 break;
1388 default:
1389 break;
1390 }
1391
1392 return 0;
1393}
1394
Harald Welte52b1f982008-12-23 20:25:15 +00001395static int abis_rsl_rx_cchan(struct msgb *msg)
1396{
Harald Welteea280442009-02-02 22:29:56 +00001397 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001398 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001399
Harald Welte8470bf22008-12-25 23:28:35 +00001400 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1401
1402 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001403 case RSL_MT_CHAN_RQD:
1404 /* MS has requested a channel on the RACH */
1405 rc = rsl_rx_chan_rqd(msg);
1406 break;
Harald Welteea280442009-02-02 22:29:56 +00001407 case RSL_MT_CCCH_LOAD_IND:
1408 /* current load on the CCCH */
1409 rc = rsl_rx_ccch_load(msg);
1410 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001411 case RSL_MT_DELETE_IND:
1412 /* CCCH overloaded, IMM_ASSIGN was dropped */
1413 case RSL_MT_CBCH_LOAD_IND:
1414 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001415 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1416 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001417 break;
1418 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001419 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1420 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001421 return -EINVAL;
1422 }
Harald Welte8470bf22008-12-25 23:28:35 +00001423
1424 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001425}
1426
Harald Welte4b634542008-12-27 01:55:51 +00001427static int rsl_rx_rll_err_ind(struct msgb *msg)
1428{
1429 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001430 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001431
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001432 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001433 gsm_lchan_name(msg->lchan),
Harald Weltee95daf192010-03-25 12:13:02 +08001434 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001435
1436 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001437
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001438 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
1439 counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001440 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001441 }
Harald Welte81543bc2009-07-04 09:40:05 +02001442
Harald Welte4b634542008-12-27 01:55:51 +00001443 return 0;
1444}
Harald Weltef325eb42009-02-19 17:07:39 +00001445
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001446static void rsl_handle_release(struct gsm_lchan *lchan)
1447{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001448 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001449 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001450
1451 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001452 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001453 return;
1454
1455 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1456 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1457 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001458 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001459 gsm_lchan_name(lchan), sapi);
1460 return;
1461 }
1462
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001463
1464
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001465 /* wait a bit to send the RF Channel Release */
1466 lchan->T3111.cb = t3111_expired;
1467 lchan->T3111.data = lchan;
1468 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001469 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001470}
1471
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001472/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001473 0x02, 0x06,
1474 0x01, 0x20,
1475 0x02, 0x00,
1476 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1477
1478static int abis_rsl_rx_rll(struct msgb *msg)
1479{
1480 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001481 int rc = 0;
1482 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001483 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001484
1485 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001486 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001487 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001488
1489 switch (rllh->c.msg_type) {
1490 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001491 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001492 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001493 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1494 rllh->data[0] == RSL_IE_L3_INFO) {
1495 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001496 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001497 }
Harald Welte52b1f982008-12-23 20:25:15 +00001498 break;
1499 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001500 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001501 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001502 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001503 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001504 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001505 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1506 rllh->data[0] == RSL_IE_L3_INFO) {
1507 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001508 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001509 }
Harald Welte52b1f982008-12-23 20:25:15 +00001510 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001511 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001512 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001513 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001514 rll_indication(msg->lchan, rllh->link_id,
1515 BSC_RLLR_IND_EST_CONF);
1516 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001517 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001518 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001519 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001520 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001521 rll_indication(msg->lchan, rllh->link_id,
1522 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001523 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001524 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001525 break;
1526 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001527 /* BTS informs us of having received UA from MS,
1528 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001529 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001530 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001531 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001532 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001533 break;
1534 case RSL_MT_ERROR_IND:
1535 rc = rsl_rx_rll_err_ind(msg);
1536 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001537 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001538 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1539 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001540 break;
1541 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001542 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1543 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001544 }
Harald Welte8470bf22008-12-25 23:28:35 +00001545 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001546}
1547
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001548static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001549{
Harald Welte0603c9d2009-12-02 01:58:23 +05301550 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001551 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301552 switch (lchan->type) {
1553 case GSM_LCHAN_TCH_F:
1554 return 0x00;
1555 case GSM_LCHAN_TCH_H:
1556 return 0x03;
1557 default:
1558 break;
1559 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001560 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301561 switch (lchan->type) {
1562 case GSM_LCHAN_TCH_F:
1563 return 0x01;
1564 /* there's no half-rate EFR */
1565 default:
1566 break;
1567 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001568 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301569 switch (lchan->type) {
1570 case GSM_LCHAN_TCH_F:
1571 return 0x02;
1572 case GSM_LCHAN_TCH_H:
1573 return 0x05;
1574 default:
1575 break;
1576 }
1577 default:
1578 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001579 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001580 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301581 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001582 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001583}
1584
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001585static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001586{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001587 struct gsm_network *net = lchan->ts->trx->bts->network;
1588
1589 /* allow to hardcode the rtp payload */
1590 if (net->hardcoded_rtp_payload != 0)
1591 return net->hardcoded_rtp_payload;
1592
Sylvain Munautb54dda42009-12-20 22:06:40 +01001593 switch (lchan->tch_mode) {
1594 case GSM48_CMODE_SPEECH_V1:
1595 switch (lchan->type) {
1596 case GSM_LCHAN_TCH_F:
1597 return RTP_PT_GSM_FULL;
1598 case GSM_LCHAN_TCH_H:
1599 return RTP_PT_GSM_HALF;
1600 default:
1601 break;
1602 }
1603 case GSM48_CMODE_SPEECH_EFR:
1604 switch (lchan->type) {
1605 case GSM_LCHAN_TCH_F:
1606 return RTP_PT_GSM_EFR;
1607 /* there's no half-rate EFR */
1608 default:
1609 break;
1610 }
1611 case GSM48_CMODE_SPEECH_AMR:
1612 switch (lchan->type) {
1613 case GSM_LCHAN_TCH_F:
1614 return RTP_PT_AMR_FULL;
1615 case GSM_LCHAN_TCH_H:
1616 return RTP_PT_AMR_HALF;
1617 default:
1618 break;
1619 }
1620 default:
1621 break;
1622 }
1623 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1624 "tch_mode == 0x%02x\n & lchan_type == %d",
1625 lchan->tch_mode, lchan->type);
1626 return 0;
1627}
1628
Harald Welte75099262009-02-16 21:12:08 +00001629/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001630static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1631{
1632 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001633 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001634
1635 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001636 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001637 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1638 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1639 }
1640
1641 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001642 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001643 port = ntohs(port);
1644 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1645 lchan->abis_ip.bound_port = port;
1646 }
1647
1648 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001649 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001650 conn_id = ntohs(conn_id);
1651 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1652 lchan->abis_ip.conn_id = conn_id;
1653 }
1654
1655 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1656 lchan->abis_ip.rtp_payload2 =
1657 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1658 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1659 lchan->abis_ip.rtp_payload2);
1660 }
1661
1662 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1663 lchan->abis_ip.speech_mode =
1664 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1665 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1666 lchan->abis_ip.speech_mode);
1667 }
1668
1669 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001670 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001671 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1672 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1673 }
1674
1675 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001676 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001677 port = ntohs(port);
1678 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1679 lchan->abis_ip.connect_port = port;
1680 }
1681}
1682
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001683int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001684{
1685 struct msgb *msg = rsl_msgb_alloc();
1686 struct abis_rsl_dchan_hdr *dh;
1687
1688 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001689 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001690 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1691 dh->chan_nr = lchan2chan_nr(lchan);
1692
Harald Weltef4e79f22009-07-28 18:11:56 +02001693 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001694 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001695 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001696 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001697 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001698
Sylvain Munautb54dda42009-12-20 22:06:40 +01001699 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1700 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1701 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001702
Harald Welte75099262009-02-16 21:12:08 +00001703 msg->trx = lchan->ts->trx;
1704
1705 return abis_rsl_sendmsg(msg);
1706}
1707
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001708int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1709 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001710{
1711 struct msgb *msg = rsl_msgb_alloc();
1712 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001713 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001714 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001715
1716 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001717 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001718 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1719 dh->chan_nr = lchan2chan_nr(lchan);
1720
Harald Welte5e3d91b2009-12-19 16:42:06 +01001721 /* we need to store these now as MDCX_ACK does not return them :( */
1722 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1723 lchan->abis_ip.connect_port = port;
1724 lchan->abis_ip.connect_ip = ip;
1725
Harald Welte58ca5b72009-07-29 12:12:18 +02001726 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001727 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001728 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001729
Harald Weltef4e79f22009-07-28 18:11:56 +02001730 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001731 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1732 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1733 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1734 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001735
Harald Welte5e3d91b2009-12-19 16:42:06 +01001736 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1737 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001738 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001739 *att_ip = ia.s_addr;
1740 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1741 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001742 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001743 if (rtp_payload2)
1744 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1745
Harald Welte75099262009-02-16 21:12:08 +00001746 msg->trx = lchan->ts->trx;
1747
1748 return abis_rsl_sendmsg(msg);
1749}
1750
Harald Weltea72273e2009-12-20 16:51:09 +01001751/* tell BTS to connect RTP stream to our local RTP socket */
1752int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1753{
1754 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1755 int rc;
1756
1757 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1758 ntohs(rs->rtp.sin_local.sin_port),
1759 /* FIXME: use RTP payload of bound socket, not BTS*/
1760 lchan->abis_ip.rtp_payload2);
1761
1762 return rc;
1763}
1764
Harald Welte53cd7ac2010-12-23 12:59:52 +01001765int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001766{
1767 struct msgb *msg = rsl_msgb_alloc();
1768 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001769 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001770
1771 if (act)
1772 msg_type = RSL_MT_IPAC_PDCH_ACT;
1773 else
1774 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001775
1776 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001777 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001778 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte53cd7ac2010-12-23 12:59:52 +01001779 dh->chan_nr = ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001780
Harald Welte53cd7ac2010-12-23 12:59:52 +01001781 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001782 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001783
Harald Welte53cd7ac2010-12-23 12:59:52 +01001784 msg->trx = ts->trx;
Harald Welte9c880c92009-10-24 10:29:22 +02001785
1786 return abis_rsl_sendmsg(msg);
1787}
1788
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001789static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001790{
1791 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1792 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301793 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001794
1795 /* the BTS has acknowledged a local bind, it now tells us the IP
1796 * address and port number to which it has bound the given logical
1797 * channel */
1798
1799 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1800 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1801 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001802 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001803 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001804 return -EINVAL;
1805 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001806
Harald Welte5e3d91b2009-12-19 16:42:06 +01001807 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001808
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001809 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001810
Harald Welte75099262009-02-16 21:12:08 +00001811 return 0;
1812}
1813
Harald Welte5e3d91b2009-12-19 16:42:06 +01001814static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1815{
1816 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1817 struct tlv_parsed tv;
1818 struct gsm_lchan *lchan = msg->lchan;
1819
1820 /* the BTS has acknowledged a remote connect request and
1821 * it now tells us the IP address and port number to which it has
1822 * connected the given logical channel */
1823
1824 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1825 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001826 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001827
1828 return 0;
1829}
1830
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001831static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001832{
1833 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1834 struct tlv_parsed tv;
1835
1836 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001837
Harald Welte8830e072009-07-28 17:58:09 +02001838 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001839 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001840 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001841
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001842 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001843
Harald Welte75099262009-02-16 21:12:08 +00001844 return 0;
1845}
1846
1847static int abis_rsl_rx_ipacc(struct msgb *msg)
1848{
1849 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001850 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001851 int rc = 0;
1852
1853 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001854 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001855
1856 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001857 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001858 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001859 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001860 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001861 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001862 /* somehow the BTS was unable to bind the lchan to its local
1863 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001864 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001865 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001866 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001867 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001868 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001869 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001870 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001871 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001872 /* somehow the BTS was unable to connect the lchan to a remote
1873 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001874 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001875 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001876 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001877 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001878 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001879 break;
1880 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001881 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001882 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001883 break;
1884 }
Harald Welte6dab0552009-05-01 17:21:37 +00001885 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001886
1887 return rc;
1888}
1889
1890
Harald Welte52b1f982008-12-23 20:25:15 +00001891/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001892int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001893{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001894 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001895 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001896
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001897 if (!msg) {
1898 DEBUGP(DRSL, "Empty RSL msg?..\n");
1899 return -1;
1900 }
1901
1902 if (msgb_l2len(msg) < sizeof(*rslh)) {
1903 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1904 return -1;
1905 }
1906
1907 rslh = msgb_l2(msg);
1908
Harald Welte52b1f982008-12-23 20:25:15 +00001909 switch (rslh->msg_discr & 0xfe) {
1910 case ABIS_RSL_MDISC_RLL:
1911 rc = abis_rsl_rx_rll(msg);
1912 break;
1913 case ABIS_RSL_MDISC_DED_CHAN:
1914 rc = abis_rsl_rx_dchan(msg);
1915 break;
1916 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001917 rc = abis_rsl_rx_cchan(msg);
1918 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001919 case ABIS_RSL_MDISC_TRX:
1920 rc = abis_rsl_rx_trx(msg);
1921 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001922 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001923 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001924 rslh->msg_discr);
1925 break;
Harald Welte75099262009-02-16 21:12:08 +00001926 case ABIS_RSL_MDISC_IPACCESS:
1927 rc = abis_rsl_rx_ipacc(msg);
1928 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001929 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001930 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1931 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001932 return -EINVAL;
1933 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001934 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001935 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001936}
Holger Freyther3b72a892009-02-04 00:31:39 +00001937
Holger Freyther3b72a892009-02-04 00:31:39 +00001938/* From Table 10.5.33 of GSM 04.08 */
1939int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1940{
Harald Weltea43f7892009-12-01 18:04:30 +05301941 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1942 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1943 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001944 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301945 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1946 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001947 }
1948}
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001949
1950int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1951 uint8_t cb_command, const uint8_t *data, int len)
1952{
1953 struct abis_rsl_dchan_hdr *dh;
1954 struct msgb *cb_cmd;
1955
1956 cb_cmd = rsl_msgb_alloc();
1957 if (!cb_cmd)
1958 return -1;
1959
1960 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1961 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1962 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1963
1964 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1965 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1966
1967 cb_cmd->trx = bts->c0;
1968
1969 return abis_rsl_sendmsg(cb_cmd);
1970}