blob: d9084e128cfce383b26eb02738dee64e935035ef [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
Daniel Willmann513da172011-08-11 04:44:12 +0200199 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
200 lchan_free(lchan);
Harald Weltee8bd9e82011-08-10 23:26:33 +0200201}
202
203
Harald Welte52b1f982008-12-23 20:25:15 +0000204/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200205int rsl_bcch_info(struct gsm_bts_trx *trx, uint8_t type,
206 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000207{
208 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000209 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000210
211 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
212 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
213 dh->chan_nr = RSL_CHAN_BCCH;
214
215 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
216 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
217
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200218 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000219
220 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000221}
222
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200223int rsl_sacch_filling(struct gsm_bts_trx *trx, uint8_t type,
224 const uint8_t *data, int len)
Harald Welte52b1f982008-12-23 20:25:15 +0000225{
226 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000227 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000228
229 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
230 ch->msg_discr = ABIS_RSL_MDISC_TRX;
231 ch->msg_type = RSL_MT_SACCH_FILL;
232
233 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000234 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000235
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200236 msg->dst = trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000237
238 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000239}
240
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200241int rsl_sacch_info_modify(struct gsm_lchan *lchan, uint8_t type,
242 const uint8_t *data, int len)
Harald Welte7a69cf02011-01-13 23:16:03 +0100243{
244 struct abis_rsl_dchan_hdr *dh;
245 struct msgb *msg = rsl_msgb_alloc();
Harald Weltef6093a42011-06-25 10:02:33 +0200246 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte7a69cf02011-01-13 23:16:03 +0100247
248 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
249 init_dchan_hdr(dh, RSL_MT_SACCH_INFO_MODIFY);
250 dh->chan_nr = chan_nr;
251
252 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
253 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
254
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200255 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte7a69cf02011-01-13 23:16:03 +0100256
257 return abis_rsl_sendmsg(msg);
258}
259
Harald Weltefcd24452009-06-20 18:15:19 +0200260int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
261{
262 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200263 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200264 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200265
266 db = abs(db);
267 if (db > 30)
268 return -EINVAL;
269
Harald Welteeab33352009-06-27 03:09:08 +0200270 msg = rsl_msgb_alloc();
271
Harald Weltefcd24452009-06-20 18:15:19 +0200272 lchan->bs_power = db/2;
273 if (fpc)
274 lchan->bs_power |= 0x10;
275
276 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
277 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
278 dh->chan_nr = chan_nr;
279
280 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
281
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200282 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200283
284 return abis_rsl_sendmsg(msg);
285}
286
Harald Weltefcd24452009-06-20 18:15:19 +0200287int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
288{
289 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200290 struct msgb *msg;
Harald Weltef6093a42011-06-25 10:02:33 +0200291 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltefcd24452009-06-20 18:15:19 +0200292 int ctl_lvl;
293
Harald Welte66b6a8d2009-08-09 14:45:18 +0200294 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200295 if (ctl_lvl < 0)
296 return ctl_lvl;
297
Harald Welteeab33352009-06-27 03:09:08 +0200298 msg = rsl_msgb_alloc();
299
Harald Weltefcd24452009-06-20 18:15:19 +0200300 lchan->ms_power = ctl_lvl;
301
302 if (fpc)
303 lchan->ms_power |= 0x20;
304
305 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
306 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
307 dh->chan_nr = chan_nr;
308
309 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
310
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200311 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltefcd24452009-06-20 18:15:19 +0200312
313 return abis_rsl_sendmsg(msg);
314}
315
Harald Welte9943c5b2009-07-29 15:41:29 +0200316static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
317 struct gsm_lchan *lchan)
318{
319 memset(cm, 0, sizeof(cm));
320
321 /* FIXME: what to do with data calls ? */
Holger Hans Peter Freyther5a3a61d2010-09-06 09:25:48 +0800322 if (lchan->ts->trx->bts->network->dtx_enabled)
323 cm->dtx_dtu = 0x03;
324 else
325 cm->dtx_dtu = 0x00;
Harald Welte9943c5b2009-07-29 15:41:29 +0200326
327 /* set TCH Speech/Data */
328 cm->spd_ind = lchan->rsl_cmode;
329
Harald Welte1a79d362009-11-27 08:55:16 +0100330 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
331 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100332 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte1a79d362009-11-27 08:55:16 +0100333 "but tch_mode != signalling\n");
334
Harald Welte9943c5b2009-07-29 15:41:29 +0200335 switch (lchan->type) {
336 case GSM_LCHAN_SDCCH:
337 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
338 break;
339 case GSM_LCHAN_TCH_F:
340 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
341 break;
342 case GSM_LCHAN_TCH_H:
343 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
344 break;
345 case GSM_LCHAN_NONE:
346 case GSM_LCHAN_UNKNOWN:
347 default:
348 return -EINVAL;
349 }
350
351 switch (lchan->tch_mode) {
352 case GSM48_CMODE_SIGN:
353 cm->chan_rate = 0;
354 break;
355 case GSM48_CMODE_SPEECH_V1:
356 cm->chan_rate = RSL_CMOD_SP_GSM1;
357 break;
358 case GSM48_CMODE_SPEECH_EFR:
359 cm->chan_rate = RSL_CMOD_SP_GSM2;
360 break;
361 case GSM48_CMODE_SPEECH_AMR:
362 cm->chan_rate = RSL_CMOD_SP_GSM3;
363 break;
364 case GSM48_CMODE_DATA_14k5:
365 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
366 break;
367 case GSM48_CMODE_DATA_12k0:
368 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
369 break;
370 case GSM48_CMODE_DATA_6k0:
371 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
372 break;
373 default:
374 return -EINVAL;
375 }
376
377 return 0;
378}
379
Harald Welte52b1f982008-12-23 20:25:15 +0000380/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000381#if 0
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200382int rsl_chan_activate(struct gsm_bts_trx *trx, uint8_t chan_nr,
383 uint8_t act_type,
Harald Welte52b1f982008-12-23 20:25:15 +0000384 struct rsl_ie_chan_mode *chan_mode,
385 struct rsl_ie_chan_ident *chan_ident,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200386 uint8_t bs_power, uint8_t ms_power,
387 uint8_t ta)
Harald Welte52b1f982008-12-23 20:25:15 +0000388{
389 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000390 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000391
392 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
393 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
394 dh->chan_nr = chan_nr;
395
396 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
397 /* For compatibility with Phase 1 */
398 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200399 (uint8_t *) chan_mode);
Harald Welte52b1f982008-12-23 20:25:15 +0000400 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200401 (uint8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000402#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000403 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200404 (uint8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000405#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000406 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000407 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
408 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
409
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200410 msg->dst = trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000411
Harald Welte8470bf22008-12-25 23:28:35 +0000412 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000413}
Harald Welteddab3c72009-02-28 13:19:15 +0000414#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000415
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200416int rsl_chan_activate_lchan(struct gsm_lchan *lchan, uint8_t act_type,
417 uint8_t ta, uint8_t ho_ref)
Harald Welte4b634542008-12-27 01:55:51 +0000418{
419 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200420 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200421 int rc;
Harald Welte93d50e62010-06-29 17:53:45 +0200422 uint8_t *len;
Harald Welte4b634542008-12-27 01:55:51 +0000423
Harald Weltef6093a42011-06-25 10:02:33 +0200424 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000425 struct rsl_ie_chan_mode cm;
laforge694a5cf2010-06-20 21:38:19 +0200426 struct gsm48_chan_desc cd;
Harald Welte4b634542008-12-27 01:55:51 +0000427
Harald Welte9943c5b2009-07-29 15:41:29 +0200428 rc = channel_mode_from_lchan(&cm, lchan);
429 if (rc < 0)
430 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000431
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800432 memset(&cd, 0, sizeof(cd));
laforge694a5cf2010-06-20 21:38:19 +0200433 gsm48_lchan2chan_desc(&cd, lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000434
Harald Welteeab33352009-06-27 03:09:08 +0200435 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000436 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
437 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
438 dh->chan_nr = chan_nr;
439
440 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte4b634542008-12-27 01:55:51 +0000441 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200442 (uint8_t *) &cm);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800443
444 /*
445 * The Channel Identification is needed for Phase1 phones
446 * and it contains the GSM48 Channel Description and the
447 * Mobile Allocation. The GSM 08.58 asks for the Mobile
448 * Allocation to have a length of zero. We are using the
449 * msgb_l3len to calculate the length of both messages.
450 */
laforge694a5cf2010-06-20 21:38:19 +0200451 msgb_v_put(msg, RSL_IE_CHAN_IDENT);
Harald Welte93d50e62010-06-29 17:53:45 +0200452 len = msgb_put(msg, 1);
Dieter Spaareabb6e32011-07-27 23:40:33 +0200453 msgb_tv_fixed_put(msg, GSM48_IE_CHANDESC_2, sizeof(cd), (const uint8_t *) &cd);
Holger Hans Peter Freyther0379c6d2010-06-30 12:06:20 +0800454
455 if (lchan->ts->hopping.enabled)
456 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, lchan->ts->hopping.ma_len,
457 lchan->ts->hopping.ma_data);
458 else
459 msgb_tlv_put(msg, GSM48_IE_MA_AFTER, 0, NULL);
Holger Hans Peter Freythere38bd6c2010-06-30 11:56:43 +0800460
461 /* update the calculated size */
462 msg->l3h = len + 1;
463 *len = msgb_l3len(msg);
464
Harald Welte08d91a52009-08-30 15:37:11 +0900465 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200466 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900467 rc = build_encr_info(encr_info, lchan);
468 if (rc > 0)
469 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
470 }
471
Harald Welte8d77b952009-12-17 00:31:10 +0100472 switch (act_type) {
473 case RSL_ACT_INTER_ASYNC:
474 case RSL_ACT_INTER_SYNC:
475 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
476 break;
477 default:
478 break;
479 }
480
Harald Welted4c9bf32009-02-15 16:56:18 +0000481 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
482 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000483 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
484
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100485 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
486 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200487 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freyther93b6c652010-01-28 04:45:05 +0100488
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200489 msg->dst = lchan->ts->trx->rsl_link;
Harald Weltee79769b2009-02-07 00:48:17 +0000490
Harald Welte4b634542008-12-27 01:55:51 +0000491 return abis_rsl_sendmsg(msg);
492}
493
Harald Welte470abb72009-07-29 11:38:15 +0200494/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000495int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
496{
497 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200498 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200499 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000500
Harald Weltef6093a42011-06-25 10:02:33 +0200501 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteda783762009-02-18 03:29:53 +0000502 struct rsl_ie_chan_mode cm;
503
Harald Welte9943c5b2009-07-29 15:41:29 +0200504 rc = channel_mode_from_lchan(&cm, lchan);
505 if (rc < 0)
506 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000507
Harald Welteeab33352009-06-27 03:09:08 +0200508 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000509 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
510 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
511 dh->chan_nr = chan_nr;
512
513 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200514 (uint8_t *) &cm);
Harald Welte08d91a52009-08-30 15:37:11 +0900515
516 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200517 uint8_t encr_info[MAX_A5_KEY_LEN+2];
Harald Welte08d91a52009-08-30 15:37:11 +0900518 rc = build_encr_info(encr_info, lchan);
519 if (rc > 0)
520 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
521 }
522
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100523 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
524 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200525 (uint8_t *) &lchan->mr_conf);
Holger Hans Peter Freytherea528022009-11-18 22:57:02 +0100526 }
527
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200528 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte08d91a52009-08-30 15:37:11 +0900529
530 return abis_rsl_sendmsg(msg);
531}
532
533/* Chapter 8.4.6: Send the encryption command with given L3 info */
534int rsl_encryption_cmd(struct msgb *msg)
535{
536 struct abis_rsl_dchan_hdr *dh;
537 struct gsm_lchan *lchan = msg->lchan;
Harald Weltef6093a42011-06-25 10:02:33 +0200538 uint8_t chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200539 uint8_t encr_info[MAX_A5_KEY_LEN+2];
540 uint8_t l3_len = msg->len;
Harald Welte08d91a52009-08-30 15:37:11 +0900541 int rc;
542
543 /* First push the L3 IE tag and length */
544 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
545
546 /* then the link identifier (SAPI0, main sign link) */
547 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
548
549 /* then encryption information */
550 rc = build_encr_info(encr_info, lchan);
551 if (rc <= 0)
552 return rc;
553 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
554
555 /* and finally the DCHAN header */
556 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
557 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
558 dh->chan_nr = chan_nr;
Harald Welteda783762009-02-18 03:29:53 +0000559
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200560 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteda783762009-02-18 03:29:53 +0000561
562 return abis_rsl_sendmsg(msg);
563}
564
Harald Welte115d1032009-08-10 11:43:22 +0200565/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-07-19 18:36:49 +0200566int rsl_deact_sacch(struct gsm_lchan *lchan)
567{
568 struct abis_rsl_dchan_hdr *dh;
569 struct msgb *msg = rsl_msgb_alloc();
570
571 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
572 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
Harald Weltef6093a42011-06-25 10:02:33 +0200573 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welteae0f2362009-07-19 18:36:49 +0200574
575 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200576 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteae0f2362009-07-19 18:36:49 +0200577
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100578 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_lchan_name(lchan));
Harald Welteae0f2362009-07-19 18:36:49 +0200579
580 return abis_rsl_sendmsg(msg);
581}
582
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800583static void error_timeout_cb(void *data)
584{
585 struct gsm_lchan *lchan = data;
586 if (lchan->state != LCHAN_S_REL_ERR) {
587 LOGP(DRSL, LOGL_ERROR, "%s error timeout but not in error state: %d\n",
588 gsm_lchan_name(lchan), lchan->state);
589 return;
590 }
591
592 /* go back to the none state */
593 LOGP(DRSL, LOGL_NOTICE, "%s is back in operation.\n", gsm_lchan_name(lchan));
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800594 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800595}
596
Harald Weltefd355a32011-03-04 13:41:31 +0100597static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan);
598
Harald Welte115d1032009-08-10 11:43:22 +0200599/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800600static int rsl_rf_chan_release(struct gsm_lchan *lchan, int error)
Harald Welte52b1f982008-12-23 20:25:15 +0000601{
602 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800603 struct msgb *msg;
Harald Weltefd355a32011-03-04 13:41:31 +0100604 int rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000605
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800606 if (lchan->state == LCHAN_S_REL_ERR) {
607 LOGP(DRSL, LOGL_NOTICE, "%s is in error state not sending release.\n",
608 gsm_lchan_name(lchan));
609 return -1;
610 }
611
612 msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000613 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
614 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Weltef6093a42011-06-25 10:02:33 +0200615 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000616
Harald Welte8470bf22008-12-25 23:28:35 +0000617 msg->lchan = lchan;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200618 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000619
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800620 DEBUGP(DRSL, "%s RF Channel Release CMD due error %d\n", gsm_lchan_name(lchan), error);
621
622 if (error) {
623 /*
624 * the nanoBTS sends RLL release indications after the channel release. This can
625 * be a problem when we have reassigned the channel to someone else and then can
626 * not figure out who used this channel.
627 */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200628 struct e1inp_sign_link *sign_link = msg->dst;
629
Holger Hans Peter Freyther44752d92010-06-08 11:53:33 +0800630 rsl_lchan_set_state(lchan, LCHAN_S_REL_ERR);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800631 lchan->error_timer.data = lchan;
632 lchan->error_timer.cb = error_timeout_cb;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200633 osmo_timer_schedule(&lchan->error_timer,
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200634 sign_link->trx->bts->network->T3111 + 2, 0);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800635 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000636
Harald Weltee8bd9e82011-08-10 23:26:33 +0200637 /* Start another timer or assume the BTS sends a ACK/NACK? */
638 lchan->act_timer.cb = lchan_deact_tmr_cb;
639 lchan->act_timer.data = lchan;
640 osmo_timer_schedule(&lchan->act_timer, 4, 0);
641
Harald Weltefd355a32011-03-04 13:41:31 +0100642 rc = abis_rsl_sendmsg(msg);
643
Harald Welte115d1032009-08-10 11:43:22 +0200644 /* BTS will respond by RF CHAN REL ACK */
Harald Welte26d79072011-01-14 23:18:59 +0100645#ifdef HSL_SR_1_0
Harald Weltefd355a32011-03-04 13:41:31 +0100646 /* The HSL Femto seems to 'forget' sending a REL ACK for TS1...TS7 */
647 if (lchan->ts->trx->bts->type == GSM_BTS_TYPE_HSL_FEMTO && lchan->ts->nr != 0)
648 rc = rsl_rx_rf_chan_rel_ack(lchan);
Harald Welte26d79072011-01-14 23:18:59 +0100649#endif
Harald Weltefd355a32011-03-04 13:41:31 +0100650
651 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000652}
653
Harald Welte64bb7542011-01-14 14:16:16 +0100654static int rsl_rx_rf_chan_rel_ack(struct gsm_lchan *lchan)
655{
656
657 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", gsm_lchan_name(lchan));
658
Harald Weltee8bd9e82011-08-10 23:26:33 +0200659 osmo_timer_del(&lchan->act_timer);
660
Harald Welte64bb7542011-01-14 14:16:16 +0100661 if (lchan->state != LCHAN_S_REL_REQ && lchan->state != LCHAN_S_REL_ERR)
662 LOGP(DRSL, LOGL_NOTICE, "%s CHAN REL ACK but state %s\n",
663 gsm_lchan_name(lchan),
664 gsm_lchans_name(lchan->state));
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +0200665 osmo_timer_del(&lchan->T3111);
Harald Welte64bb7542011-01-14 14:16:16 +0100666 /* we have an error timer pending to release that */
667 if (lchan->state != LCHAN_S_REL_ERR)
668 rsl_lchan_set_state(lchan, LCHAN_S_NONE);
669 lchan_free(lchan);
670
671 return 0;
672}
673
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200674int rsl_paging_cmd(struct gsm_bts *bts, uint8_t paging_group, uint8_t len,
675 uint8_t *ms_ident, uint8_t chan_needed)
Harald Welte52b1f982008-12-23 20:25:15 +0000676{
677 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000678 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000679
680 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
681 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
682 dh->chan_nr = RSL_CHAN_PCH_AGCH;
683
684 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000685 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000686 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
687
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200688 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000689
690 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000691}
692
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200693int imsi_str2bcd(uint8_t *bcd_out, const char *str_in)
Harald Welte52b1f982008-12-23 20:25:15 +0000694{
695 int i, len = strlen(str_in);
696
697 for (i = 0; i < len; i++) {
698 int num = str_in[i] - 0x30;
699 if (num < 0 || num > 9)
700 return -1;
701 if (i % 2 == 0)
702 bcd_out[i/2] = num;
703 else
704 bcd_out[i/2] |= (num << 4);
705 }
706
707 return 0;
708}
709
Harald Welte702d8702008-12-26 20:25:35 +0000710/* Chapter 8.5.6 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200711int rsl_imm_assign_cmd(struct gsm_bts *bts, uint8_t len, uint8_t *val)
Harald Welte52b1f982008-12-23 20:25:15 +0000712{
Harald Welte8470bf22008-12-25 23:28:35 +0000713 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000714 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200715 uint8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000716
717 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
718 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
719 dh->chan_nr = RSL_CHAN_PCH_AGCH;
720
Harald Welte362322e2009-02-15 14:36:38 +0000721 switch (bts->type) {
722 case GSM_BTS_TYPE_BS11:
723 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
724 break;
725 default:
726 /* If phase 2, construct a FULL_IMM_ASS_INFO */
727 pad_macblock(buf, val, len);
728 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
729 break;
730 }
Harald Welte52b1f982008-12-23 20:25:15 +0000731
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200732 msg->dst = bts->c0->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000733
734 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000735}
736
Harald Welte67fa91b2009-08-10 09:51:40 +0200737/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200738int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-08-10 09:51:40 +0200739{
740 struct msgb *msg = rsl_msgb_alloc();
741 struct abis_rsl_dchan_hdr *dh;
742
743 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
744 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte3c456d02009-08-10 11:26:14 +0200745 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +0200746 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200747 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(uint8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200748
Harald Welte5b8ed432009-12-24 12:20:20 +0100749 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200750 gsm_lchan_name(lchan), *(uint8_t *)mrpci);
Harald Welte3c456d02009-08-10 11:26:14 +0200751
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200752 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte3c456d02009-08-10 11:26:14 +0200753
Harald Welte67fa91b2009-08-10 09:51:40 +0200754 return abis_rsl_sendmsg(msg);
755}
756
757
Harald Welte8470bf22008-12-25 23:28:35 +0000758/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000759/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200760int rsl_data_request(struct msgb *msg, uint8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000761{
Harald Welte8470bf22008-12-25 23:28:35 +0000762 if (msg->lchan == NULL) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100763 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000764 return -EINVAL;
765 }
Harald Welte52b1f982008-12-23 20:25:15 +0000766
Harald Weltef6093a42011-06-25 10:02:33 +0200767 rsl_rll_push_l3(msg, RSL_MT_DATA_REQ, gsm_lchan2chan_nr(msg->lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100768 link_id, 1);
Harald Welte52b1f982008-12-23 20:25:15 +0000769
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200770 msg->dst = msg->lchan->ts->trx->rsl_link;
Harald Welte8470bf22008-12-25 23:28:35 +0000771
772 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000773}
774
Harald Welteedcc5272009-08-09 13:47:35 +0200775/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
776/* Chapter 8.3.1 */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200777int rsl_establish_request(struct gsm_lchan *lchan, uint8_t link_id)
Harald Welteedcc5272009-08-09 13:47:35 +0200778{
Harald Welte3c9c5f92010-03-04 10:33:10 +0100779 struct msgb *msg;
Harald Welteedcc5272009-08-09 13:47:35 +0200780
Harald Weltef6093a42011-06-25 10:02:33 +0200781 msg = rsl_rll_simple(RSL_MT_EST_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100782 link_id, 0);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200783 msg->dst = lchan->ts->trx->rsl_link;
Harald Welteedcc5272009-08-09 13:47:35 +0200784
785 return abis_rsl_sendmsg(msg);
786}
787
Harald Welted2dc1de2009-08-08 13:15:07 +0200788/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
789 This is what higher layers should call. The BTS then responds with
790 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
791 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
792 lchan_free() */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200793int rsl_release_request(struct gsm_lchan *lchan, uint8_t link_id, uint8_t reason)
Harald Welted2dc1de2009-08-08 13:15:07 +0200794{
Harald Welted2dc1de2009-08-08 13:15:07 +0200795
Harald Welte3c9c5f92010-03-04 10:33:10 +0100796 struct msgb *msg;
797
Harald Weltef6093a42011-06-25 10:02:33 +0200798 msg = rsl_rll_simple(RSL_MT_REL_REQ, gsm_lchan2chan_nr(lchan),
Harald Welte3c9c5f92010-03-04 10:33:10 +0100799 link_id, 0);
Holger Hans Peter Freyther4f5848d2010-06-08 11:57:45 +0800800 /* 0 is normal release, 1 is local end */
801 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, reason);
Harald Welted2dc1de2009-08-08 13:15:07 +0200802
Harald Welte8e93b792009-12-29 10:44:17 +0100803 /* FIXME: start some timer in case we don't receive a REL ACK ? */
804
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +0200805 msg->dst = lchan->ts->trx->rsl_link;
Harald Welted2dc1de2009-08-08 13:15:07 +0200806
807 return abis_rsl_sendmsg(msg);
808}
809
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200810int rsl_lchan_set_state(struct gsm_lchan *lchan, int state)
811{
812 lchan->state = state;
813 return 0;
814}
815
Harald Welte702d8702008-12-26 20:25:35 +0000816/* Chapter 8.4.2: Channel Activate Acknowledge */
817static int rsl_rx_chan_act_ack(struct msgb *msg)
818{
819 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
820
821 /* BTS has confirmed channel activation, we now need
822 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000823 if (rslh->ie_chan != RSL_IE_CHAN_NR)
824 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100825
Harald Weltee8bd9e82011-08-10 23:26:33 +0200826 osmo_timer_del(&msg->lchan->act_timer);
827
Harald Welte8e93b792009-12-29 10:44:17 +0100828 if (msg->lchan->state != LCHAN_S_ACT_REQ)
Harald Welte1887f9d2009-12-29 10:52:38 +0100829 LOGP(DRSL, LOGL_NOTICE, "%s CHAN ACT ACK, but state %s\n",
830 gsm_lchan_name(msg->lchan),
831 gsm_lchans_name(msg->lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200832 rsl_lchan_set_state(msg->lchan, LCHAN_S_ACTIVE);
Harald Welteb8bfc562009-12-21 13:27:11 +0100833
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +0800834 if (msg->lchan->rqd_ref) {
835 rsl_send_imm_assignment(msg->lchan);
836 talloc_free(msg->lchan->rqd_ref);
837 msg->lchan->rqd_ref = NULL;
838 msg->lchan->rqd_ta = 0;
839 }
840
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100841 send_lchan_signal(S_LCHAN_ACTIVATE_ACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100842
Harald Welte4b634542008-12-27 01:55:51 +0000843 return 0;
844}
Harald Welte702d8702008-12-26 20:25:35 +0000845
Harald Welte4b634542008-12-27 01:55:51 +0000846/* Chapter 8.4.3: Channel Activate NACK */
847static int rsl_rx_chan_act_nack(struct msgb *msg)
848{
Harald Welte6dab0552009-05-01 17:21:37 +0000849 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
850 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000851
Harald Weltee8bd9e82011-08-10 23:26:33 +0200852 osmo_timer_del(&msg->lchan->act_timer);
853
Daniel Willmann6fc6a122011-08-11 04:54:23 +0200854 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL ACTIVATE NACK ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100855 gsm_lchan_name(msg->lchan));
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100856
Harald Welte6dab0552009-05-01 17:21:37 +0000857 /* BTS has rejected channel activation ?!? */
858 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000859 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000860
861 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100862 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200863 const uint8_t *cause = TLVP_VAL(&tp, RSL_IE_CAUSE);
Harald Welte (local)3e460312009-12-27 18:12:29 +0100864 print_rsl_cause(LOGL_ERROR, cause,
Harald Welte8830e072009-07-28 17:58:09 +0200865 TLVP_LEN(&tp, RSL_IE_CAUSE));
Harald Welte (local)3e460312009-12-27 18:12:29 +0100866 if (*cause != RSL_ERR_RCH_ALR_ACTV_ALLOC)
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200867 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Daniel Willmann7ddc3182011-08-11 04:47:11 +0200868 else
869 rsl_rf_chan_release(msg->lchan, 1);
870
Harald Welte (local)3e460312009-12-27 18:12:29 +0100871 } else
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +0200872 rsl_lchan_set_state(msg->lchan, LCHAN_S_NONE);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +0200873
Harald Welte (local)91b603d2009-12-27 11:48:11 +0100874 LOGPC(DRSL, LOGL_ERROR, "\n");
875
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +0100876 send_lchan_signal(S_LCHAN_ACTIVATE_NACK, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +0100877
Harald Welte3073a9f2009-08-09 19:50:08 +0200878 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000879 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000880}
881
Harald Welte7f93cea2009-02-23 00:02:59 +0000882/* Chapter 8.4.4: Connection Failure Indication */
883static int rsl_rx_conn_fail(struct msgb *msg)
884{
885 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
886 struct tlv_parsed tp;
887
Harald Welteb1d4c8e2009-12-17 23:10:46 +0100888 /* FIXME: print which channel */
Harald Welte (local)fc057502009-12-26 22:33:09 +0100889 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +0100890 gsm_lchan_name(msg->lchan));
Harald Welte7f93cea2009-02-23 00:02:59 +0000891
892 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
893
Harald Welte8830e072009-07-28 17:58:09 +0200894 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +0100895 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +0200896 TLVP_LEN(&tp, RSL_IE_CAUSE));
897
Harald Welte (local)fc057502009-12-26 22:33:09 +0100898 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000899 /* FIXME: only free it after channel release ACK */
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +0200900 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rf_fail);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +0800901 return rsl_rf_chan_release(msg->lchan, 1);
Harald Welte7f93cea2009-02-23 00:02:59 +0000902}
903
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100904static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
905 const char *prefix)
906{
Harald Welte6739dfb2009-12-16 16:52:07 +0100907 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
908 prefix, rxlev2dbm(mru->full.rx_lev),
909 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100910 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
911 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
912}
913
914static void print_meas_rep(struct gsm_meas_rep *mr)
915{
Harald Welte6739dfb2009-12-16 16:52:07 +0100916 int i;
917
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100918 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
919
920 if (mr->flags & MEAS_REP_F_DL_DTX)
921 DEBUGPC(DMEAS, "DTXd ");
922
923 print_meas_rep_uni(&mr->ul, "ul");
924 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
925 if (mr->flags & MEAS_REP_F_MS_TO)
926 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
927
928 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100929 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100930 DEBUGPC(DMEAS, "L1_FPC=%u ",
931 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
932 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
933 }
934
935 if (mr->flags & MEAS_REP_F_UL_DTX)
936 DEBUGPC(DMEAS, "DTXu ");
937 if (mr->flags & MEAS_REP_F_BA1)
938 DEBUGPC(DMEAS, "BA1 ");
939 if (!(mr->flags & MEAS_REP_F_DL_VALID))
940 DEBUGPC(DMEAS, "NOT VALID ");
941 else
942 print_meas_rep_uni(&mr->dl, "dl");
943
944 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte479015b2009-12-19 18:33:05 +0100945 if (mr->num_cell == 7)
946 return;
Harald Welte6739dfb2009-12-16 16:52:07 +0100947 for (i = 0; i < mr->num_cell; i++) {
948 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte303e5e02009-12-25 23:02:22 +0100949 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
950 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte6739dfb2009-12-16 16:52:07 +0100951 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100952}
953
Harald Welte440fed02009-05-01 18:43:47 +0000954static int rsl_rx_meas_res(struct msgb *msg)
955{
956 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
957 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +0100958 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200959 uint8_t len;
960 const uint8_t *val;
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100961 int rc;
Harald Welte440fed02009-05-01 18:43:47 +0000962
Harald Welteb8bfc562009-12-21 13:27:11 +0100963 /* check if this channel is actually active */
964 /* FIXME: maybe this check should be way more generic/centralized */
Harald Welte8e93b792009-12-29 10:44:17 +0100965 if (msg->lchan->state != LCHAN_S_ACTIVE) {
Holger Hans Peter Freytherc44db4a2010-07-29 14:50:57 +0800966 LOGP(DRSL, LOGL_DEBUG, "%s: MEAS RES for inactive channel\n",
Harald Welte8e93b792009-12-29 10:44:17 +0100967 gsm_lchan_name(msg->lchan));
Harald Welteb8bfc562009-12-21 13:27:11 +0100968 return 0;
Harald Welte8e93b792009-12-29 10:44:17 +0100969 }
Harald Welteb8bfc562009-12-21 13:27:11 +0100970
Harald Welted12b0fd2009-12-15 21:36:05 +0100971 memset(mr, 0, sizeof(*mr));
Harald Welte33e65972009-12-16 23:29:34 +0100972 mr->lchan = msg->lchan;
Harald Weltedbb1d882009-11-30 19:16:47 +0100973
Harald Welte440fed02009-05-01 18:43:47 +0000974 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
975
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100976 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
977 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
978 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
979 return -EIO;
980
981 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +0100982 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100983
984 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
985 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
986 if (len >= 3) {
987 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +0100988 mr->flags |= MEAS_REP_F_DL_DTX;
989 mr->ul.full.rx_lev = val[0] & 0x3f;
990 mr->ul.sub.rx_lev = val[1] & 0x3f;
991 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
992 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +0000993 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100994
Harald Welted12b0fd2009-12-15 21:36:05 +0100995 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100996
997 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +0000998 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +0100999 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001000 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1001
Harald Weltefe9af262009-06-20 18:44:35 +02001002 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001003 struct e1inp_sign_link *sign_link = msg->dst;
1004
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001005 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001006 mr->flags |= MEAS_REP_F_MS_L1;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001007 mr->ms_l1.pwr = ms_pwr_dbm(sign_link->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001008 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001009 mr->flags |= MEAS_REP_F_FPC;
1010 mr->ms_l1.ta = val[1];
Andreas Eversberg2957de92011-12-16 17:45:37 +01001011 /* BS11 reports TA shifted by 2 bits */
1012 if (msg->lchan->ts->trx->bts->type == GSM_BTS_TYPE_BS11)
1013 mr->ms_l1.ta >>= 2;
Harald Weltefe9af262009-06-20 18:44:35 +02001014 }
Harald Weltef7c43522009-06-09 20:24:21 +00001015 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001016 msg->l3h = (uint8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001017 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001018 if (rc < 0)
1019 return rc;
1020 }
1021
Harald Welted12b0fd2009-12-15 21:36:05 +01001022 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001023
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001024 send_lchan_signal(S_LCHAN_MEAS_REP, msg->lchan, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001025
Harald Welte75d34a82009-05-23 06:11:13 +00001026 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001027}
1028
Harald Welted011e8b2009-11-29 22:45:52 +01001029/* Chapter 8.4.7 */
1030static int rsl_rx_hando_det(struct msgb *msg)
1031{
1032 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1033 struct tlv_parsed tp;
1034
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001035 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_lchan_name(msg->lchan));
Harald Welted011e8b2009-11-29 22:45:52 +01001036
1037 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1038
1039 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1040 DEBUGPC(DRSL, "access delay = %u\n",
1041 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1042 else
1043 DEBUGPC(DRSL, "\n");
1044
Holger Hans Peter Freyther08eebd52010-12-27 13:28:20 +01001045 send_lchan_signal(S_LCHAN_HANDOVER_DETECT, msg->lchan, NULL);
Harald Welted011e8b2009-11-29 22:45:52 +01001046
1047 return 0;
1048}
1049
Harald Welte52b1f982008-12-23 20:25:15 +00001050static int abis_rsl_rx_dchan(struct msgb *msg)
1051{
Harald Welte8470bf22008-12-25 23:28:35 +00001052 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1053 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001054 char *ts_name;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001055 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001056
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001057 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001058 ts_name = gsm_lchan_name(msg->lchan);
Harald Weltef325eb42009-02-19 17:07:39 +00001059
Harald Welte8470bf22008-12-25 23:28:35 +00001060 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001061 case RSL_MT_CHAN_ACTIV_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001062 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte4b634542008-12-27 01:55:51 +00001063 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001064 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001065 case RSL_MT_CHAN_ACTIV_NACK:
Harald Welte4b634542008-12-27 01:55:51 +00001066 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001067 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001068 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001069 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001070 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001071 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001072 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001073 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001074 case RSL_MT_HANDO_DET:
1075 rc = rsl_rx_hando_det(msg);
1076 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001077 case RSL_MT_RF_CHAN_REL_ACK:
Harald Welte64bb7542011-01-14 14:16:16 +01001078 rc = rsl_rx_rf_chan_rel_ack(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001079 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001080 case RSL_MT_MODE_MODIFY_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001081 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001082 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001083 case RSL_MT_MODE_MODIFY_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001084 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welteda783762009-02-18 03:29:53 +00001085 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001086 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001087 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001088 msg->lchan->ts->flags |= TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001089 break;
1090 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001091 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001092 break;
1093 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001094 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welte4563eab2010-03-28 14:42:09 +08001095 msg->lchan->ts->flags &= ~TS_F_PDCH_MODE;
Harald Welte9c880c92009-10-24 10:29:22 +02001096 break;
1097 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001098 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welte9c880c92009-10-24 10:29:22 +02001099 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001100 case RSL_MT_PHY_CONTEXT_CONF:
1101 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001102 case RSL_MT_TALKER_DET:
1103 case RSL_MT_LISTENER_DET:
1104 case RSL_MT_REMOTE_CODEC_CONF_REP:
1105 case RSL_MT_MR_CODEC_MOD_ACK:
1106 case RSL_MT_MR_CODEC_MOD_NACK:
1107 case RSL_MT_MR_CODEC_MOD_PER:
Harald Welte5b8ed432009-12-24 12:20:20 +01001108 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1109 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001110 break;
1111 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001112 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1113 ts_name, rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001114 return -EINVAL;
1115 }
Harald Weltef325eb42009-02-19 17:07:39 +00001116
Harald Welte8470bf22008-12-25 23:28:35 +00001117 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001118}
1119
Harald Welte702d8702008-12-26 20:25:35 +00001120static int rsl_rx_error_rep(struct msgb *msg)
1121{
1122 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001123 struct tlv_parsed tp;
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001124 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte702d8702008-12-26 20:25:35 +00001125
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001126 LOGP(DRSL, LOGL_ERROR, "%s ERROR REPORT ", gsm_trx_name(sign_link->trx));
Harald Welte8830e072009-07-28 17:58:09 +02001127
1128 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1129
1130 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001131 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001132 TLVP_LEN(&tp, RSL_IE_CAUSE));
1133
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001134 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001135
1136 return 0;
1137}
1138
Harald Welte52b1f982008-12-23 20:25:15 +00001139static int abis_rsl_rx_trx(struct msgb *msg)
1140{
Harald Welte702d8702008-12-26 20:25:35 +00001141 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001142 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte8470bf22008-12-25 23:28:35 +00001143 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001144
1145 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001146 case RSL_MT_ERROR_REPORT:
1147 rc = rsl_rx_error_rep(msg);
1148 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001149 case RSL_MT_RF_RES_IND:
1150 /* interference on idle channels of TRX */
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001151 //DEBUGP(DRSL, "%s RF Resource Indication\n", gsm_trx_name(sign_link->trx));
Harald Welte8f5e2392009-02-03 12:57:37 +00001152 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001153 case RSL_MT_OVERLOAD:
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001154 /* indicate CCCH / ACCH / processor overload */
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001155 LOGP(DRSL, LOGL_ERROR, "%s CCCH/ACCH/CPU Overload\n",
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001156 gsm_trx_name(sign_link->trx));
Harald Welte52b1f982008-12-23 20:25:15 +00001157 break;
Dieter Spaar16646022011-07-28 00:01:50 +02001158 case 0x42: /* Nokia specific: SI End ACK */
1159 LOGP(DRSL, LOGL_INFO, "Nokia SI End ACK\n");
1160 break;
1161 case 0x43: /* Nokia specific: SI End NACK */
1162 LOGP(DRSL, LOGL_INFO, "Nokia SI End NACK\n");
1163 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001164 default:
Harald Welte (local)d48f4eb2009-12-28 23:14:22 +01001165 LOGP(DRSL, LOGL_NOTICE, "%s Unknown Abis RSL TRX message "
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001166 "type 0x%02x\n", gsm_trx_name(sign_link->trx), rslh->msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001167 return -EINVAL;
1168 }
Harald Welte8470bf22008-12-25 23:28:35 +00001169 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001170}
1171
Harald Welteb7e81162009-08-10 00:26:10 +02001172/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1173static void t3101_expired(void *data)
1174{
1175 struct gsm_lchan *lchan = data;
1176
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001177 rsl_rf_chan_release(lchan, 1);
Harald Welteb7e81162009-08-10 00:26:10 +02001178}
1179
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001180/* If T3111 expires, we will send the RF Channel Request */
1181static void t3111_expired(void *data)
1182{
1183 struct gsm_lchan *lchan = data;
1184
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001185 rsl_rf_chan_release(lchan, 0);
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001186}
1187
laforgecfa4a012010-06-21 12:08:52 +02001188#define GSM48_LEN2PLEN(a) (((a) << 2) | 1)
1189
Harald Welte2862dca2010-12-23 14:39:29 +01001190/* Format an IMM ASS REJ according to 04.08 Chapter 9.1.20 */
1191static int rsl_send_imm_ass_rej(struct gsm_bts *bts,
1192 unsigned int num_req_refs,
1193 struct gsm48_req_ref *rqd_refs,
1194 uint8_t wait_ind)
1195{
1196 uint8_t buf[GSM_MACBLOCK_LEN];
1197 struct gsm48_imm_ass_rej *iar = (struct gsm48_imm_ass_rej *)buf;
1198
1199 /* create IMMEDIATE ASSIGN REJECT 04.08 message */
1200 memset(iar, 0, sizeof(*iar));
1201 iar->proto_discr = GSM48_PDISC_RR;
1202 iar->msg_type = GSM48_MT_RR_IMM_ASS;
1203 iar->page_mode = GSM48_PM_SAME;
1204
1205 memcpy(&iar->req_ref1, &rqd_refs[0], sizeof(iar->req_ref1));
1206 iar->wait_ind1 = wait_ind;
1207
1208 if (num_req_refs >= 2)
1209 memcpy(&iar->req_ref2, &rqd_refs[1], sizeof(iar->req_ref2));
1210 else
1211 memcpy(&iar->req_ref2, &rqd_refs[0], sizeof(iar->req_ref2));
1212 iar->wait_ind2 = wait_ind;
1213
1214 if (num_req_refs >= 3)
1215 memcpy(&iar->req_ref3, &rqd_refs[2], sizeof(iar->req_ref3));
1216 else
1217 memcpy(&iar->req_ref3, &rqd_refs[0], sizeof(iar->req_ref3));
1218 iar->wait_ind3 = wait_ind;
1219
1220 if (num_req_refs >= 4)
1221 memcpy(&iar->req_ref4, &rqd_refs[3], sizeof(iar->req_ref4));
1222 else
1223 memcpy(&iar->req_ref4, &rqd_refs[0], sizeof(iar->req_ref4));
1224 iar->wait_ind4 = wait_ind;
1225
1226 return rsl_imm_assign_cmd(bts, sizeof(iar), (uint8_t *) iar);
1227}
1228
Harald Welte8470bf22008-12-25 23:28:35 +00001229/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001230static int rsl_rx_chan_rqd(struct msgb *msg)
1231{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001232 struct e1inp_sign_link *sign_link = msg->dst;
1233 struct gsm_bts *bts = sign_link->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001234 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1235 struct gsm48_req_ref *rqd_ref;
Harald Welte8470bf22008-12-25 23:28:35 +00001236 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001237 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001238 struct gsm_lchan *lchan;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001239 uint8_t rqd_ta;
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001240 int is_lu;
Harald Welte8470bf22008-12-25 23:28:35 +00001241
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001242 uint16_t arfcn;
1243 uint8_t ts_number, subch;
Harald Welte52b1f982008-12-23 20:25:15 +00001244
Harald Welte8470bf22008-12-25 23:28:35 +00001245 /* parse request reference to be used in immediate assign */
1246 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1247 return -EINVAL;
1248
1249 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1250
1251 /* parse access delay and use as TA */
1252 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1253 return -EINVAL;
1254 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1255
1256 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1257 * request reference RA */
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +08001258 lctype = get_ctype_by_chreq(bts->network, rqd_ref->ra);
1259 chreq_reason = get_reason_by_chreq(rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001260
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001261 osmo_counter_inc(bts->network->stats.chreq.total);
Harald Welte24ff6ee2009-12-22 00:41:05 +01001262
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001263 /*
1264 * We want LOCATION UPDATES to succeed and will assign a TCH
1265 * if we have no SDCCH available.
1266 */
1267 is_lu = !!(chreq_reason == GSM_CHREQ_REASON_LOCATION_UPD);
1268
Harald Welte8470bf22008-12-25 23:28:35 +00001269 /* check availability / allocate channel */
Holger Hans Peter Freyther457c2a82010-09-06 08:58:42 +08001270 lchan = lchan_alloc(bts, lctype, is_lu);
Harald Welte8470bf22008-12-25 23:28:35 +00001271 if (!lchan) {
Harald Welte (local)2f5df852009-12-27 13:48:09 +01001272 LOGP(DRSL, LOGL_NOTICE, "BTS %d CHAN RQD: no resources for %s 0x%x\n",
Harald Welte (local)ccd88452009-12-27 18:05:25 +01001273 msg->lchan->ts->trx->bts->nr, gsm_lchant_name(lctype), rqd_ref->ra);
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001274 osmo_counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte2862dca2010-12-23 14:39:29 +01001275 /* FIXME gather multiple CHAN RQD and reject up to 4 at the same time */
1276 if (bts->network->T3122)
1277 rsl_send_imm_ass_rej(bts, 1, rqd_ref, bts->network->T3122 & 0xff);
Harald Welte8470bf22008-12-25 23:28:35 +00001278 return -ENOMEM;
1279 }
1280
Harald Welte8e93b792009-12-29 10:44:17 +01001281 if (lchan->state != LCHAN_S_NONE)
1282 LOGP(DRSL, LOGL_NOTICE, "%s lchan_alloc() returned channel "
Harald Welte1887f9d2009-12-29 10:52:38 +01001283 "in state %s\n", gsm_lchan_name(lchan),
1284 gsm_lchans_name(lchan->state));
Holger Hans Peter Freyther74419492010-04-10 00:12:31 +02001285 rsl_lchan_set_state(lchan, LCHAN_S_ACT_REQ);
Harald Welte (local)3e460312009-12-27 18:12:29 +01001286
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001287 /* save the RACH data as we need it after the CHAN ACT ACK */
1288 lchan->rqd_ref = talloc_zero(bts, struct gsm48_req_ref);
1289 if (!lchan->rqd_ref) {
1290 LOGP(DRSL, LOGL_ERROR, "Failed to allocate gsm48_req_ref.\n");
1291 lchan_free(lchan);
1292 return -ENOMEM;
1293 }
1294
1295 memcpy(lchan->rqd_ref, rqd_ref, sizeof(*rqd_ref));
1296 lchan->rqd_ta = rqd_ta;
1297
Harald Welte8470bf22008-12-25 23:28:35 +00001298 ts_number = lchan->ts->nr;
1299 arfcn = lchan->ts->trx->arfcn;
1300 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001301
Harald Welte08d91a52009-08-30 15:37:11 +09001302 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001303 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001304 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001305 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001306 lchan->tch_mode = GSM48_CMODE_SIGN;
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001307
Harald Weltee8bd9e82011-08-10 23:26:33 +02001308 /* Start another timer or assume the BTS sends a ACK/NACK? */
1309 lchan->act_timer.cb = lchan_act_tmr_cb;
1310 lchan->act_timer.data = lchan;
1311 osmo_timer_schedule(&lchan->act_timer, 4, 0);
1312
Andreas Eversberg2957de92011-12-16 17:45:37 +01001313 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1314 "r=%s ra=0x%02x ta=%d\n", gsm_lchan_name(lchan), arfcn, subch,
1315 gsm_lchant_name(lchan->type), gsm_chreq_name(chreq_reason),
1316 rqd_ref->ra, rqd_ta);
1317
1318 /* BS11 requires TA shifted by 2 bits */
1319 if (bts->type == GSM_BTS_TYPE_BS11)
1320 rqd_ta <<= 2;
Harald Welte8d77b952009-12-17 00:31:10 +01001321 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte52b1f982008-12-23 20:25:15 +00001322
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001323 return 0;
1324}
1325
1326static int rsl_send_imm_assignment(struct gsm_lchan *lchan)
1327{
1328 struct gsm_bts *bts = lchan->ts->trx->bts;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001329 uint8_t buf[GSM_MACBLOCK_LEN];
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001330 struct gsm48_imm_ass *ia = (struct gsm48_imm_ass *) buf;
1331
Harald Welte52b1f982008-12-23 20:25:15 +00001332 /* create IMMEDIATE ASSIGN 04.08 messge */
laforge09108bf2010-06-20 15:18:46 +02001333 memset(ia, 0, sizeof(*ia));
laforgecfa4a012010-06-21 12:08:52 +02001334 /* we set ia->l2_plen once we know the length of the MA below */
laforge09108bf2010-06-20 15:18:46 +02001335 ia->proto_discr = GSM48_PDISC_RR;
1336 ia->msg_type = GSM48_MT_RR_IMM_ASS;
1337 ia->page_mode = GSM48_PM_SAME;
1338 gsm48_lchan2chan_desc(&ia->chan_desc, lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +02001339
Harald Welte8470bf22008-12-25 23:28:35 +00001340 /* use request reference extracted from CHAN_RQD */
Holger Hans Peter Freyther5ba05f42010-06-22 12:11:59 +08001341 memcpy(&ia->req_ref, lchan->rqd_ref, sizeof(ia->req_ref));
1342 ia->timing_advance = lchan->rqd_ta;
Harald Weltea39b0f22010-06-14 22:26:10 +02001343 if (!lchan->ts->hopping.enabled) {
laforge09108bf2010-06-20 15:18:46 +02001344 ia->mob_alloc_len = 0;
Harald Weltea39b0f22010-06-14 22:26:10 +02001345 } else {
laforge09108bf2010-06-20 15:18:46 +02001346 ia->mob_alloc_len = lchan->ts->hopping.ma_len;
1347 memcpy(ia->mob_alloc, lchan->ts->hopping.ma_data, ia->mob_alloc_len);
Harald Weltea39b0f22010-06-14 22:26:10 +02001348 }
Harald Weltea1d39a22010-06-28 18:41:27 +02001349 /* we need to subtract 1 byte from sizeof(*ia) since ia includes the l2_plen field */
1350 ia->l2_plen = GSM48_LEN2PLEN((sizeof(*ia)-1) + ia->mob_alloc_len);
Harald Welte52b1f982008-12-23 20:25:15 +00001351
Harald Welteb7e81162009-08-10 00:26:10 +02001352 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1353 lchan->T3101.cb = t3101_expired;
1354 lchan->T3101.data = lchan;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001355 osmo_timer_schedule(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001356
Harald Welte52b1f982008-12-23 20:25:15 +00001357 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001358 return rsl_imm_assign_cmd(bts, sizeof(*ia)+ia->mob_alloc_len, (uint8_t *) ia);
Harald Welte52b1f982008-12-23 20:25:15 +00001359}
1360
Harald Welteea280442009-02-02 22:29:56 +00001361/* MS has requested a channel on the RACH */
1362static int rsl_rx_ccch_load(struct msgb *msg)
1363{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001364 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001365 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001366 uint16_t pg_buf_space;
1367 uint16_t rach_slot_count = -1;
1368 uint16_t rach_busy_count = -1;
1369 uint16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001370
1371 switch (rslh->data[0]) {
1372 case RSL_IE_PAGING_LOAD:
1373 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001374 if (is_ipaccess_bts(sign_link->trx->bts) && pg_buf_space == 0xffff) {
Harald Welte38e9c822010-04-19 10:24:07 +02001375 /* paging load below configured threshold, use 50 as default */
1376 pg_buf_space = 50;
1377 }
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001378 paging_update_buffer_space(sign_link->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001379 break;
1380 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001381 if (msg->data_len >= 7) {
1382 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1383 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1384 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1385 }
Harald Welteea280442009-02-02 22:29:56 +00001386 break;
1387 default:
1388 break;
1389 }
1390
1391 return 0;
1392}
1393
Harald Welte52b1f982008-12-23 20:25:15 +00001394static int abis_rsl_rx_cchan(struct msgb *msg)
1395{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001396 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welteea280442009-02-02 22:29:56 +00001397 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001398 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001399
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001400 msg->lchan = lchan_lookup(sign_link->trx, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +00001401
1402 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001403 case RSL_MT_CHAN_RQD:
1404 /* MS has requested a channel on the RACH */
1405 rc = rsl_rx_chan_rqd(msg);
1406 break;
Harald Welteea280442009-02-02 22:29:56 +00001407 case RSL_MT_CCCH_LOAD_IND:
1408 /* current load on the CCCH */
1409 rc = rsl_rx_ccch_load(msg);
1410 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001411 case RSL_MT_DELETE_IND:
1412 /* CCCH overloaded, IMM_ASSIGN was dropped */
1413 case RSL_MT_CBCH_LOAD_IND:
1414 /* current load on the CBCH */
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001415 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1416 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001417 break;
1418 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001419 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1420 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001421 return -EINVAL;
1422 }
Harald Welte8470bf22008-12-25 23:28:35 +00001423
1424 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001425}
1426
Harald Welte4b634542008-12-27 01:55:51 +00001427static int rsl_rx_rll_err_ind(struct msgb *msg)
1428{
1429 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001430 uint8_t *rlm_cause = rllh->data;
Harald Welte4b634542008-12-27 01:55:51 +00001431
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001432 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=%s\n",
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001433 gsm_lchan_name(msg->lchan),
Harald Weltee95daf12010-03-25 12:13:02 +08001434 rsl_rlm_cause_name(rlm_cause[1]));
Harald Welteedcc5272009-08-09 13:47:35 +02001435
1436 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte (local)9538efc2009-12-26 23:55:00 +01001437
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001438 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED) {
Pablo Neira Ayusodfb342c2011-05-06 12:13:10 +02001439 osmo_counter_inc(msg->lchan->ts->trx->bts->network->stats.chan.rll_err);
Holger Hans Peter Freyther4b4dd102010-05-31 21:38:24 +08001440 return rsl_rf_chan_release(msg->lchan, 1);
Holger Hans Peter Freyther3ba36d52010-04-17 06:48:29 +02001441 }
Harald Welte81543bc2009-07-04 09:40:05 +02001442
Harald Welte4b634542008-12-27 01:55:51 +00001443 return 0;
1444}
Harald Weltef325eb42009-02-19 17:07:39 +00001445
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001446static void rsl_handle_release(struct gsm_lchan *lchan)
1447{
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001448 int sapi;
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001449 struct gsm_bts *bts;
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001450
1451 /* maybe we have only brought down one RLL */
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001452 if (lchan->state != LCHAN_S_REL_REQ)
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001453 return;
1454
1455 for (sapi = 0; sapi < ARRAY_SIZE(lchan->sapis); ++sapi) {
1456 if (lchan->sapis[sapi] == LCHAN_SAPI_UNUSED)
1457 continue;
Harald Welte3a3c2772010-12-24 12:51:07 +01001458 LOGP(DRSL, LOGL_DEBUG, "%s waiting for SAPI=%d to be released.\n",
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001459 gsm_lchan_name(lchan), sapi);
1460 return;
1461 }
1462
Holger Hans Peter Freytherd7fd3062010-04-08 22:47:44 +02001463
1464
Holger Hans Peter Freytherf30c0dc2010-05-31 21:33:15 +08001465 /* wait a bit to send the RF Channel Release */
1466 lchan->T3111.cb = t3111_expired;
1467 lchan->T3111.data = lchan;
1468 bts = lchan->ts->trx->bts;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001469 osmo_timer_schedule(&lchan->T3111, bts->network->T3111, 0);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001470}
1471
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001472/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
Harald Welte52b1f982008-12-23 20:25:15 +00001473 0x02, 0x06,
1474 0x01, 0x20,
1475 0x02, 0x00,
1476 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1477
1478static int abis_rsl_rx_rll(struct msgb *msg)
1479{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001480 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte52b1f982008-12-23 20:25:15 +00001481 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001482 int rc = 0;
1483 char *ts_name;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001484 uint8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001485
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001486 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001487 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte5b8ed432009-12-24 12:20:20 +01001488 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001489
1490 switch (rllh->c.msg_type) {
1491 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001492 DEBUGPC(DRLL, "DATA INDICATION\n");
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001493 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001494 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1495 rllh->data[0] == RSL_IE_L3_INFO) {
1496 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001497 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001498 }
Harald Welte52b1f982008-12-23 20:25:15 +00001499 break;
1500 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001501 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001502 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001503 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Pablo Neira Ayusobf540cb2011-05-06 12:11:06 +02001504 osmo_timer_del(&msg->lchan->T3101);
Holger Hans Peter Freytheracf8a0c2010-03-29 08:47:44 +02001505 if (msgb_l2len(msg) >
Harald Welte4a543e82009-02-28 13:17:55 +00001506 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1507 rllh->data[0] == RSL_IE_L3_INFO) {
1508 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001509 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001510 }
Harald Welte52b1f982008-12-23 20:25:15 +00001511 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001512 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001513 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001514 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001515 rll_indication(msg->lchan, rllh->link_id,
1516 BSC_RLLR_IND_EST_CONF);
1517 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001518 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001519 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001520 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001521 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001522 rll_indication(msg->lchan, rllh->link_id,
1523 BSC_RLLR_IND_REL_IND);
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001524 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001525 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte2d5b6382008-12-27 19:46:06 +00001526 break;
1527 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001528 /* BTS informs us of having received UA from MS,
1529 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001530 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001531 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Holger Hans Peter Freytherdbc5fae2010-04-08 22:39:34 +02001532 rsl_handle_release(msg->lchan);
Holger Hans Peter Freyther4b85a322010-07-29 17:09:36 +08001533 rsl_lchan_rll_release(msg->lchan, rllh->link_id);
Harald Welte4b634542008-12-27 01:55:51 +00001534 break;
1535 case RSL_MT_ERROR_IND:
1536 rc = rsl_rx_rll_err_ind(msg);
1537 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001538 case RSL_MT_UNIT_DATA_IND:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001539 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1540 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001541 break;
1542 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001543 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1544 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001545 }
Harald Welte8470bf22008-12-25 23:28:35 +00001546 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001547}
1548
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001549static uint8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001550{
Harald Welte0603c9d2009-12-02 01:58:23 +05301551 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001552 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301553 switch (lchan->type) {
1554 case GSM_LCHAN_TCH_F:
1555 return 0x00;
1556 case GSM_LCHAN_TCH_H:
1557 return 0x03;
1558 default:
1559 break;
1560 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001561 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301562 switch (lchan->type) {
1563 case GSM_LCHAN_TCH_F:
1564 return 0x01;
1565 /* there's no half-rate EFR */
1566 default:
1567 break;
1568 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001569 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301570 switch (lchan->type) {
1571 case GSM_LCHAN_TCH_F:
1572 return 0x02;
1573 case GSM_LCHAN_TCH_H:
1574 return 0x05;
1575 default:
1576 break;
1577 }
1578 default:
1579 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001580 }
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001581 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301582 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001583 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001584}
1585
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001586static uint8_t ipa_rtp_pt_for_lchan(struct gsm_lchan *lchan)
Sylvain Munautb54dda42009-12-20 22:06:40 +01001587{
Holger Hans Peter Freyther8cc59032010-11-14 21:09:08 +01001588 struct gsm_network *net = lchan->ts->trx->bts->network;
1589
Sylvain Munautb54dda42009-12-20 22:06:40 +01001590 switch (lchan->tch_mode) {
1591 case GSM48_CMODE_SPEECH_V1:
1592 switch (lchan->type) {
1593 case GSM_LCHAN_TCH_F:
1594 return RTP_PT_GSM_FULL;
1595 case GSM_LCHAN_TCH_H:
1596 return RTP_PT_GSM_HALF;
1597 default:
1598 break;
1599 }
1600 case GSM48_CMODE_SPEECH_EFR:
1601 switch (lchan->type) {
1602 case GSM_LCHAN_TCH_F:
1603 return RTP_PT_GSM_EFR;
1604 /* there's no half-rate EFR */
1605 default:
1606 break;
1607 }
1608 case GSM48_CMODE_SPEECH_AMR:
1609 switch (lchan->type) {
1610 case GSM_LCHAN_TCH_F:
Sylvain Munautb54dda42009-12-20 22:06:40 +01001611 case GSM_LCHAN_TCH_H:
Holger Hans Peter Freythered999b22011-07-21 10:24:46 +02001612 return RTP_PT_AMR;
Sylvain Munautb54dda42009-12-20 22:06:40 +01001613 default:
1614 break;
1615 }
1616 default:
1617 break;
1618 }
1619 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access rtp payload type for "
1620 "tch_mode == 0x%02x\n & lchan_type == %d",
1621 lchan->tch_mode, lchan->type);
1622 return 0;
1623}
1624
Harald Welte75099262009-02-16 21:12:08 +00001625/* ip.access specific RSL extensions */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001626static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1627{
1628 struct in_addr ip;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001629 uint16_t port, conn_id;
Harald Welte5e3d91b2009-12-19 16:42:06 +01001630
1631 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001632 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001633 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1634 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1635 }
1636
1637 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001638 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001639 port = ntohs(port);
1640 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1641 lchan->abis_ip.bound_port = port;
1642 }
1643
1644 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001645 conn_id = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001646 conn_id = ntohs(conn_id);
1647 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1648 lchan->abis_ip.conn_id = conn_id;
1649 }
1650
1651 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1652 lchan->abis_ip.rtp_payload2 =
1653 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1654 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1655 lchan->abis_ip.rtp_payload2);
1656 }
1657
1658 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1659 lchan->abis_ip.speech_mode =
1660 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1661 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1662 lchan->abis_ip.speech_mode);
1663 }
1664
1665 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001666 ip.s_addr = *((uint32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001667 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1668 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1669 }
1670
1671 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001672 port = *((uint16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001673 port = ntohs(port);
1674 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1675 lchan->abis_ip.connect_port = port;
1676 }
1677}
1678
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001679int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001680{
1681 struct msgb *msg = rsl_msgb_alloc();
1682 struct abis_rsl_dchan_hdr *dh;
1683
1684 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001685 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001686 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001687 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001688
Harald Weltef4e79f22009-07-28 18:11:56 +02001689 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001690 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001691 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001692 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001693 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001694
Sylvain Munautb54dda42009-12-20 22:06:40 +01001695 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x RTP_PAYLOAD=%d\n",
1696 gsm_lchan_name(lchan), lchan->abis_ip.speech_mode,
1697 lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001698
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001699 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001700
1701 return abis_rsl_sendmsg(msg);
1702}
1703
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001704int rsl_ipacc_mdcx(struct gsm_lchan *lchan, uint32_t ip, uint16_t port,
1705 uint8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001706{
1707 struct msgb *msg = rsl_msgb_alloc();
1708 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001709 uint32_t *att_ip;
Harald Weltef4e79f22009-07-28 18:11:56 +02001710 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001711
1712 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001713 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001714 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
Harald Weltef6093a42011-06-25 10:02:33 +02001715 dh->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Welte75099262009-02-16 21:12:08 +00001716
Harald Welte5e3d91b2009-12-19 16:42:06 +01001717 /* we need to store these now as MDCX_ACK does not return them :( */
1718 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1719 lchan->abis_ip.connect_port = port;
1720 lchan->abis_ip.connect_ip = ip;
1721
Harald Welte58ca5b72009-07-29 12:12:18 +02001722 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte5e3d91b2009-12-19 16:42:06 +01001723 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001724 lchan->abis_ip.rtp_payload = ipa_rtp_pt_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001725
Harald Weltef4e79f22009-07-28 18:11:56 +02001726 ia.s_addr = htonl(ip);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001727 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD=%d RTP_PAYLOAD2=%d "
1728 "CONN_ID=%d speech_mode=0x%02x\n", gsm_lchan_name(lchan),
1729 inet_ntoa(ia), port, lchan->abis_ip.rtp_payload, rtp_payload2,
1730 lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001731
Harald Welte5e3d91b2009-12-19 16:42:06 +01001732 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1733 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001734 att_ip = (uint32_t *) msgb_put(msg, sizeof(ip));
Harald Welte5e3d91b2009-12-19 16:42:06 +01001735 *att_ip = ia.s_addr;
1736 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1737 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Sylvain Munautb54dda42009-12-20 22:06:40 +01001738 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD, lchan->abis_ip.rtp_payload);
Harald Weltef4e79f22009-07-28 18:11:56 +02001739 if (rtp_payload2)
1740 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001741
1742 msg->dst = lchan->ts->trx->rsl_link;
Harald Welte75099262009-02-16 21:12:08 +00001743
1744 return abis_rsl_sendmsg(msg);
1745}
1746
Harald Weltea72273e2009-12-20 16:51:09 +01001747/* tell BTS to connect RTP stream to our local RTP socket */
1748int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1749{
1750 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1751 int rc;
1752
1753 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1754 ntohs(rs->rtp.sin_local.sin_port),
1755 /* FIXME: use RTP payload of bound socket, not BTS*/
1756 lchan->abis_ip.rtp_payload2);
1757
1758 return rc;
1759}
1760
Harald Welte53cd7ac2010-12-23 12:59:52 +01001761int rsl_ipacc_pdch_activate(struct gsm_bts_trx_ts *ts, int act)
Harald Welte9c880c92009-10-24 10:29:22 +02001762{
1763 struct msgb *msg = rsl_msgb_alloc();
1764 struct abis_rsl_dchan_hdr *dh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +02001765 uint8_t msg_type;
Harald Welte4563eab2010-03-28 14:42:09 +08001766
1767 if (act)
1768 msg_type = RSL_MT_IPAC_PDCH_ACT;
1769 else
1770 msg_type = RSL_MT_IPAC_PDCH_DEACT;
Harald Welte9c880c92009-10-24 10:29:22 +02001771
1772 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Harald Welte4563eab2010-03-28 14:42:09 +08001773 init_dchan_hdr(dh, msg_type);
Harald Welte9c880c92009-10-24 10:29:22 +02001774 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Weltef6093a42011-06-25 10:02:33 +02001775 dh->chan_nr = gsm_ts2chan_nr(ts, 0);
Harald Welte9c880c92009-10-24 10:29:22 +02001776
Harald Welte53cd7ac2010-12-23 12:59:52 +01001777 DEBUGP(DRSL, "%s IPAC_PDCH_%sACT\n", gsm_ts_name(ts),
Harald Welte4563eab2010-03-28 14:42:09 +08001778 act ? "" : "DE");
Harald Welte9c880c92009-10-24 10:29:22 +02001779
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001780 msg->dst = ts->trx->rsl_link;
Harald Welte9c880c92009-10-24 10:29:22 +02001781
1782 return abis_rsl_sendmsg(msg);
1783}
1784
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001785static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001786{
1787 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1788 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301789 struct gsm_lchan *lchan = msg->lchan;
Harald Welte75099262009-02-16 21:12:08 +00001790
1791 /* the BTS has acknowledged a local bind, it now tells us the IP
1792 * address and port number to which it has bound the given logical
1793 * channel */
1794
1795 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1796 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1797 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001798 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001799 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001800 return -EINVAL;
1801 }
Harald Welte17f5bf62009-12-20 15:42:44 +01001802
Harald Welte5e3d91b2009-12-19 16:42:06 +01001803 ipac_parse_rtp(lchan, &tv);
Harald Welte17f5bf62009-12-20 15:42:44 +01001804
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001805 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001806
Harald Welte75099262009-02-16 21:12:08 +00001807 return 0;
1808}
1809
Harald Welte5e3d91b2009-12-19 16:42:06 +01001810static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1811{
1812 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1813 struct tlv_parsed tv;
1814 struct gsm_lchan *lchan = msg->lchan;
1815
1816 /* the BTS has acknowledged a remote connect request and
1817 * it now tells us the IP address and port number to which it has
1818 * connected the given logical channel */
1819
1820 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1821 ipac_parse_rtp(lchan, &tv);
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001822 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001823
1824 return 0;
1825}
1826
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001827static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001828{
1829 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1830 struct tlv_parsed tv;
1831
1832 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001833
Harald Welte8830e072009-07-28 17:58:09 +02001834 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Welte5b8ed432009-12-24 12:20:20 +01001835 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Welte8830e072009-07-28 17:58:09 +02001836 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001837
Pablo Neira Ayusobbc5b992011-05-06 12:12:31 +02001838 osmo_signal_dispatch(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001839
Harald Welte75099262009-02-16 21:12:08 +00001840 return 0;
1841}
1842
1843static int abis_rsl_rx_ipacc(struct msgb *msg)
1844{
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001845 struct e1inp_sign_link *sign_link = msg->dst;
Harald Welte75099262009-02-16 21:12:08 +00001846 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Welte5b8ed432009-12-24 12:20:20 +01001847 char *ts_name;
Harald Welte75099262009-02-16 21:12:08 +00001848 int rc = 0;
1849
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001850 msg->lchan = lchan_lookup(sign_link->trx, rllh->chan_nr);
Harald Welte (local)19ef62a2009-12-27 18:16:36 +01001851 ts_name = gsm_lchan_name(msg->lchan);
Harald Welte75099262009-02-16 21:12:08 +00001852
1853 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001854 case RSL_MT_IPAC_CRCX_ACK:
Harald Welte5b8ed432009-12-24 12:20:20 +01001855 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001856 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001857 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001858 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001859 /* somehow the BTS was unable to bind the lchan to its local
1860 * port?!? */
Harald Welte5b8ed432009-12-24 12:20:20 +01001861 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001862 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001863 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001864 /* the BTS tells us that a connect operation was successful */
Harald Welte5b8ed432009-12-24 12:20:20 +01001865 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Welte5e3d91b2009-12-19 16:42:06 +01001866 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001867 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001868 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001869 /* somehow the BTS was unable to connect the lchan to a remote
1870 * port */
Harald Welte5b8ed432009-12-24 12:20:20 +01001871 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte75099262009-02-16 21:12:08 +00001872 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001873 case RSL_MT_IPAC_DLCX_IND:
Harald Welte5b8ed432009-12-24 12:20:20 +01001874 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001875 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001876 break;
1877 default:
Harald Welte5b8ed432009-12-24 12:20:20 +01001878 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001879 rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001880 break;
1881 }
Harald Welte6dab0552009-05-01 17:21:37 +00001882 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001883
1884 return rc;
1885}
1886
1887
Harald Welte52b1f982008-12-23 20:25:15 +00001888/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001889int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001890{
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001891 struct abis_rsl_common_hdr *rslh;
Harald Welte8f5e2392009-02-03 12:57:37 +00001892 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001893
Holger Hans Peter Freyther19bab732009-11-20 15:14:01 +01001894 if (!msg) {
1895 DEBUGP(DRSL, "Empty RSL msg?..\n");
1896 return -1;
1897 }
1898
1899 if (msgb_l2len(msg) < sizeof(*rslh)) {
1900 DEBUGP(DRSL, "Truncated RSL message with l2len: %u\n", msgb_l2len(msg));
1901 return -1;
1902 }
1903
1904 rslh = msgb_l2(msg);
1905
Harald Welte52b1f982008-12-23 20:25:15 +00001906 switch (rslh->msg_discr & 0xfe) {
1907 case ABIS_RSL_MDISC_RLL:
1908 rc = abis_rsl_rx_rll(msg);
1909 break;
1910 case ABIS_RSL_MDISC_DED_CHAN:
1911 rc = abis_rsl_rx_dchan(msg);
1912 break;
1913 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001914 rc = abis_rsl_rx_cchan(msg);
1915 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001916 case ABIS_RSL_MDISC_TRX:
1917 rc = abis_rsl_rx_trx(msg);
1918 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001919 case ABIS_RSL_MDISC_LOC:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001920 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte8f5e2392009-02-03 12:57:37 +00001921 rslh->msg_discr);
1922 break;
Harald Welte75099262009-02-16 21:12:08 +00001923 case ABIS_RSL_MDISC_IPACCESS:
1924 rc = abis_rsl_rx_ipacc(msg);
1925 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001926 default:
Harald Welteb1d4c8e2009-12-17 23:10:46 +01001927 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1928 "0x%02x\n", rslh->msg_discr);
Harald Welte52b1f982008-12-23 20:25:15 +00001929 return -EINVAL;
1930 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001931 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001932 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001933}
Holger Freyther3b72a892009-02-04 00:31:39 +00001934
Holger Hans Peter Freyther8cb4a0f2010-07-21 15:54:32 +08001935int rsl_sms_cb_command(struct gsm_bts *bts, uint8_t chan_number,
1936 uint8_t cb_command, const uint8_t *data, int len)
1937{
1938 struct abis_rsl_dchan_hdr *dh;
1939 struct msgb *cb_cmd;
1940
1941 cb_cmd = rsl_msgb_alloc();
1942 if (!cb_cmd)
1943 return -1;
1944
1945 dh = (struct abis_rsl_dchan_hdr *) msgb_put(cb_cmd, sizeof*dh);
1946 init_dchan_hdr(dh, RSL_MT_SMS_BC_CMD);
1947 dh->chan_nr = RSL_CHAN_SDCCH4_ACCH; /* TODO: check the chan config */
1948
1949 msgb_tv_put(cb_cmd, RSL_IE_CB_CMD_TYPE, cb_command);
1950 msgb_tlv_put(cb_cmd, RSL_IE_SMSCB_MSG, len, data);
1951
1952 cb_cmd->trx = bts->c0;
1953
1954 return abis_rsl_sendmsg(cb_cmd);
1955}
Dieter Spaar16646022011-07-28 00:01:50 +02001956
1957int rsl_nokia_si_begin(struct gsm_bts_trx *trx)
1958{
1959 struct abis_rsl_common_hdr *ch;
1960 struct msgb *msg = rsl_msgb_alloc();
1961
1962 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1963 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1964 ch->msg_type = 0x40; /* Nokia SI Begin */
1965
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001966 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02001967
1968 return abis_rsl_sendmsg(msg);
1969}
1970
1971int rsl_nokia_si_end(struct gsm_bts_trx *trx)
1972{
1973 struct abis_rsl_common_hdr *ch;
1974 struct msgb *msg = rsl_msgb_alloc();
1975
1976 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1977 ch->msg_discr = ABIS_RSL_MDISC_TRX;
1978 ch->msg_type = 0x41; /* Nokia SI End */
1979
1980 msgb_tv_put(msg, 0xFD, 0x00); /* Nokia Pagemode Info, No paging reorganisation required */
1981
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001982 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02001983
1984 return abis_rsl_sendmsg(msg);
1985}
1986
1987int rsl_bs_power_control(struct gsm_bts_trx *trx, uint8_t channel, uint8_t reduction)
1988{
1989 struct abis_rsl_common_hdr *ch;
1990 struct msgb *msg = rsl_msgb_alloc();
1991
1992 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
1993 ch->msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1994 ch->msg_type = RSL_MT_BS_POWER_CONTROL;
1995
1996 msgb_tv_put(msg, RSL_IE_CHAN_NR, channel);
1997 msgb_tv_put(msg, RSL_IE_BS_POWER, reduction); /* reduction in 2dB steps */
1998
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +02001999 msg->dst = trx->rsl_link;
Dieter Spaar16646022011-07-28 00:01:50 +02002000
2001 return abis_rsl_sendmsg(msg);
2002}