blob: e155a34754bb4bec1b3ef2ccdddfc8cc2028d9d7 [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 Ayusoed5cacb2011-08-17 22:44:07 +020041#include <osmocom/abis/e1_input.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010042#include <osmocom/gsm/rsl.h>
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010043#include <osmocom/core/talloc.h>
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080044
Harald Welte8470bf22008-12-25 23:28:35 +000045#define RSL_ALLOC_SIZE 1024
46#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000047
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +080048static int rsl_send_imm_assignment(struct gsm_lchan *lchan);
49
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010050static void send_lchan_signal(int sig_no, struct gsm_lchan *lchan,
51 struct gsm_meas_rep *resp)
52{
53 struct lchan_signal_data sig;
54 sig.lchan = lchan;
55 sig.mr = resp;
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +020056 osmo_signal_dispatch(SS_LCHAN, sig_no, &sig);
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +010057}
58
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020059static uint8_t mdisc_by_msgtype(uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000060{
61 /* mask off the transparent bit ? */
62 msg_type &= 0xfe;
63
Harald Welte8470bf22008-12-25 23:28:35 +000064 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +000065 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +000066 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +000067 if (msg_type >= 0x19 && msg_type <= 0x22)
68 return ABIS_RSL_MDISC_TRX;
69 else
70 return ABIS_RSL_MDISC_COM_CHAN;
71 }
Harald Welte2d5b6382008-12-27 19:46:06 +000072 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +000073 return ABIS_RSL_MDISC_DED_CHAN;
74
75 return ABIS_RSL_MDISC_LOC;
76}
77
78static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020079 uint8_t msg_type)
Harald Welte52b1f982008-12-23 20:25:15 +000080{
81 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
82 dh->c.msg_type = msg_type;
83 dh->ie_chan = RSL_IE_CHAN_NR;
84}
85
Harald Welte8470bf22008-12-25 23:28:35 +000086/* determine logical channel based on TRX and channel number IE */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020087struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, uint8_t chan_nr)
Harald Welte8470bf22008-12-25 23:28:35 +000088{
89 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020090 uint8_t ts_nr = chan_nr & 0x07;
91 uint8_t cbits = chan_nr >> 3;
92 uint8_t lch_idx;
Harald Welte8470bf22008-12-25 23:28:35 +000093 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
94
95 if (cbits == 0x01) {
96 lch_idx = 0; /* TCH/F */
Harald Weltea1499d02009-10-24 10:25:50 +020097 if (ts->pchan != GSM_PCHAN_TCH_F &&
98 ts->pchan != GSM_PCHAN_PDCH &&
99 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100100 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000101 chan_nr, ts->pchan);
102 } else if ((cbits & 0x1e) == 0x02) {
103 lch_idx = cbits & 0x1; /* TCH/H */
104 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100105 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000106 chan_nr, ts->pchan);
107 } else if ((cbits & 0x1c) == 0x04) {
108 lch_idx = cbits & 0x3; /* SDCCH/4 */
109 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100110 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000111 chan_nr, ts->pchan);
112 } else if ((cbits & 0x18) == 0x08) {
113 lch_idx = cbits & 0x7; /* SDCCH/8 */
114 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100115 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000116 chan_nr, ts->pchan);
117 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
118 lch_idx = 0;
119 if (ts->pchan != GSM_PCHAN_CCCH &&
120 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100121 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000122 chan_nr, ts->pchan);
123 /* FIXME: we should not return first sdcch4 !!! */
124 } else {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100125 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000126 return NULL;
127 }
128
129 lchan = &ts->lchan[lch_idx];
Harald Weltedc5062b2010-03-26 21:28:59 +0800130 log_set_context(BSC_CTX_LCHAN, lchan);
Holger Hans Peter Freyther2412a072010-06-28 15:47:12 +0800131 if (lchan->conn)
132 log_set_context(BSC_CTX_SUBSCR, lchan->conn->subscr);
Harald Welte8470bf22008-12-25 23:28:35 +0000133
134 return lchan;
135}
136
Harald Welte52b1f982008-12-23 20:25:15 +0000137/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200138uint64_t str_to_imsi(const char *imsi_str)
Harald Welte52b1f982008-12-23 20:25:15 +0000139{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200140 uint64_t ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000141
142 ret = strtoull(imsi_str, NULL, 10);
143
144 return ret;
145}
146
Harald Welte8470bf22008-12-25 23:28:35 +0000147static struct msgb *rsl_msgb_alloc(void)
148{
Harald Welte966636f2009-06-26 19:39:35 +0200149 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
150 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000151}
152
Harald Welte362322e2009-02-15 14:36:38 +0000153#define MACBLOCK_SIZE 23
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200154static void pad_macblock(uint8_t *out, const uint8_t *in, int len)
Harald Welte362322e2009-02-15 14:36:38 +0000155{
156 memcpy(out, in, len);
157
158 if (len < MACBLOCK_SIZE)
159 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
160}
161
Harald Welte08d91a52009-08-30 15:37:11 +0900162/* Chapter 9.3.7: Encryption Information */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200163static int build_encr_info(uint8_t *out, struct gsm_lchan *lchan)
Harald Welte08d91a52009-08-30 15:37:11 +0900164{
165 *out++ = lchan->encr.alg_id & 0xff;
166 if (lchan->encr.key_len)
167 memcpy(out, lchan->encr.key, lchan->encr.key_len);
168 return lchan->encr.key_len + 1;
169}
170
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200171static void print_rsl_cause(int lvl, const uint8_t *cause_v, uint8_t cause_len)
Harald Welte8830e072009-07-28 17:58:09 +0200172{
Harald Welte7f93cea2009-02-23 00:02:59 +0000173 int i;
174
Harald Welte5b8ed432009-12-24 12:20:20 +0100175 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Welte8830e072009-07-28 17:58:09 +0200176 cause_v[0], rsl_err_name(cause_v[0]));
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200177 for (i = 1; i < cause_len-1; i++)
Harald Welte5b8ed432009-12-24 12:20:20 +0100178 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte7f93cea2009-02-23 00:02:59 +0000179}
180
Harald Weltee8bd9e82011-08-10 23:26:33 +0200181static void lchan_act_tmr_cb(void *data)
182{
183 struct gsm_lchan *lchan = data;
184
185 LOGP(DRSL, LOGL_NOTICE, "%s Timeout during activation!\n",
186 gsm_lchan_name(lchan));
187
Daniel Willmann513da172011-08-11 04:44:12 +0200188 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
189 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200190}
191
192static void lchan_deact_tmr_cb(void *data)
193{
194 struct gsm_lchan *lchan = data;
195
196 LOGP(DRSL, LOGL_NOTICE, "%s Timeout during deactivation!\n",
197 gsm_lchan_name(lchan));
198
Holger Hans Peter Freytherbbf21392012-01-14 21:56:37 +0100199 if (lchan->state != LCHAN_S_REL_ERR)
200 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Daniel Willmann513da172011-08-11 04:44:12 +0200201 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200202}
203
204
Harald Welte52b1f982008-12-23 20:25:15 +0000205/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200206int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
207 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000208{
209 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000210 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000211
212 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
213 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
214 dh->chan_nr = RSL_CHAN_BCCH;
215
216 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
217 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
218
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200219 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000220
221 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000222}
223
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200224int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
225 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000226{
227 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000228 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000229
230 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
231 ch->msg_discr = ABIS_RSL_MDISC_TRX;
232 ch->msg_type = RSL_MT_SACCH_FILL;
233
234 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000235 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000236
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200237 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000238
239 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000240}
241
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200242int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
243 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100244{
245 struct abis_rsl_dchan_hdr *dh;
246 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200247 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100248
249 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
250 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
251 dh->chan_nr = chan_nr;
252
253 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
254 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
255
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200256 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte7a69cf02011-01-13 23:16:03 +0100257
258 return abis_rsl_sendmsg(msg);
259}
260
Harald Weltefcd24452009-06-20 18:15:19 +0200261int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
262{
263 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200264 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200265 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200266
267 db = abs(db);
268 if (db > 30)
269 return -EINVAL;
270
Harald Welteeab33352009-06-27 03:09:08 +0200271 msg = rsl_msgb_alloc();
272
Harald Weltefcd24452009-06-20 18:15:19 +0200273 lchan->bs_power = db/2;
274 if (fpc)
275 lchan->bs_power |= 0x10;
276
277 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
278 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
279 dh->chan_nr = chan_nr;
280
281 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
282
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200283 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200284
285 return abis_rsl_sendmsg(msg);
286}
287
Harald Weltefcd24452009-06-20 18:15:19 +0200288int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
289{
290 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200291 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200292 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200293 int ctl_lvl;
294
Harald Welte66b6a8d2009-08-09 14:45:18 +0200295 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200296 if (ctl_lvl < 0)
297 return ctl_lvl;
298
Harald Welteeab33352009-06-27 03:09:08 +0200299 msg = rsl_msgb_alloc();
300
Harald Weltefcd24452009-06-20 18:15:19 +0200301 lchan->ms_power = ctl_lvl;
302
303 if (fpc)
304 lchan->ms_power |= 0x20;
305
306 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
307 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
308 dh->chan_nr = chan_nr;
309
310 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
311
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200312 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200313
314 return abis_rsl_sendmsg(msg);
315}
316
Harald Welte9943c5b2009-07-29 15:41:29 +0200317static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
318 struct gsm_lchan *lchan)
319{
320 memset(cm, 0, sizeof(cm));
321
322 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800323 if (lchan->ts->trx->bts->network->dtx_enabled)
324 cm->dtx_dtu = 0x03;
325 else
326 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200327
328 /* set TCH Speech/Data */
329 cm->spd_ind = lchan->rsl_cmode;
330
Harald Welte1a79d362009-11-27 08:55:16 +0100331 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
332 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100333 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100334 "but tch_mode != signalling\n");
335
Harald Welte9943c5b2009-07-29 15:41:29 +0200336 switch (lchan->type) {
337 case GSM_LCHAN_SDCCH:
338 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
339 break;
340 case GSM_LCHAN_TCH_F:
341 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
342 break;
343 case GSM_LCHAN_TCH_H:
344 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
345 break;
346 case GSM_LCHAN_NONE:
347 case GSM_LCHAN_UNKNOWN:
348 default:
349 return -EINVAL;
350 }
351
352 switch (lchan->tch_mode) {
353 case GSM48_CMODE_SIGN:
354 cm->chan_rate = 0;
355 break;
356 case GSM48_CMODE_SPEECH_V1:
357 cm->chan_rate = RSL_CMOD_SP_GSM1;
358 break;
359 case GSM48_CMODE_SPEECH_EFR:
360 cm->chan_rate = RSL_CMOD_SP_GSM2;
361 break;
362 case GSM48_CMODE_SPEECH_AMR:
363 cm->chan_rate = RSL_CMOD_SP_GSM3;
364 break;
365 case GSM48_CMODE_DATA_14k5:
366 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
367 break;
368 case GSM48_CMODE_DATA_12k0:
369 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
370 break;
371 case GSM48_CMODE_DATA_6k0:
372 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
373 break;
374 default:
375 return -EINVAL;
376 }
377
378 return 0;
379}
380
Harald Welte52b1f982008-12-23 20:25:15 +0000381/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000382#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200383int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
384 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000385 struct rsl_ie_chan_mode *chan_mode,
386 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200387 uint8_t bs_power, uint8_t ms_power,
388 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000389{
390 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000391 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000392
393 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
394 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
395 dh->chan_nr = chan_nr;
396
397 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
398 /* For compatibility with Phase 1 */
399 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200400 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000401 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200402 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000403#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000404 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200405 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000406#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000407 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000408 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
409 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
410
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200411 msg->dst = trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000412
Harald Welte8470bf22008-12-25 23:28:35 +0000413 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000414}
Harald Welteddab3c72009-02-28 13:19:15 +0000415#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000416
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200417int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
418 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000419{
420 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200421 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200422 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200423 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000424
Harald Weltef6093a42011-06-25 10:02:33 +0200425 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000426 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200427 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000428
Harald Welte9943c5b2009-07-29 15:41:29 +0200429 rc = channel_mode_from_lchan(&cm, lchan);
430 if (rc < 0)
431 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000432
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800433 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200434 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000435
Harald Welteeab33352009-06-27 03:09:08 +0200436 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000437 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
438 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
439 dh->chan_nr = chan_nr;
440
441 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000442 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200443 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800444
445 /*
446 * The Channel Identification is needed for Phase1 phones
447 * and it contains the GSM48 Channel Description and the
448 * Mobile Allocation. The GSM 08.58 asks for the Mobile
449 * Allocation to have a length of zero. We are using the
450 * msgb_l3len to calculate the length of both messages.
451 */
laforge694a5cf2010-06-20 21:38:19 +0200452 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200453 len = msgb_put(msg, 1);
Dieter Spaareabb6e32011-07-27 23:40:33 +0200454 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800455
456 if (lchan->ts->hopping.enabled)
457 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
458 lchan->ts->hopping.ma_data);
459 else
460 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800461
462 /* update the calculated size */
463 msg->l3h = len + 1;
464 *len = msgb_l3len(msg);
465
Harald Welte08d91a52009-08-30 15:37:11 +0900466 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200467 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900468 rc = build_encr_info(encr_info, lchan);
469 if (rc > 0)
470 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
471 }
472
Harald Welte8d77b952009-12-17 00:31:10 +0100473 switch (act_type) {
474 case RSL_ACT_INTER_ASYNC:
475 case RSL_ACT_INTER_SYNC:
476 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
477 break;
478 default:
479 break;
480 }
481
Harald Welted4c9bf32009-02-15 16:56:18 +0000482 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
483 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000484 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
485
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100486 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
487 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200488 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100489
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200490 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000491
Harald Welte4b634542008-12-27 01:55:51 +0000492 return abis_rsl_sendmsg(msg);
493}
494
Harald Welte470abb72009-07-29 11:38:15 +0200495/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000496int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
497{
498 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200499 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200500 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000501
Harald Weltef6093a42011-06-25 10:02:33 +0200502 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000503 struct rsl_ie_chan_mode cm;
504
Harald Welte9943c5b2009-07-29 15:41:29 +0200505 rc = channel_mode_from_lchan(&cm, lchan);
506 if (rc < 0)
507 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000508
Harald Welteeab33352009-06-27 03:09:08 +0200509 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000510 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
511 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
512 dh->chan_nr = chan_nr;
513
514 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200515 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900516
517 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200518 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900519 rc = build_encr_info(encr_info, lchan);
520 if (rc > 0)
521 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
522 }
523
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100524 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
525 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200526 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100527 }
528
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200529 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte08d91a52009-08-30 15:37:11 +0900530
531 return abis_rsl_sendmsg(msg);
532}
533
534/* Chapter 8.4.6: Send the encryption command with given L3 info */
535int rsl_encryption_cmd(struct msgb *msg)
536{
537 struct abis_rsl_dchan_hdr *dh;
538 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200539 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200540 uint8_t encr_info[MAX_A5_KEY_LEN+2];
541 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900542 int rc;
543
544 /* First push the L3 IE tag and length */
545 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
546
547 /* then the link identifier (SAPI0, main sign link) */
548 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
549
550 /* then encryption information */
551 rc = build_encr_info(encr_info, lchan);
552 if (rc <= 0)
553 return rc;
554 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
555
556 /* and finally the DCHAN header */
557 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
558 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
559 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000560
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200561 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteda783762009-02-18 03:29:53 +0000562
563 return abis_rsl_sendmsg(msg);
564}
565
Harald Welte115d1032009-08-10 11:43:22 +0200566/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200567int rsl_deact_sacch(struct gsm_lchan *lchan)
568{
569 struct abis_rsl_dchan_hdr *dh;
570 struct msgb *msg = rsl_msgb_alloc();
571
572 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
573 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200574 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200575
576 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200577 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteae0f2362009-07-19 18:36:49 +0200578
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100579 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200580
581 return abis_rsl_sendmsg(msg);
582}
583
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800584static void error_timeout_cb(void *data)
585{
586 struct gsm_lchan *lchan = data;
587 if (lchan->state != LCHAN_S_REL_ERR) {
588 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
589 gsm_lchan_name(lchan), lchan->state);
590 return;
591 }
592
593 /* go back to the none state */
594 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800595 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800596}
597
Harald Weltefd355a32011-03-04 13:41:31 +0100598static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
599
Harald Welte115d1032009-08-10 11:43:22 +0200600/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800601static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000602{
603 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800604 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100605 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000606
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800607 if (lchan->state == LCHAN_S_REL_ERR) {
608 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
609 gsm_lchan_name(lchan));
610 return -1;
611 }
612
613 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000614 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
615 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200616 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000617
Harald Welte8470bf22008-12-25 23:28:35 +0000618 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200619 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000620
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800621 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
622
623 if (error) {
624 /*
625 * the nanoBTS sends RLL release indications after the channel release. This can
626 * be a problem when we have reassigned the channel to someone else and then can
627 * not figure out who used this channel.
628 */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200629 struct e1inp_sign_link *sign_link = msg->dst;
630
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800631 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800632 lchan->error_timer.data = lchan;
633 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200634 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200635 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800636 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000637
Harald Weltee8bd9e82011-08-10 23:26:33 +0200638 /* Start another timer or assume the BTS sends a ACK/NACK? */
639 lchan->act_timer.cb = lchan_deact_tmr_cb;
640 lchan->act_timer.data = lchan;
641 osmo_timer_schedule(&lchan->act_timer, 4, 0);
642
Harald Weltefd355a32011-03-04 13:41:31 +0100643 rc = abis_rsl_sendmsg(msg);
644
Harald Welte115d1032009-08-10 11:43:22 +0200645 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100646#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100647 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
648 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
649 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100650#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100651
652 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000653}
654
Harald Welte64bb7542011-01-14 14:16:16 +0100655static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
656{
657
658 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
659
Harald Weltee8bd9e82011-08-10 23:26:33 +0200660 osmo_timer_del(&lchan->act_timer);
661
Harald Welte64bb7542011-01-14 14:16:16 +0100662 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
663 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
664 gsm_lchan_name(lchan),
665 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200666 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100667 /* we have an error timer pending to release that */
668 if (lchan->state != LCHAN_S_REL_ERR)
669 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
670 lchan_free(lchan);
671
672 return 0;
673}
674
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200675int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
676 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000677{
678 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000679 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000680
681 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
682 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
683 dh->chan_nr = RSL_CHAN_PCH_AGCH;
684
685 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000686 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000687 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
688
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200689 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000690
691 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000692}
693
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200694int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000695{
696 int i, len = strlen(str_in);
697
698 for (i = 0; i < len; i++) {
699 int num = str_in[i] - 0x30;
700 if (num < 0 || num > 9)
701 return -1;
702 if (i % 2 == 0)
703 bcd_out[i/2] = num;
704 else
705 bcd_out[i/2] |= (num << 4);
706 }
707
708 return 0;
709}
710
Harald Welte702d8702008-12-26 20:25:35 +0000711/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200712int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000713{
Harald Welte8470bf22008-12-25 23:28:35 +0000714 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000715 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200716 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000717
718 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
719 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
720 dh->chan_nr = RSL_CHAN_PCH_AGCH;
721
Harald Welte362322e2009-02-15 14:36:38 +0000722 switch (bts->type) {
723 case GSM_BTS_TYPE_BS11:
724 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
725 break;
726 default:
727 /* If phase 2, construct a FULL_IMM_ASS_INFO */
728 pad_macblock(buf, val, len);
729 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
730 break;
731 }
Harald Welte52b1f982008-12-23 20:25:15 +0000732
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200733 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000734
735 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000736}
737
Harald Welte67fa91b2009-08-10 09:51:40 +0200738/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200739int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200740{
741 struct msgb *msg = rsl_msgb_alloc();
742 struct abis_rsl_dchan_hdr *dh;
743
744 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
745 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200746 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200747 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200748 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200749
Harald Welte5b8ed432009-12-24 12:20:20 +0100750 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200751 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200752
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200753 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte3c456d02009-08-10 11:26:14 +0200754
Harald Welte67fa91b2009-08-10 09:51:40 +0200755 return abis_rsl_sendmsg(msg);
756}
757
758
Harald Welte8470bf22008-12-25 23:28:35 +0000759/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000760/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200761int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000762{
Harald Welte8470bf22008-12-25 23:28:35 +0000763 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100764 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000765 return -EINVAL;
766 }
Harald Welte52b1f982008-12-23 20:25:15 +0000767
Harald Weltef6093a42011-06-25 10:02:33 +0200768 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100769 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000770
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200771 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000772
773 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000774}
775
Harald Welteedcc5272009-08-09 13:47:35 +0200776/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
777/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200778int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200779{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100780 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200781
Harald Weltef6093a42011-06-25 10:02:33 +0200782 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100783 link_id, 0);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200784 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteedcc5272009-08-09 13:47:35 +0200785
786 return abis_rsl_sendmsg(msg);
787}
788
Harald Welted2dc1de2009-08-08 13:15:07 +0200789/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
790 This is what higher layers should call. The BTS then responds with
791 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
792 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
793 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200794int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200795{
Harald Welted2dc1de2009-08-08 13:15:07 +0200796
Harald Welte3c9c5f92010-03-04 10:33:10 +0100797 struct msgb *msg;
798
Harald Weltef6093a42011-06-25 10:02:33 +0200799 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100800 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800801 /* 0 is normal release, 1 is local end */
802 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200803
Harald Welte8e93b792009-12-29 10:44:17 +0100804 /* FIXME: start some timer in case we don't receive a REL ACK ? */
805
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200806 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dc1de2009-08-08 13:15:07 +0200807
808 return abis_rsl_sendmsg(msg);
809}
810
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200811int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
812{
813 lchan->state = state;
814 return 0;
815}
816
Harald Welte702d8702008-12-26 20:25:35 +0000817/* Chapter 8.4.2: Channel Activate Acknowledge */
818static int rsl_rx_chan_act_ack(struct msgb *msg)
819{
820 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
821
822 /* BTS has confirmed channel activation, we now need
823 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000824 if (rslh->ie_chan != RSL_IE_CHAN_NR)
825 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100826
Harald Weltee8bd9e82011-08-10 23:26:33 +0200827 osmo_timer_del(&msg->lchan->act_timer);
828
Harald Welte8e93b792009-12-29 10:44:17 +0100829 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100830 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
831 gsm_lchan_name(msg->lchan),
832 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200833 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100834
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800835 if (msg->lchan->rqd_ref) {
836 rsl_send_imm_assignment(msg->lchan);
837 talloc_free(msg->lchan->rqd_ref);
838 msg->lchan->rqd_ref = NULL;
839 msg->lchan->rqd_ta = 0;
840 }
841
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100842 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100843
Harald Welte4b634542008-12-27 01:55:51 +0000844 return 0;
845}
Harald Welte702d8702008-12-26 20:25:35 +0000846
Harald Welte4b634542008-12-27 01:55:51 +0000847/* Chapter 8.4.3: Channel Activate NACK */
848static int rsl_rx_chan_act_nack(struct msgb *msg)
849{
Harald Welte6dab0552009-05-01 17:21:37 +0000850 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
851 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000852
Harald Weltee8bd9e82011-08-10 23:26:33 +0200853 osmo_timer_del(&msg->lchan->act_timer);
854
Daniel Willmann6fc6a122011-08-11 04:54:23 +0200855 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100856 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100857
Harald Welte6dab0552009-05-01 17:21:37 +0000858 /* BTS has rejected channel activation ?!? */
859 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000860 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000861
862 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100863 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200864 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100865 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200866 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100867 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200868 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Daniel Willmann7ddc3182011-08-11 04:47:11 +0200869 else
870 rsl_rf_chan_release(msg->lchan, 1);
871
Harald Welte (local)3e460312009-12-27 18:12:29 +0100872 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200873 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200874
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100875 LOGPC(DRSL, LOGL_ERROR, "\n");
876
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100877 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100878
Harald Welte3073a9f2009-08-09 19:50:08 +0200879 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000880 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000881}
882
Harald Welte7f93cea2009-02-23 00:02:59 +0000883/* Chapter 8.4.4: Connection Failure Indication */
884static int rsl_rx_conn_fail(struct msgb *msg)
885{
886 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
887 struct tlv_parsed tp;
888
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100889 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100890 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100891 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000892
893 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
894
Harald Welte8830e072009-07-28 17:58:09 +0200895 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100896 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200897 TLVP_LEN(&tp, RSL_IE_CAUSE));
898
Harald Welte (local)fc057502009-12-26 22:33:09 +0100899 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000900 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200901 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800902 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000903}
904
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100905static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
906 const char *prefix)
907{
Harald Welte6739dfb2009-12-16 16:52:07 +0100908 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
909 prefix, rxlev2dbm(mru->full.rx_lev),
910 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100911 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
912 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
913}
914
915static void print_meas_rep(struct gsm_meas_rep *mr)
916{
Harald Welte6739dfb2009-12-16 16:52:07 +0100917 int i;
918
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100919 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
920
921 if (mr->flags & MEAS_REP_F_DL_DTX)
922 DEBUGPC(DMEAS, "DTXd ");
923
924 print_meas_rep_uni(&mr->ul, "ul");
925 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
926 if (mr->flags & MEAS_REP_F_MS_TO)
927 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
928
929 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100930 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100931 DEBUGPC(DMEAS, "L1_FPC=%u ",
932 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
933 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
934 }
935
936 if (mr->flags & MEAS_REP_F_UL_DTX)
937 DEBUGPC(DMEAS, "DTXu ");
938 if (mr->flags & MEAS_REP_F_BA1)
939 DEBUGPC(DMEAS, "BA1 ");
940 if (!(mr->flags & MEAS_REP_F_DL_VALID))
941 DEBUGPC(DMEAS, "NOT VALID ");
942 else
943 print_meas_rep_uni(&mr->dl, "dl");
944
945 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100946 if (mr->num_cell == 7)
947 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100948 for (i = 0; i < mr->num_cell; i++) {
949 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100950 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
951 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100952 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100953}
954
Harald Welte440fed02009-05-01 18:43:47 +0000955static int rsl_rx_meas_res(struct msgb *msg)
956{
957 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
958 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100959 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200960 uint8_t len;
961 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100962 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000963
Harald Welteb8bfc562009-12-21 13:27:11 +0100964 /* check if this channel is actually active */
965 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100966 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800967 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100968 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100969 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100970 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100971
Harald Welted12b0fd2009-12-15 21:36:05 +0100972 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100973 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100974
Harald Welte440fed02009-05-01 18:43:47 +0000975 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
976
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100977 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
978 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
979 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
980 return -EIO;
981
982 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100983 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100984
985 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
986 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
987 if (len >= 3) {
988 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100989 mr->flags |= MEAS_REP_F_DL_DTX;
990 mr->ul.full.rx_lev = val[0] & 0x3f;
991 mr->ul.sub.rx_lev = val[1] & 0x3f;
992 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
993 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000994 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100995
Harald Welted12b0fd2009-12-15 21:36:05 +0100996 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100997
998 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000999 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +01001000 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001001 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1002
Harald Weltefe9af262009-06-20 18:44:35 +02001003 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001004 struct e1inp_sign_link *sign_link = msg->dst;
1005
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001006 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001007 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001008 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001009 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001010 mr->flags |= MEAS_REP_F_FPC;
1011 mr->ms_l1.ta = val[1];
Andreas Eversberg3365cd12011-12-24 11:49:05 +01001012 /* BS11 and Nokia reports TA shifted by 2 bits */
1013 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11
1014 || msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_NOKIA_SITE)
Andreas Eversberg2957de92011-12-16 17:45:37 +01001015 mr->ms_l1.ta >>= 2;
Harald Weltefe9af262009-06-20 18:44:35 +02001016 }
Harald Weltef7c43522009-06-09 20:24:21 +00001017 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001018 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001019 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001020 if (rc < 0)
1021 return rc;
1022 }
1023
Harald Welted12b0fd2009-12-15 21:36:05 +01001024 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001025
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001026 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001027
Harald Welte75d34a82009-05-23 06:11:13 +00001028 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001029}
1030
Harald Welted011e8b2009-11-29 22:45:52 +01001031/* Chapter 8.4.7 */
1032static int rsl_rx_hando_det(struct msgb *msg)
1033{
1034 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1035 struct tlv_parsed tp;
1036
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001037 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001038
1039 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1040
1041 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1042 DEBUGPC(DRSL, "access delay = %u\n",
1043 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1044 else
1045 DEBUGPC(DRSL, "\n");
1046
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001047 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001048
1049 return 0;
1050}
1051
Harald Welte52b1f982008-12-23 20:25:15 +00001052static int abis_rsl_rx_dchan(struct msgb *msg)
1053{
Harald Welte8470bf22008-12-25 23:28:35 +00001054 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1055 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001056 char *ts_name;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001057 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001058
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001059 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001060 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001061
Harald Welte8470bf22008-12-25 23:28:35 +00001062 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001063 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001064 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001065 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001066 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001067 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001068 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001069 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001070 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001071 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001072 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001073 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001074 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001075 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001076 case RSL_MT_HANDO_DET:
1077 rc = rsl_rx_hando_det(msg);
1078 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001079 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001080 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001081 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001082 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001083 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001084 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001085 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001086 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001087 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001088 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001089 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001090 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001091 break;
1092 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001093 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001094 break;
1095 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001096 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001097 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001098 break;
1099 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001100 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001101 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001102 case RSL_MT_PHY_CONTEXT_CONF:
1103 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001104 case RSL_MT_TALKER_DET:
1105 case RSL_MT_LISTENER_DET:
1106 case RSL_MT_REMOTE_CODEC_CONF_REP:
1107 case RSL_MT_MR_CODEC_MOD_ACK:
1108 case RSL_MT_MR_CODEC_MOD_NACK:
1109 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001110 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1111 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001112 break;
1113 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001114 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1115 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001116 return -EINVAL;
1117 }
Harald Weltef325eb42009-02-19 17:07:39 +00001118
Harald Welte8470bf22008-12-25 23:28:35 +00001119 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001120}
1121
Harald Welte702d8702008-12-26 20:25:35 +00001122static int rsl_rx_error_rep(struct msgb *msg)
1123{
1124 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001125 struct tlv_parsed tp;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001126 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte702d8702008-12-26 20:25:35 +00001127
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001128 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001129
1130 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1131
1132 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001133 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001134 TLVP_LEN(&tp, RSL_IE_CAUSE));
1135
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001136 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001137
1138 return 0;
1139}
1140
Harald Welte52b1f982008-12-23 20:25:15 +00001141static int abis_rsl_rx_trx(struct msgb *msg)
1142{
Harald Welte702d8702008-12-26 20:25:35 +00001143 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001144 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte8470bf22008-12-25 23:28:35 +00001145 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001146
1147 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001148 case RSL_MT_ERROR_REPORT:
1149 rc = rsl_rx_error_rep(msg);
1150 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001151 case RSL_MT_RF_RES_IND:
1152 /* interference on idle channels of TRX */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001153 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001154 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001155 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001156 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001157 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001158 gsm_trx_name(sign_link->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001159 break;
Dieter Spaar16646022011-07-28 00:01:50 +02001160 case 0x42: /* Nokia specific: SI End ACK */
1161 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1162 break;
1163 case 0x43: /* Nokia specific: SI End NACK */
1164 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1165 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001166 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001167 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001168 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001169 return -EINVAL;
1170 }
Harald Welte8470bf22008-12-25 23:28:35 +00001171 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001172}
1173
Harald Welteb7e81162009-08-10 00:26:10 +02001174/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1175static void t3101_expired(void *data)
1176{
1177 struct gsm_lchan *lchan = data;
1178
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001179 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001180}
1181
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001182/* If T3111 expires, we will send the RF Channel Request */
1183static void t3111_expired(void *data)
1184{
1185 struct gsm_lchan *lchan = data;
1186
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001187 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001188}
1189
laforgecfa4a012010-06-21 12:08:52 +02001190#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1191
Harald Welte2862dca2010-12-23 14:39:29 +01001192/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1193static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1194 unsigned int num_req_refs,
1195 struct gsm48_req_ref *rqd_refs,
1196 uint8_t wait_ind)
1197{
1198 uint8_t buf[GSM_MACBLOCK_LEN];
1199 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1200
1201 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1202 memset(iar, 0, sizeof(*iar));
1203 iar->proto_discr = GSM48_PDISC_RR;
1204 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1205 iar->page_mode = GSM48_PM_SAME;
1206
1207 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1208 iar->wait_ind1 = wait_ind;
1209
1210 if (num_req_refs >= 2)
1211 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1212 else
1213 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1214 iar->wait_ind2 = wait_ind;
1215
1216 if (num_req_refs >= 3)
1217 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1218 else
1219 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1220 iar->wait_ind3 = wait_ind;
1221
1222 if (num_req_refs >= 4)
1223 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1224 else
1225 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1226 iar->wait_ind4 = wait_ind;
1227
1228 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1229}
1230
Harald Welte8470bf22008-12-25 23:28:35 +00001231/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001232static int rsl_rx_chan_rqd(struct msgb *msg)
1233{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001234 struct e1inp_sign_link *sign_link = msg->dst;
1235 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001236 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1237 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001238 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001239 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001240 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001241 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001242 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001243
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001244 uint16_t arfcn;
Holger Hans Peter Freytherc6d0a172012-02-03 20:10:13 +01001245 uint8_t subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001246
Harald Welte8470bf22008-12-25 23:28:35 +00001247 /* parse request reference to be used in immediate assign */
1248 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1249 return -EINVAL;
1250
1251 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1252
1253 /* parse access delay and use as TA */
1254 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1255 return -EINVAL;
1256 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1257
1258 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1259 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001260 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1261 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001262
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001263 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001264
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001265 /*
1266 * We want LOCATION UPDATES to succeed and will assign a TCH
1267 * if we have no SDCCH available.
1268 */
1269 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1270
Harald Welte8470bf22008-12-25 23:28:35 +00001271 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001272 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001273 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001274 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001275 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001276 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001277 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1278 if (bts->network->T3122)
1279 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001280 return -ENOMEM;
1281 }
1282
Harald Welte8e93b792009-12-29 10:44:17 +01001283 if (lchan->state != LCHAN_S_NONE)
1284 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001285 "in state %s\n", gsm_lchan_name(lchan),
1286 gsm_lchans_name(lchan->state));
Harald Welte (local)3e460312009-12-27 18:12:29 +01001287
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001288 /* save the RACH data as we need it after the CHAN ACT ACK */
1289 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1290 if (!lchan->rqd_ref) {
1291 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1292 lchan_free(lchan);
1293 return -ENOMEM;
1294 }
1295
Holger Hans Peter Freytherc0a66742011-12-29 23:33:04 +01001296 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001297 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1298 lchan->rqd_ta = rqd_ta;
1299
Harald Welte8470bf22008-12-25 23:28:35 +00001300 arfcn = lchan->ts->trx->arfcn;
1301 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001302
Harald Welte08d91a52009-08-30 15:37:11 +09001303 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001304 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001305 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001306 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001307 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001308
Harald Weltee8bd9e82011-08-10 23:26:33 +02001309 /* Start another timer or assume the BTS sends a ACK/NACK? */
1310 lchan->act_timer.cb = lchan_act_tmr_cb;
1311 lchan->act_timer.data = lchan;
1312 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1313
Andreas Eversberg2957de92011-12-16 17:45:37 +01001314 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1315 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1316 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1317 rqd_ref->ra, rqd_ta);
1318
1319 /* BS11 requires TA shifted by 2 bits */
1320 if (bts->type == GSM_BTS_TYPE_BS11)
1321 rqd_ta <<= 2;
Harald Welte8d77b952009-12-17 00:31:10 +01001322 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001323
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001324 return 0;
1325}
1326
1327static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1328{
1329 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001330 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001331 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1332
Harald Welte52b1f982008-12-23 20:25:15 +00001333 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001334 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001335 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001336 ia->proto_discr = GSM48_PDISC_RR;
1337 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1338 ia->page_mode = GSM48_PM_SAME;
1339 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001340
Harald Welte8470bf22008-12-25 23:28:35 +00001341 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001342 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1343 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001344 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001345 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001346 } else {
laforge09108bf2010-06-20 15:18:46 +02001347 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1348 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001349 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001350 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1351 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001352
Harald Welteb7e81162009-08-10 00:26:10 +02001353 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1354 lchan->T3101.cb = t3101_expired;
1355 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001356 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001357
Harald Welte52b1f982008-12-23 20:25:15 +00001358 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001359 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001360}
1361
Harald Welteea280442009-02-02 22:29:56 +00001362/* MS has requested a channel on the RACH */
1363static int rsl_rx_ccch_load(struct msgb *msg)
1364{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001365 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001366 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];
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001375 if (is_ipaccess_bts(sign_link->trx->bts) && pg_buf_space == 0xffff) {
Harald Welte38e9c822010-04-19 10:24:07 +02001376 /* paging load below configured threshold, use 50 as default */
1377 pg_buf_space = 50;
1378 }
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001379 paging_update_buffer_space(sign_link->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{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001397 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001398 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001399 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001400
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001401 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +00001402
1403 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001404 case RSL_MT_CHAN_RQD:
1405 /* MS has requested a channel on the RACH */
1406 rc = rsl_rx_chan_rqd(msg);
1407 break;
Harald Welteea280442009-02-02 22:29:56 +00001408 case RSL_MT_CCCH_LOAD_IND:
1409 /* current load on the CCCH */
1410 rc = rsl_rx_ccch_load(msg);
1411 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001412 case RSL_MT_DELETE_IND:
1413 /* CCCH overloaded, IMM_ASSIGN was dropped */
1414 case RSL_MT_CBCH_LOAD_IND:
1415 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001416 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1417 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001418 break;
1419 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001420 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1421 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001422 return -EINVAL;
1423 }
Harald Welte8470bf22008-12-25 23:28:35 +00001424
1425 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001426}
1427
Harald Welte4b634542008-12-27 01:55:51 +00001428static int rsl_rx_rll_err_ind(struct msgb *msg)
1429{
1430 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001431 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001432
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001433 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001434 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001435 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001436
1437 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001438
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001439 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001440 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001441 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001442 }
Harald Welte81543bc2009-07-04 09:40:05 +02001443
Harald Welte4b634542008-12-27 01:55:51 +00001444 return 0;
1445}
Harald Weltef325eb42009-02-19 17:07:39 +00001446
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001447static void rsl_handle_release(struct gsm_lchan *lchan)
1448{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001449 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001450 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001451
1452 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001453 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001454 return;
1455
1456 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1457 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1458 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001459 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001460 gsm_lchan_name(lchan), sapi);
1461 return;
1462 }
1463
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001464
1465
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001466 /* wait a bit to send the RF Channel Release */
1467 lchan->T3111.cb = t3111_expired;
1468 lchan->T3111.data = lchan;
1469 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001470 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001471}
1472
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001473/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001474 0x02, 0x06,
1475 0x01, 0x20,
1476 0x02, 0x00,
1477 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1478
1479static int abis_rsl_rx_rll(struct msgb *msg)
1480{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001481 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001482 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001483 int rc = 0;
1484 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001485 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001486
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001487 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001488 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001489 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001490
1491 switch (rllh->c.msg_type) {
1492 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001493 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001494 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001495 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1496 rllh->data[0] == RSL_IE_L3_INFO) {
1497 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001498 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001499 }
Harald Welte52b1f982008-12-23 20:25:15 +00001500 break;
1501 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001502 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001503 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001504 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001505 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001506 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001507 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1508 rllh->data[0] == RSL_IE_L3_INFO) {
1509 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001510 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001511 }
Harald Welte52b1f982008-12-23 20:25:15 +00001512 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001513 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001514 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001515 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001516 rll_indication(msg->lchan, rllh->link_id,
1517 BSC_RLLR_IND_EST_CONF);
1518 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001519 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001520 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001521 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001522 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001523 rll_indication(msg->lchan, rllh->link_id,
1524 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001525 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001526 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001527 break;
1528 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001529 /* BTS informs us of having received UA from MS,
1530 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001531 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001532 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001533 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001534 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001535 break;
1536 case RSL_MT_ERROR_IND:
1537 rc = rsl_rx_rll_err_ind(msg);
1538 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001539 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001540 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1541 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001542 break;
1543 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001544 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1545 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001546 }
Harald Welte8470bf22008-12-25 23:28:35 +00001547 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001548}
1549
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001550static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001551{
Harald Welte0603c9d2009-12-02 01:58:23 +05301552 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001553 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301554 switch (lchan->type) {
1555 case GSM_LCHAN_TCH_F:
1556 return 0x00;
1557 case GSM_LCHAN_TCH_H:
1558 return 0x03;
1559 default:
1560 break;
1561 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001562 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301563 switch (lchan->type) {
1564 case GSM_LCHAN_TCH_F:
1565 return 0x01;
1566 /* there's no half-rate EFR */
1567 default:
1568 break;
1569 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001570 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301571 switch (lchan->type) {
1572 case GSM_LCHAN_TCH_F:
1573 return 0x02;
1574 case GSM_LCHAN_TCH_H:
1575 return 0x05;
1576 default:
1577 break;
1578 }
1579 default:
1580 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001581 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001582 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301583 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001584 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001585}
1586
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001587static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001588{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001589 struct gsm_network *net = lchan->ts->trx->bts->network;
1590
Sylvain Munautb54dda42009-12-20 22:06:40 +01001591 switch (lchan->tch_mode) {
1592 case GSM48_CMODE_SPEECH_V1:
1593 switch (lchan->type) {
1594 case GSM_LCHAN_TCH_F:
1595 return RTP_PT_GSM_FULL;
1596 case GSM_LCHAN_TCH_H:
1597 return RTP_PT_GSM_HALF;
1598 default:
1599 break;
1600 }
1601 case GSM48_CMODE_SPEECH_EFR:
1602 switch (lchan->type) {
1603 case GSM_LCHAN_TCH_F:
1604 return RTP_PT_GSM_EFR;
1605 /* there's no half-rate EFR */
1606 default:
1607 break;
1608 }
1609 case GSM48_CMODE_SPEECH_AMR:
1610 switch (lchan->type) {
1611 case GSM_LCHAN_TCH_F:
Sylvain Munautb54dda42009-12-20 22:06:40 +01001612 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freythered999b22011-07-21 10:24:46 +02001613 return RTP_PT_AMR;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001614 default:
1615 break;
1616 }
1617 default:
1618 break;
1619 }
1620 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1621 "tch_mode == 0x%02x\n & lchan_type == %d",
1622 lchan->tch_mode, lchan->type);
1623 return 0;
1624}
1625
Harald Welte75099262009-02-16 21:12:08 +00001626/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001627static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1628{
1629 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001630 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001631
1632 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001633 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001634 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1635 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1636 }
1637
1638 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001639 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001640 port = ntohs(port);
1641 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1642 lchan->abis_ip.bound_port = port;
1643 }
1644
1645 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001646 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001647 conn_id = ntohs(conn_id);
1648 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1649 lchan->abis_ip.conn_id = conn_id;
1650 }
1651
1652 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1653 lchan->abis_ip.rtp_payload2 =
1654 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1655 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1656 lchan->abis_ip.rtp_payload2);
1657 }
1658
1659 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1660 lchan->abis_ip.speech_mode =
1661 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1662 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1663 lchan->abis_ip.speech_mode);
1664 }
1665
1666 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001667 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001668 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1669 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1670 }
1671
1672 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001673 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001674 port = ntohs(port);
1675 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1676 lchan->abis_ip.connect_port = port;
1677 }
1678}
1679
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001680int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001681{
1682 struct msgb *msg = rsl_msgb_alloc();
1683 struct abis_rsl_dchan_hdr *dh;
1684
1685 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001686 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001687 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001688 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001689
Harald Weltef4e79f22009-07-28 18:11:56 +02001690 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001691 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001692 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001693 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001694 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001695
Sylvain Munautb54dda42009-12-20 22:06:40 +01001696 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1697 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1698 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001699
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001700 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001701
1702 return abis_rsl_sendmsg(msg);
1703}
1704
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001705int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1706 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001707{
1708 struct msgb *msg = rsl_msgb_alloc();
1709 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001710 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001711 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001712
1713 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001714 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001715 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001716 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001717
Harald Welte5e3d91b2009-12-19 16:42:06 +01001718 /* we need to store these now as MDCX_ACK does not return them :( */
1719 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1720 lchan->abis_ip.connect_port = port;
1721 lchan->abis_ip.connect_ip = ip;
1722
Harald Welte58ca5b72009-07-29 12:12:18 +02001723 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001724 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001725 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001726
Harald Weltef4e79f22009-07-28 18:11:56 +02001727 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001728 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1729 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1730 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1731 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001732
Harald Welte5e3d91b2009-12-19 16:42:06 +01001733 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1734 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001735 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001736 *att_ip = ia.s_addr;
1737 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1738 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001739 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001740 if (rtp_payload2)
1741 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001742
1743 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001744
1745 return abis_rsl_sendmsg(msg);
1746}
1747
Harald Weltea72273e2009-12-20 16:51:09 +01001748/* tell BTS to connect RTP stream to our local RTP socket */
1749int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1750{
1751 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1752 int rc;
1753
1754 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1755 ntohs(rs->rtp.sin_local.sin_port),
1756 /* FIXME: use RTP payload of bound socket, not BTS*/
1757 lchan->abis_ip.rtp_payload2);
1758
1759 return rc;
1760}
1761
Harald Welte53cd7ac2010-12-23 12:59:52 +01001762int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001763{
1764 struct msgb *msg = rsl_msgb_alloc();
1765 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001766 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001767
1768 if (act)
1769 msg_type = RSL_MT_IPAC_PDCH_ACT;
1770 else
1771 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001772
1773 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001774 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001775 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001776 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001777
Harald Welte53cd7ac2010-12-23 12:59:52 +01001778 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001779 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001780
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001781 msg->dst = ts->trx->rsl_link;
Harald Welte9c880c92009-10-24 10:29:22 +02001782
1783 return abis_rsl_sendmsg(msg);
1784}
1785
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001786static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001787{
1788 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1789 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301790 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001791
1792 /* the BTS has acknowledged a local bind, it now tells us the IP
1793 * address and port number to which it has bound the given logical
1794 * channel */
1795
1796 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1797 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1798 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001799 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001800 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001801 return -EINVAL;
1802 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001803
Harald Welte5e3d91b2009-12-19 16:42:06 +01001804 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001805
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001806 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001807
Harald Welte75099262009-02-16 21:12:08 +00001808 return 0;
1809}
1810
Harald Welte5e3d91b2009-12-19 16:42:06 +01001811static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1812{
1813 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1814 struct tlv_parsed tv;
1815 struct gsm_lchan *lchan = msg->lchan;
1816
1817 /* the BTS has acknowledged a remote connect request and
1818 * it now tells us the IP address and port number to which it has
1819 * connected the given logical channel */
1820
1821 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1822 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001823 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001824
1825 return 0;
1826}
1827
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001828static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001829{
1830 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1831 struct tlv_parsed tv;
1832
1833 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001834
Harald Welte8830e072009-07-28 17:58:09 +02001835 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001836 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001837 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001838
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001839 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001840
Harald Welte75099262009-02-16 21:12:08 +00001841 return 0;
1842}
1843
1844static int abis_rsl_rx_ipacc(struct msgb *msg)
1845{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001846 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte75099262009-02-16 21:12:08 +00001847 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001848 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001849 int rc = 0;
1850
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001851 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001852 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001853
1854 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001855 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001856 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001857 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001858 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001859 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001860 /* somehow the BTS was unable to bind the lchan to its local
1861 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001862 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001863 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001864 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001865 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001866 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001867 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001868 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001869 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001870 /* somehow the BTS was unable to connect the lchan to a remote
1871 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001872 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001873 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001874 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001875 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001876 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001877 break;
1878 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001879 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001880 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001881 break;
1882 }
Harald Welte6dab0552009-05-01 17:21:37 +00001883 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001884
1885 return rc;
1886}
1887
1888
Harald Welte52b1f982008-12-23 20:25:15 +00001889/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001890int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001891{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001892 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001893 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001894
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001895 if (!msg) {
1896 DEBUGP(DRSL, "Empty RSL msg?..\n");
1897 return -1;
1898 }
1899
1900 if (msgb_l2len(msg) < sizeof(*rslh)) {
1901 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1902 return -1;
1903 }
1904
1905 rslh = msgb_l2(msg);
1906
Harald Welte52b1f982008-12-23 20:25:15 +00001907 switch (rslh->msg_discr & 0xfe) {
1908 case ABIS_RSL_MDISC_RLL:
1909 rc = abis_rsl_rx_rll(msg);
1910 break;
1911 case ABIS_RSL_MDISC_DED_CHAN:
1912 rc = abis_rsl_rx_dchan(msg);
1913 break;
1914 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001915 rc = abis_rsl_rx_cchan(msg);
1916 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001917 case ABIS_RSL_MDISC_TRX:
1918 rc = abis_rsl_rx_trx(msg);
1919 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001920 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001921 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001922 rslh->msg_discr);
1923 break;
Harald Welte75099262009-02-16 21:12:08 +00001924 case ABIS_RSL_MDISC_IPACCESS:
1925 rc = abis_rsl_rx_ipacc(msg);
1926 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001927 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001928 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1929 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001930 return -EINVAL;
1931 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001932 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001933 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001934}
Holger Freyther3b72a892009-02-04 00:31:39 +00001935
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001936int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1937 uint8_t cb_command, const uint8_t *data, int len)
1938{
1939 struct abis_rsl_dchan_hdr *dh;
1940 struct msgb *cb_cmd;
1941
1942 cb_cmd = rsl_msgb_alloc();
1943 if (!cb_cmd)
1944 return -1;
1945
1946 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1947 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1948 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1949
1950 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1951 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1952
1953 cb_cmd->trx = bts->c0;
1954
1955 return abis_rsl_sendmsg(cb_cmd);
1956}
Dieter Spaar16646022011-07-28 00:01:50 +02001957
1958int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
1959{
1960 struct abis_rsl_common_hdr *ch;
1961 struct msgb *msg = rsl_msgb_alloc();
1962
1963 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1964 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1965 ch->msg_type = 0x40; /* Nokia SI Begin */
1966
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001967 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02001968
1969 return abis_rsl_sendmsg(msg);
1970}
1971
1972int rsl_nokia_si_end(struct gsm_bts_trx *trx)
1973{
1974 struct abis_rsl_common_hdr *ch;
1975 struct msgb *msg = rsl_msgb_alloc();
1976
1977 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1978 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1979 ch->msg_type = 0x41; /* Nokia SI End */
1980
1981 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
1982
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001983 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02001984
1985 return abis_rsl_sendmsg(msg);
1986}
1987
1988int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
1989{
1990 struct abis_rsl_common_hdr *ch;
1991 struct msgb *msg = rsl_msgb_alloc();
1992
1993 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1994 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1995 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
1996
1997 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
1998 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
1999
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02002000 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002001
2002 return abis_rsl_sendmsg(msg);
2003}