blob: b56a47c173af820fc5cf47322d0d2f8ffb32a2e2 [file] [log] [blame]
Harald Welte52b1f982008-12-23 20:25:15 +00001/* GSM Radio Signalling Link messages on the A-bis interface
2 * 3GPP TS 08.58 version 8.6.0 Release 1999 / ETSI TS 100 596 V8.6.0 */
3
Harald Welte8f5e2392009-02-03 12:57:37 +00004/* (C) 2008-2009 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
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (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
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
21 *
22 */
23
24#include <stdio.h>
Harald Welte8470bf22008-12-25 23:28:35 +000025#include <stdlib.h>
Harald Welte52b1f982008-12-23 20:25:15 +000026#include <errno.h>
27#include <sys/types.h>
Harald Welte75099262009-02-16 21:12:08 +000028#include <netinet/in.h>
Harald Welte167df882009-02-17 14:35:45 +000029#include <arpa/inet.h>
Harald Welte52b1f982008-12-23 20:25:15 +000030
Harald Welte8470bf22008-12-25 23:28:35 +000031#include <openbsc/gsm_data.h>
32#include <openbsc/gsm_04_08.h>
33#include <openbsc/abis_rsl.h>
34#include <openbsc/chan_alloc.h>
35#include <openbsc/debug.h>
36#include <openbsc/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 Welte52b1f982008-12-23 20:25:15 +000039
Harald Welte8470bf22008-12-25 23:28:35 +000040#define RSL_ALLOC_SIZE 1024
41#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000042
Holger Freyther3b72a892009-02-04 00:31:39 +000043#define MAX(a, b) (a) >= (b) ? (a) : (b)
44
Harald Welte75099262009-02-16 21:12:08 +000045static const struct tlv_definition rsl_att_tlvdef = {
46 .def = {
47 [RSL_IE_CHAN_NR] = { TLV_TYPE_TV },
48 [RSL_IE_LINK_IDENT] = { TLV_TYPE_TV },
49 [RSL_IE_ACT_TYPE] = { TLV_TYPE_TV },
50 [RSL_IE_BS_POWER] = { TLV_TYPE_TV },
51 [RSL_IE_CHAN_IDENT] = { TLV_TYPE_TLV },
52 [RSL_IE_CHAN_MODE] = { TLV_TYPE_TLV },
53 [RSL_IE_ENCR_INFO] = { TLV_TYPE_TLV },
54 [RSL_IE_FRAME_NUMBER] = { TLV_TYPE_FIXED, 2 },
55 [RSL_IE_HANDO_REF] = { TLV_TYPE_TV },
56 [RSL_IE_L1_INFO] = { TLV_TYPE_FIXED, 2 },
57 [RSL_IE_L3_INFO] = { TLV_TYPE_TL16V },
58 [RSL_IE_MS_IDENTITY] = { TLV_TYPE_TLV },
59 [RSL_IE_MS_POWER] = { TLV_TYPE_TV },
60 [RSL_IE_PAGING_GROUP] = { TLV_TYPE_TV },
61 [RSL_IE_PAGING_LOAD] = { TLV_TYPE_FIXED, 2 },
62 [RSL_IE_PYHS_CONTEXT] = { TLV_TYPE_TLV },
63 [RSL_IE_ACCESS_DELAY] = { TLV_TYPE_TV },
64 [RSL_IE_RACH_LOAD] = { TLV_TYPE_TLV },
65 [RSL_IE_REQ_REFERENCE] = { TLV_TYPE_FIXED, 3 },
66 [RSL_IE_RELEASE_MODE] = { TLV_TYPE_TV },
67 [RSL_IE_RESOURCE_INFO] = { TLV_TYPE_TLV },
68 [RSL_IE_RLM_CAUSE] = { TLV_TYPE_TLV },
69 [RSL_IE_STARTNG_TIME] = { TLV_TYPE_FIXED, 2 },
70 [RSL_IE_TIMING_ADVANCE] = { TLV_TYPE_TV },
71 [RSL_IE_UPLINK_MEAS] = { TLV_TYPE_TLV },
72 [RSL_IE_CAUSE] = { TLV_TYPE_TLV },
73 [RSL_IE_MEAS_RES_NR] = { TLV_TYPE_TV },
74 [RSL_IE_MSG_ID] = { TLV_TYPE_TV },
75 [RSL_IE_SYSINFO_TYPE] = { TLV_TYPE_TV },
76 [RSL_IE_MS_POWER_PARAM] = { TLV_TYPE_TLV },
77 [RSL_IE_BS_POWER_PARAM] = { TLV_TYPE_TLV },
78 [RSL_IE_PREPROC_PARAM] = { TLV_TYPE_TLV },
79 [RSL_IE_PREPROC_MEAS] = { TLV_TYPE_TLV },
80 [RSL_IE_IMM_ASS_INFO] = { TLV_TYPE_TLV },
81 [RSL_IE_SMSCB_INFO] = { TLV_TYPE_FIXED, 23 },
82 [RSL_IE_MS_TIMING_OFFSET] = { TLV_TYPE_TV },
83 [RSL_IE_ERR_MSG] = { TLV_TYPE_TLV },
84 [RSL_IE_FULL_BCCH_INFO] = { TLV_TYPE_TLV },
85 [RSL_IE_CHAN_NEEDED] = { TLV_TYPE_TV },
86 [RSL_IE_CB_CMD_TYPE] = { TLV_TYPE_TV },
87 [RSL_IE_SMSCB_MSG] = { TLV_TYPE_TLV },
88 [RSL_IE_FULL_IMM_ASS_INFO] = { TLV_TYPE_TLV },
89 [RSL_IE_SACCH_INFO] = { TLV_TYPE_TLV },
90 [RSL_IE_CBCH_LOAD_INFO] = { TLV_TYPE_TV },
91 [RSL_IE_SMSCB_CHAN_INDICATOR] = { TLV_TYPE_TV },
92 [RSL_IE_GROUP_CALL_REF] = { TLV_TYPE_TLV },
93 [RSL_IE_CHAN_DESC] = { TLV_TYPE_TLV },
94 [RSL_IE_NCH_DRX_INFO] = { TLV_TYPE_TLV },
95 [RSL_IE_CMD_INDICATOR] = { TLV_TYPE_TLV },
96 [RSL_IE_EMLPP_PRIO] = { TLV_TYPE_TV },
97 [RSL_IE_UIC] = { TLV_TYPE_TLV },
98 [RSL_IE_MAIN_CHAN_REF] = { TLV_TYPE_TV },
99 [RSL_IE_MR_CONFIG] = { TLV_TYPE_TLV },
100 [RSL_IE_MR_CONTROL] = { TLV_TYPE_TV },
101 [RSL_IE_SUP_CODEC_TYPES] = { TLV_TYPE_TLV },
102 [RSL_IE_CODEC_CONFIG] = { TLV_TYPE_TLV },
103 [RSL_IE_RTD] = { TLV_TYPE_TV },
104 [RSL_IE_TFO_STATUS] = { TLV_TYPE_TV },
105 [RSL_IE_LLP_APDU] = { TLV_TYPE_TLV },
106 [RSL_IE_IPAC_REMOTE_IP] = { TLV_TYPE_FIXED, 4 },
107 [RSL_IE_IPAC_REMOTE_PORT] = { TLV_TYPE_FIXED, 2 },
108 [RSL_IE_IPAC_LOCAL_IP] = { TLV_TYPE_FIXED, 4 },
109 [RSL_IE_IPAC_LOCAL_PORT] = { TLV_TYPE_FIXED, 2 },
110 [0xf4] = { TLV_TYPE_TV },
111 [0xf8] = { TLV_TYPE_FIXED, 2 },
112 [0xfc] = { TLV_TYPE_TV },
113 },
114};
115#define rsl_tlv_parse(dec, buf, len) tlv_parse(dec, &rsl_att_tlvdef, buf, len)
116
Harald Welte52b1f982008-12-23 20:25:15 +0000117static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
118{
119 /* mask off the transparent bit ? */
120 msg_type &= 0xfe;
121
Harald Welte8470bf22008-12-25 23:28:35 +0000122 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +0000123 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +0000124 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +0000125 if (msg_type >= 0x19 && msg_type <= 0x22)
126 return ABIS_RSL_MDISC_TRX;
127 else
128 return ABIS_RSL_MDISC_COM_CHAN;
129 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000130 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +0000131 return ABIS_RSL_MDISC_DED_CHAN;
132
133 return ABIS_RSL_MDISC_LOC;
134}
135
136static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
137 u_int8_t msg_type)
138{
139 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
140 dh->c.msg_type = msg_type;
141 dh->ie_chan = RSL_IE_CHAN_NR;
142}
143
144static inline void init_llm_hdr(struct abis_rsl_rll_hdr *dh,
145 u_int8_t msg_type)
146{
147 /* dh->c.msg_discr = mdisc_by_msgtype(msg_type); */
148 dh->c.msg_discr = ABIS_RSL_MDISC_RLL;
149 dh->c.msg_type = msg_type;
150 dh->ie_chan = RSL_IE_CHAN_NR;
151 dh->ie_link_id = RSL_IE_LINK_IDENT;
152}
153
154
155/* encode channel number as per Section 9.3.1 */
156u_int8_t rsl_enc_chan_nr(u_int8_t type, u_int8_t subch, u_int8_t timeslot)
157{
158 u_int8_t ret;
159
160 ret = (timeslot & 0x07) | type;
161
162 switch (type) {
163 case RSL_CHAN_Lm_ACCHs:
164 subch &= 0x01;
165 break;
166 case RSL_CHAN_SDCCH4_ACCH:
167 subch &= 0x07;
168 break;
169 case RSL_CHAN_SDCCH8_ACCH:
170 subch &= 0x07;
171 break;
172 default:
173 /* no subchannels allowed */
174 subch = 0x00;
175 break;
176 }
177 ret |= (subch << 3);
178
179 return ret;
180}
181
Harald Welte8470bf22008-12-25 23:28:35 +0000182/* determine logical channel based on TRX and channel number IE */
183struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
184{
185 struct gsm_lchan *lchan;
186 u_int8_t ts_nr = chan_nr & 0x07;
187 u_int8_t cbits = chan_nr >> 3;
188 u_int8_t lch_idx;
189 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
190
191 if (cbits == 0x01) {
192 lch_idx = 0; /* TCH/F */
193 if (ts->pchan != GSM_PCHAN_TCH_F)
194 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
195 chan_nr, ts->pchan);
196 } else if ((cbits & 0x1e) == 0x02) {
197 lch_idx = cbits & 0x1; /* TCH/H */
198 if (ts->pchan != GSM_PCHAN_TCH_H)
199 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
200 chan_nr, ts->pchan);
201 } else if ((cbits & 0x1c) == 0x04) {
202 lch_idx = cbits & 0x3; /* SDCCH/4 */
203 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
204 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
205 chan_nr, ts->pchan);
206 } else if ((cbits & 0x18) == 0x08) {
207 lch_idx = cbits & 0x7; /* SDCCH/8 */
208 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
209 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
210 chan_nr, ts->pchan);
211 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
212 lch_idx = 0;
213 if (ts->pchan != GSM_PCHAN_CCCH &&
214 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
215 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
216 chan_nr, ts->pchan);
217 /* FIXME: we should not return first sdcch4 !!! */
218 } else {
219 fprintf(stderr, "unknown chan_nr=0x%02x\n", chan_nr);
220 return NULL;
221 }
222
223 lchan = &ts->lchan[lch_idx];
224
225 return lchan;
226}
227
228u_int8_t lchan2chan_nr(struct gsm_lchan *lchan)
229{
230 struct gsm_bts_trx_ts *ts = lchan->ts;
231 u_int8_t cbits, chan_nr;
232
233 switch (ts->pchan) {
234 case GSM_PCHAN_TCH_F:
235 cbits = 0x01;
236 break;
237 case GSM_PCHAN_TCH_H:
238 cbits = 0x02;
239 cbits += lchan->nr;
240 break;
241 case GSM_PCHAN_CCCH_SDCCH4:
242 cbits = 0x04;
243 cbits += lchan->nr;
244 break;
245 case GSM_PCHAN_SDCCH8_SACCH8C:
246 cbits = 0x08;
247 cbits += lchan->nr;
248 break;
249 default:
250 case GSM_PCHAN_CCCH:
251 cbits = 0x10;
252 break;
253 }
254
255 chan_nr = (cbits << 3) | (ts->nr & 0x7);
256
257 return chan_nr;
258}
259
Harald Welte52b1f982008-12-23 20:25:15 +0000260/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
261u_int64_t str_to_imsi(const char *imsi_str)
262{
263 u_int64_t ret;
264
265 ret = strtoull(imsi_str, NULL, 10);
266
267 return ret;
268}
269
270/* Table 5 Clause 7 TS 05.02 */
271unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
272{
273 if (!bs_ccch_sdcch_comb)
274 return 9 - bs_ag_blks_res;
275 else
276 return 3 - bs_ag_blks_res;
277}
278
279/* Chapter 6.5.2 of TS 05.02 */
280unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
281 unsigned int n_pag_blocks)
282{
283 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
284}
285
286/* Chapter 6.5.2 of TS 05.02 */
287unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
288 int n_pag_blocks)
289{
290 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
291}
292
Harald Welte8470bf22008-12-25 23:28:35 +0000293static struct msgb *rsl_msgb_alloc(void)
294{
295 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM);
296}
297
Harald Welte362322e2009-02-15 14:36:38 +0000298#define MACBLOCK_SIZE 23
299static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
300{
301 memcpy(out, in, len);
302
303 if (len < MACBLOCK_SIZE)
304 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
305}
306
Harald Welte7f93cea2009-02-23 00:02:59 +0000307static void print_rsl_cause(u_int8_t *cause_tlv)
308{
309 u_int8_t cause_len;
310 int i;
311
312 if (cause_tlv[0] != RSL_IE_CAUSE)
313 return;
314
315 cause_len = cause_tlv[1];
316 DEBUGPC(DRSL, "CAUSE: ");
317 for (i = 0; i < cause_len; i++)
318 DEBUGPC(DRSL, "%02x ", cause_tlv[2+i]);
319}
320
Harald Welte52b1f982008-12-23 20:25:15 +0000321/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000322int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000323 const u_int8_t *data, int len)
324{
325 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000326 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000327
328 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
329 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
330 dh->chan_nr = RSL_CHAN_BCCH;
331
332 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
333 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
334
Harald Weltee79769b2009-02-07 00:48:17 +0000335 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000336
337 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000338}
339
Harald Weltee79769b2009-02-07 00:48:17 +0000340int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000341 const u_int8_t *data, int len)
342{
343 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000344 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000345
346 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
347 ch->msg_discr = ABIS_RSL_MDISC_TRX;
348 ch->msg_type = RSL_MT_SACCH_FILL;
349
350 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
Harald Welte702d8702008-12-26 20:25:35 +0000351 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000352
Harald Weltee79769b2009-02-07 00:48:17 +0000353 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000354
355 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000356}
357
358/* Chapter 8.4.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000359int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000360 u_int8_t act_type,
361 struct rsl_ie_chan_mode *chan_mode,
362 struct rsl_ie_chan_ident *chan_ident,
363 u_int8_t bs_power, u_int8_t ms_power,
364 u_int8_t ta)
365{
366 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000367 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000368
369 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
370 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
371 dh->chan_nr = chan_nr;
372
373 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
374 /* For compatibility with Phase 1 */
375 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
376 (u_int8_t *) chan_mode);
377 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
Harald Welte702d8702008-12-26 20:25:35 +0000378 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000379#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000380 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
381 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000382#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000383 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000384 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
385 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
386
Harald Weltee79769b2009-02-07 00:48:17 +0000387 msg->trx = trx;
388
Harald Welte8470bf22008-12-25 23:28:35 +0000389 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000390}
391
392#define TSC 7
393
Harald Welte8f5e2392009-02-03 12:57:37 +0000394int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
395 u_int8_t ta)
Harald Welte4b634542008-12-27 01:55:51 +0000396{
397 struct abis_rsl_dchan_hdr *dh;
398 struct msgb *msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000399
400 u_int8_t chan_nr = lchan2chan_nr(lchan);
401 u_int16_t arfcn = lchan->ts->trx->arfcn;
402 struct rsl_ie_chan_mode cm;
403 struct rsl_ie_chan_ident ci;
404
405 /* FIXME: what to do with data calls ? */
406 cm.dtx_dtu = 0x00;
407 switch (lchan->type) {
408 case GSM_LCHAN_SDCCH:
409 cm.spd_ind = RSL_CMOD_SPD_SIGN;
410 cm.chan_rt = RSL_CMOD_CRT_SDCCH;
411 cm.chan_rate = 0x00;
412 break;
413 case GSM_LCHAN_TCH_F:
Harald Welteda783762009-02-18 03:29:53 +0000414 /* TCH/F are always activated in signalling mode first */
415 cm.spd_ind = RSL_CMOD_SPD_SIGN;
Harald Welte4b634542008-12-27 01:55:51 +0000416 cm.chan_rt = RSL_CMOD_CRT_TCH_Bm;
Harald Welteda783762009-02-18 03:29:53 +0000417 cm.chan_rate = 0x00;
Harald Welte4b634542008-12-27 01:55:51 +0000418 break;
Holger Freytherca362a62009-01-04 21:05:01 +0000419 case GSM_LCHAN_TCH_H:
Harald Welte8f5e2392009-02-03 12:57:37 +0000420 DEBUGP(DRSL, "Unimplemented TCH_H activation\n");
Holger Freytherca362a62009-01-04 21:05:01 +0000421 return -1;
422 case GSM_LCHAN_UNKNOWN:
423 case GSM_LCHAN_NONE:
424 return -1;
Harald Welte4b634542008-12-27 01:55:51 +0000425 }
426
427 ci.chan_desc.iei = 0x64;
428 ci.chan_desc.chan_nr = chan_nr;
429 ci.chan_desc.oct3 = (TSC << 5) | ((arfcn & 0x3ff) >> 8);
430 ci.chan_desc.oct4 = arfcn & 0xff;
431
432 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
433 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
434 dh->chan_nr = chan_nr;
435
436 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
437 /* For compatibility with Phase 1 */
438 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
439 (u_int8_t *) &cm);
440 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
441 (u_int8_t *) &ci);
Harald Welte4b634542008-12-27 01:55:51 +0000442#if 0
443 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
444 (u_int8_t *) &encr_info);
Harald Welte4b634542008-12-27 01:55:51 +0000445#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000446 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
447 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000448 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
449
Harald Weltee79769b2009-02-07 00:48:17 +0000450 msg->trx = lchan->ts->trx;
451
Harald Welte4b634542008-12-27 01:55:51 +0000452 return abis_rsl_sendmsg(msg);
453}
454
Harald Welteda783762009-02-18 03:29:53 +0000455/* Chapter 8.4.9 */
456int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
457{
458 struct abis_rsl_dchan_hdr *dh;
459 struct msgb *msg = rsl_msgb_alloc();
460
461 u_int8_t chan_nr = lchan2chan_nr(lchan);
462 struct rsl_ie_chan_mode cm;
463
464 /* FIXME: what to do with data calls ? */
465 cm.dtx_dtu = 0x00;
466 switch (lchan->type) {
467 case GSM_LCHAN_TCH_F:
468 cm.spd_ind = RSL_CMOD_SPD_SPEECH;
469 cm.chan_rt = RSL_CMOD_CRT_TCH_Bm;
470 cm.chan_rate = 0x11; /* speech coding alg version 2*/
471 break;
472 default:
473 DEBUGP(DRSL, "Unimplemented channel modification\n");
474 return -1;
475 }
476
477 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
478 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
479 dh->chan_nr = chan_nr;
480
481 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
482 (u_int8_t *) &cm);
483#if 0
484 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
485 (u_int8_t *) &encr_info);
486#endif
487
488 msg->trx = lchan->ts->trx;
489
490 return abis_rsl_sendmsg(msg);
491}
492
Holger Freyther36cbeff2008-12-30 19:15:20 +0000493/* Chapter 9.1.7 of 04.08 */
Harald Welte8470bf22008-12-25 23:28:35 +0000494int rsl_chan_release(struct gsm_lchan *lchan)
Harald Welte52b1f982008-12-23 20:25:15 +0000495{
496 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000497 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000498
499 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
500 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000501 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000502
Harald Welte8470bf22008-12-25 23:28:35 +0000503 msg->lchan = lchan;
504 msg->trx = lchan->ts->trx;
505
Harald Weltef325eb42009-02-19 17:07:39 +0000506 DEBUGP(DRSL, "Channel Release CMD channel=%s chan_nr=0x%02x\n",
507 gsm_ts_name(lchan->ts), dh->chan_nr);
Harald Welte2d5b6382008-12-27 19:46:06 +0000508
Harald Welte8470bf22008-12-25 23:28:35 +0000509 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000510}
511
512int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
513 u_int8_t *ms_ident, u_int8_t chan_needed)
514{
515 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000516 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000517
518 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
519 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
520 dh->chan_nr = RSL_CHAN_PCH_AGCH;
521
522 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000523 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000524 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
525
Harald Welte8470bf22008-12-25 23:28:35 +0000526 msg->trx = bts->c0;
527
528 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000529}
530
Holger Freyther7448a532009-01-04 20:18:23 +0000531int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
532 struct gsm_subscriber *subscr)
533{
Holger Freytherca362a62009-01-04 21:05:01 +0000534#if 0
Holger Freyther7448a532009-01-04 20:18:23 +0000535 u_int8_t mi[128];
536 unsigned int mi_len;
537 u_int8_t paging_group;
Holger Freytherca362a62009-01-04 21:05:01 +0000538#endif
Holger Freyther7448a532009-01-04 20:18:23 +0000539
540 return -1;
541}
542
Harald Welte52b1f982008-12-23 20:25:15 +0000543int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
544{
545 int i, len = strlen(str_in);
546
547 for (i = 0; i < len; i++) {
548 int num = str_in[i] - 0x30;
549 if (num < 0 || num > 9)
550 return -1;
551 if (i % 2 == 0)
552 bcd_out[i/2] = num;
553 else
554 bcd_out[i/2] |= (num << 4);
555 }
556
557 return 0;
558}
559
Harald Welte702d8702008-12-26 20:25:35 +0000560/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000561int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
562{
Harald Welte8470bf22008-12-25 23:28:35 +0000563 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000564 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000565 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000566
567 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
568 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
569 dh->chan_nr = RSL_CHAN_PCH_AGCH;
570
Harald Welte362322e2009-02-15 14:36:38 +0000571 switch (bts->type) {
572 case GSM_BTS_TYPE_BS11:
573 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
574 break;
575 default:
576 /* If phase 2, construct a FULL_IMM_ASS_INFO */
577 pad_macblock(buf, val, len);
578 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
579 break;
580 }
Harald Welte52b1f982008-12-23 20:25:15 +0000581
Harald Welte8470bf22008-12-25 23:28:35 +0000582 msg->trx = bts->c0;
583
584 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000585}
586
Harald Welte8470bf22008-12-25 23:28:35 +0000587/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000588/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000589int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000590{
Harald Welte8470bf22008-12-25 23:28:35 +0000591 u_int8_t l3_len = msg->tail - (u_int8_t *)msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000592 struct abis_rsl_rll_hdr *rh;
593
Harald Welte8470bf22008-12-25 23:28:35 +0000594 if (msg->lchan == NULL) {
595 fprintf(stderr, "cannot send DATA REQUEST to unknown lchan\n");
596 return -EINVAL;
597 }
Harald Welte52b1f982008-12-23 20:25:15 +0000598
Harald Welte8470bf22008-12-25 23:28:35 +0000599 /* First push the L3 IE tag and length */
Harald Welte4b634542008-12-27 01:55:51 +0000600 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
Harald Welte8470bf22008-12-25 23:28:35 +0000601
602 /* Then push the RSL header */
Harald Welte52b1f982008-12-23 20:25:15 +0000603 rh = (struct abis_rsl_rll_hdr *) msgb_push(msg, sizeof(*rh));
604 init_llm_hdr(rh, RSL_MT_DATA_REQ);
Harald Welte8470bf22008-12-25 23:28:35 +0000605 rh->chan_nr = lchan2chan_nr(msg->lchan);
606 rh->link_id = link_id;
Harald Welte52b1f982008-12-23 20:25:15 +0000607
Harald Welte8470bf22008-12-25 23:28:35 +0000608 msg->trx = msg->lchan->ts->trx;
609
610 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000611}
612
Harald Welte702d8702008-12-26 20:25:35 +0000613/* Chapter 8.4.2: Channel Activate Acknowledge */
614static int rsl_rx_chan_act_ack(struct msgb *msg)
615{
616 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
617
618 /* BTS has confirmed channel activation, we now need
619 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000620 if (rslh->ie_chan != RSL_IE_CHAN_NR)
621 return -EINVAL;
622
Harald Welte4b634542008-12-27 01:55:51 +0000623 return 0;
624}
Harald Welte702d8702008-12-26 20:25:35 +0000625
Harald Welte4b634542008-12-27 01:55:51 +0000626/* Chapter 8.4.3: Channel Activate NACK */
627static int rsl_rx_chan_act_nack(struct msgb *msg)
628{
629 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
630
631 /* BTS has confirmed channel activation, we now need
632 * to assign the activated channel to the MS */
633 if (rslh->ie_chan != RSL_IE_CHAN_NR)
634 return -EINVAL;
635
Harald Welte4b634542008-12-27 01:55:51 +0000636 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000637}
638
Harald Welte7f93cea2009-02-23 00:02:59 +0000639/* Chapter 8.4.4: Connection Failure Indication */
640static int rsl_rx_conn_fail(struct msgb *msg)
641{
642 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
643 struct tlv_parsed tp;
644
645 DEBUGPC(DRSL, "CONNECTION FAIL: ");
646 print_rsl_cause(dh->data);
647
648 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
649
650 if (msg->trx->bts->type == GSM_BTS_TYPE_BS11) {
651 /* FIXME: we have no idea what cause 0x18 is !!! */
652 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE) &&
653 TLVP_LEN(&tp, RSL_IE_CAUSE) >= 1 &&
654 *TLVP_VAL(&tp, RSL_IE_CAUSE) == 0x18) {
655 DEBUGPC(DRSL, "IGNORING\n");
656 return 0;
657 }
658 }
659
660 DEBUGPC(DRSL, "\n");
661
662 /* FIXME: only free it after channel release ACK */
663 return rsl_chan_release(msg->lchan);
664}
665
Harald Welte52b1f982008-12-23 20:25:15 +0000666static int abis_rsl_rx_dchan(struct msgb *msg)
667{
Harald Welte8470bf22008-12-25 23:28:35 +0000668 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
669 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +0000670 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +0000671
Harald Welte8470bf22008-12-25 23:28:35 +0000672 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +0000673 ts_name = gsm_ts_name(msg->lchan->ts);
674
675 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ", ts_name, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000676
677 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +0000678 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000679 DEBUGPC(DRSL, "CHANNEL ACTIVATE ACK ");
Harald Welte4b634542008-12-27 01:55:51 +0000680 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000681 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000682 case RSL_MT_CHAN_ACTIV_NACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000683 DEBUGPC(DRSL, "CHANNEL ACTIVATE NACK ");
Harald Welte4b634542008-12-27 01:55:51 +0000684 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000685 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000686 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +0000687 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000688 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000689 case RSL_MT_MEAS_RES:
Harald Weltef325eb42009-02-19 17:07:39 +0000690 DEBUGPC(DRSL, "MEASUREMENT RESULT ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000691 break;
692 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000693 DEBUGPC(DRSL, "RF CHANNEL RELEASE ACK ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000694 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +0000695 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000696 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000697 DEBUGPC(DRSL, "CHANNEL MODE MODIFY ACK ");
Harald Welteda783762009-02-18 03:29:53 +0000698 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000699 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000700 DEBUGPC(DRSL, "CHANNEL MODE MODIFY NACK ");
Harald Welteda783762009-02-18 03:29:53 +0000701 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000702 case RSL_MT_PHY_CONTEXT_CONF:
703 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +0000704 case RSL_MT_TALKER_DET:
705 case RSL_MT_LISTENER_DET:
706 case RSL_MT_REMOTE_CODEC_CONF_REP:
707 case RSL_MT_MR_CODEC_MOD_ACK:
708 case RSL_MT_MR_CODEC_MOD_NACK:
709 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltef325eb42009-02-19 17:07:39 +0000710 DEBUGPC(DRSL, "Unimplemented Abis RSL DChan msg 0x%02x ",
Harald Welte8470bf22008-12-25 23:28:35 +0000711 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000712 break;
713 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000714 DEBUGPC(DRSL, "unknown Abis RSL DChan msg 0x%02x ",
Harald Welte8470bf22008-12-25 23:28:35 +0000715 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000716 return -EINVAL;
717 }
Harald Weltef325eb42009-02-19 17:07:39 +0000718 DEBUGPC(DRSL, "\n");
719
Harald Welte8470bf22008-12-25 23:28:35 +0000720 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000721}
722
Harald Welte702d8702008-12-26 20:25:35 +0000723static int rsl_rx_error_rep(struct msgb *msg)
724{
725 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte702d8702008-12-26 20:25:35 +0000726
Harald Welte7f93cea2009-02-23 00:02:59 +0000727 DEBUGP(DRSL, "ERROR REPORT ");
728 print_rsl_cause(rslh->data);
Harald Welte702d8702008-12-26 20:25:35 +0000729
730 return 0;
731}
732
Harald Welte52b1f982008-12-23 20:25:15 +0000733static int abis_rsl_rx_trx(struct msgb *msg)
734{
Harald Welte702d8702008-12-26 20:25:35 +0000735 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000736 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000737
738 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +0000739 case RSL_MT_ERROR_REPORT:
740 rc = rsl_rx_error_rep(msg);
741 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000742 case RSL_MT_RF_RES_IND:
743 /* interference on idle channels of TRX */
Harald Weltef325eb42009-02-19 17:07:39 +0000744 DEBUGP(DRSL, "TRX: RF Interference Indication\n");
Harald Welte8f5e2392009-02-03 12:57:37 +0000745 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000746 case RSL_MT_OVERLOAD:
747 /* indicate CCCH / ACCH / processor overload */
Harald Weltef325eb42009-02-19 17:07:39 +0000748 DEBUGP(DRSL, "TRX: CCCH/ACCH/CPU Overload\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000749 break;
750 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000751 DEBUGP(DRSL, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +0000752 rslh->msg_type);
753 return -EINVAL;
754 }
Harald Welte8470bf22008-12-25 23:28:35 +0000755 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000756}
757
Harald Welte8470bf22008-12-25 23:28:35 +0000758/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +0000759static int rsl_rx_chan_rqd(struct msgb *msg)
760{
Harald Welte702d8702008-12-26 20:25:35 +0000761 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +0000762 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
763 struct gsm48_req_ref *rqd_ref;
Harald Welte52b1f982008-12-23 20:25:15 +0000764 struct gsm48_imm_ass ia;
Harald Welte8470bf22008-12-25 23:28:35 +0000765 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +0000766 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +0000767 struct gsm_lchan *lchan;
768 u_int8_t rqd_ta;
Holger Freyther3186bf22008-12-29 06:23:49 +0000769 int ret;
Harald Welte8470bf22008-12-25 23:28:35 +0000770
Harald Welte52b1f982008-12-23 20:25:15 +0000771 u_int16_t arfcn;
772 u_int8_t ts_number, subch;
773
Harald Welte8470bf22008-12-25 23:28:35 +0000774 /* parse request reference to be used in immediate assign */
775 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
776 return -EINVAL;
777
778 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
779
780 /* parse access delay and use as TA */
781 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
782 return -EINVAL;
783 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
784
785 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
786 * request reference RA */
787 lctype = get_ctype_by_chreq(bts, rqd_ref->ra);
Harald Welte2cbe0922008-12-29 04:09:31 +0000788 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra);
789
Harald Welte8470bf22008-12-25 23:28:35 +0000790 /* check availability / allocate channel */
791 lchan = lchan_alloc(bts, lctype);
792 if (!lchan) {
793 fprintf(stderr, "CHAN RQD: no resources\n");
794 /* FIXME: send some kind of reject ?!? */
795 return -ENOMEM;
796 }
797
798 ts_number = lchan->ts->nr;
799 arfcn = lchan->ts->trx->arfcn;
800 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +0000801
Harald Welted4c9bf32009-02-15 16:56:18 +0000802 lchan->ms_power = lchan->bs_power = 0x0f; /* 30dB reduction */
Harald Welte4b634542008-12-27 01:55:51 +0000803 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta);
Harald Welte52b1f982008-12-23 20:25:15 +0000804
805 /* create IMMEDIATE ASSIGN 04.08 messge */
806 memset(&ia, 0, sizeof(ia));
807 ia.l2_plen = 0x2d;
808 ia.proto_discr = GSM48_PDISC_RR;
809 ia.msg_type = GSM48_MT_RR_IMM_ASS;
Harald Welte2d5b6382008-12-27 19:46:06 +0000810 ia.page_mode = GSM48_PM_SAME;
Harald Welte4b634542008-12-27 01:55:51 +0000811 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000812 ia.chan_desc.h0.h = 0;
813 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
814 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
815 ia.chan_desc.h0.tsc = 7;
Harald Welte8470bf22008-12-25 23:28:35 +0000816 /* use request reference extracted from CHAN_RQD */
817 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
818 ia.timing_advance = rqd_ta;
Harald Welte52b1f982008-12-23 20:25:15 +0000819 ia.mob_alloc_len = 0;
820
Harald Welte8f5e2392009-02-03 12:57:37 +0000821 DEBUGP(DRSL, "Activating ARFCN(%u) TS(%u) SS(%u) lctype %s "
822 "chan_nr=0x%02x r=%s\n",
Harald Welteca64da92009-01-04 16:54:12 +0000823 arfcn, ts_number, subch, gsm_lchan_name(lchan->type),
824 ia.chan_desc.chan_nr, gsm_chreq_name(chreq_reason));
Harald Welte75a983f2008-12-27 21:34:06 +0000825
Harald Welte09e38af2009-02-16 22:52:23 +0000826 /* FIXME: Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
Holger Freyther3186bf22008-12-29 06:23:49 +0000827
Harald Welte52b1f982008-12-23 20:25:15 +0000828 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Freyther3186bf22008-12-29 06:23:49 +0000829 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
830
Harald Welte817f3c82008-12-30 14:57:59 +0000831 return ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000832}
833
Harald Welteea280442009-02-02 22:29:56 +0000834/* MS has requested a channel on the RACH */
835static int rsl_rx_ccch_load(struct msgb *msg)
836{
837 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
838 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +0000839 u_int16_t rach_slot_count = -1;
840 u_int16_t rach_busy_count = -1;
841 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +0000842
843 switch (rslh->data[0]) {
844 case RSL_IE_PAGING_LOAD:
845 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Holger Freyther392209c2009-02-10 00:06:19 +0000846 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +0000847 break;
848 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +0000849 if (msg->data_len >= 7) {
850 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
851 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
852 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
853 }
Harald Welteea280442009-02-02 22:29:56 +0000854 break;
855 default:
856 break;
857 }
858
859 return 0;
860}
861
Harald Welte52b1f982008-12-23 20:25:15 +0000862static int abis_rsl_rx_cchan(struct msgb *msg)
863{
Harald Welteea280442009-02-02 22:29:56 +0000864 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000865 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000866
Harald Welte8470bf22008-12-25 23:28:35 +0000867 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
868
869 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +0000870 case RSL_MT_CHAN_RQD:
871 /* MS has requested a channel on the RACH */
872 rc = rsl_rx_chan_rqd(msg);
873 break;
Harald Welteea280442009-02-02 22:29:56 +0000874 case RSL_MT_CCCH_LOAD_IND:
875 /* current load on the CCCH */
876 rc = rsl_rx_ccch_load(msg);
877 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000878 case RSL_MT_DELETE_IND:
879 /* CCCH overloaded, IMM_ASSIGN was dropped */
880 case RSL_MT_CBCH_LOAD_IND:
881 /* current load on the CBCH */
Harald Welte8f5e2392009-02-03 12:57:37 +0000882 fprintf(stderr, "Unimplemented Abis RSL TRX message type "
883 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000884 break;
885 default:
886 fprintf(stderr, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000887 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000888 return -EINVAL;
889 }
Harald Welte8470bf22008-12-25 23:28:35 +0000890
891 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000892}
893
Harald Welte4b634542008-12-27 01:55:51 +0000894static int rsl_rx_rll_err_ind(struct msgb *msg)
895{
896 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
897 u_int8_t *rlm_cause = rllh->data;
898
Harald Weltef325eb42009-02-19 17:07:39 +0000899 DEBUGPC(DRLL, "cause=0x%02x", rlm_cause[1]);
Harald Welte4b634542008-12-27 01:55:51 +0000900
901 return 0;
902}
Harald Weltef325eb42009-02-19 17:07:39 +0000903
Harald Welte52b1f982008-12-23 20:25:15 +0000904/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
905 0x02, 0x06,
906 0x01, 0x20,
907 0x02, 0x00,
908 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
909
910static int abis_rsl_rx_rll(struct msgb *msg)
911{
912 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +0000913 int rc = 0;
914 char *ts_name;
Harald Welte8470bf22008-12-25 23:28:35 +0000915
916 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +0000917 ts_name = gsm_ts_name(msg->lchan->ts);
918 DEBUGP(DRLL, "channel=%s chan_nr=0x%02x ", ts_name, rllh->chan_nr);
Harald Welte52b1f982008-12-23 20:25:15 +0000919
920 switch (rllh->c.msg_type) {
921 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000922 DEBUGPC(DRLL, "DATA INDICATION\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000923 /* FIXME: Verify L3 info element */
Harald Welte702d8702008-12-26 20:25:35 +0000924 msg->l3h = &rllh->data[3];
Harald Weltef325eb42009-02-19 17:07:39 +0000925 return gsm0408_rcvmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000926 break;
927 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000928 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000929 /* FIXME: Verify L3 info element */
Harald Welte702d8702008-12-26 20:25:35 +0000930 msg->l3h = &rllh->data[3];
Harald Weltef325eb42009-02-19 17:07:39 +0000931 return gsm0408_rcvmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000932 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000933 case RSL_MT_REL_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000934 DEBUGPC(DRLL, "RELEASE INDICATION ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000935 break;
936 case RSL_MT_REL_CONF:
Harald Weltef325eb42009-02-19 17:07:39 +0000937 DEBUGPC(DRLL, "RELEASE CONFIRMATION ");
Harald Welte4b634542008-12-27 01:55:51 +0000938 break;
939 case RSL_MT_ERROR_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000940 DEBUGPC(DRLL, "ERROR INDICATION ");
Harald Welte4b634542008-12-27 01:55:51 +0000941 rc = rsl_rx_rll_err_ind(msg);
942 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000943 case RSL_MT_UNIT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000944 DEBUGPC(DRLL, "unimplemented Abis RLL message type 0x%02x ",
Harald Welte52b1f982008-12-23 20:25:15 +0000945 rllh->c.msg_type);
946 break;
947 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000948 DEBUGPC(DRLL, "unknown Abis RLL message type 0x%02x ",
Harald Welte52b1f982008-12-23 20:25:15 +0000949 rllh->c.msg_type);
950 }
Harald Weltef325eb42009-02-19 17:07:39 +0000951 DEBUGPC(DRLL, "\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000952 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000953}
954
Harald Welte75099262009-02-16 21:12:08 +0000955/* ip.access specific RSL extensions */
956int rsl_ipacc_bind(struct gsm_lchan *lchan)
957{
958 struct msgb *msg = rsl_msgb_alloc();
959 struct abis_rsl_dchan_hdr *dh;
960
961 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
962 init_dchan_hdr(dh, RSL_MT_IPAC_BIND);
963 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
964 dh->chan_nr = lchan2chan_nr(lchan);
965
966 msg->trx = lchan->ts->trx;
967
968 return abis_rsl_sendmsg(msg);
969}
970
971int rsl_ipacc_connect(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port, u_int16_t f8, u_int8_t fc)
972{
973 struct msgb *msg = rsl_msgb_alloc();
974 struct abis_rsl_dchan_hdr *dh;
975 u_int8_t *att_f8, *att_ip, *att_port;
976
977 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
978 init_dchan_hdr(dh, RSL_MT_IPAC_CONNECT);
979 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
980 dh->chan_nr = lchan2chan_nr(lchan);
981
982 att_f8 = msgb_put(msg, sizeof(f8)+1);
983 att_f8[0] = 0xf8;
984 att_f8[1] = f8 >> 8;
985 att_f8[2] = f8 & 0xff;
986
987 att_ip = msgb_put(msg, sizeof(ip)+1);
988 att_ip[0] = RSL_IE_IPAC_REMOTE_IP;
989 att_ip[1] = ip >> 24;
990 att_ip[2] = ip >> 16;
991 att_ip[3] = ip >> 8;
992 att_ip[4] = ip & 0xff;
Harald Welteda783762009-02-18 03:29:53 +0000993 //att_ip[4] = 11;
Harald Welte75099262009-02-16 21:12:08 +0000994
995 att_port = msgb_put(msg, sizeof(port)+1);
996 att_port[0] = RSL_IE_IPAC_REMOTE_PORT;
997 att_port[1] = port >> 8;
998 att_port[2] = port & 0xff;
999
1000 msgb_tv_put(msg, 0xf4, 1); /* F4 01 */
1001 msgb_tv_put(msg, 0xfc, fc); /* FC 7F */
1002 msg->trx = lchan->ts->trx;
1003
1004 return abis_rsl_sendmsg(msg);
1005}
1006
1007static int abis_rsl_rx_ipacc_bindack(struct msgb *msg)
1008{
1009 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1010 struct tlv_parsed tv;
1011 struct gsm_bts_trx_ts *ts = msg->lchan->ts;
Harald Welte167df882009-02-17 14:35:45 +00001012 struct in_addr ip;
Harald Welte75099262009-02-16 21:12:08 +00001013 u_int16_t port, attr_f8;
1014
1015 /* the BTS has acknowledged a local bind, it now tells us the IP
1016 * address and port number to which it has bound the given logical
1017 * channel */
1018
1019 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1020 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1021 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
1022 !TLVP_PRESENT(&tv, 0xfc) ||
1023 !TLVP_PRESENT(&tv, 0xf8)) {
Harald Weltef325eb42009-02-19 17:07:39 +00001024 DEBUGPC(DRSL, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001025 return -EINVAL;
1026 }
Harald Welte167df882009-02-17 14:35:45 +00001027 ip.s_addr = *((u_int32_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte75099262009-02-16 21:12:08 +00001028 port = *((u_int16_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_PORT));
1029 attr_f8 = *((u_int16_t *) TLVP_VAL(&tv, 0xf8));
1030
Harald Weltef325eb42009-02-19 17:07:39 +00001031 DEBUGPC(DRSL, "IP=%s PORT=%d FC=%d F8=%d",
1032 inet_ntoa(ip), ntohs(port), *TLVP_VAL(&tv, 0xfc),
Harald Welte167df882009-02-17 14:35:45 +00001033 ntohs(attr_f8));
1034
Harald Welte75099262009-02-16 21:12:08 +00001035 /* update our local information about this TS */
Harald Welte167df882009-02-17 14:35:45 +00001036 ts->abis_ip.bound_ip = ntohl(ip.s_addr);
1037 ts->abis_ip.bound_port = ntohs(port);
Harald Welte75099262009-02-16 21:12:08 +00001038 ts->abis_ip.attr_f8 = ntohs(attr_f8);
1039 ts->abis_ip.attr_fc = *TLVP_VAL(&tv, 0xfc);
1040
Harald Welte167df882009-02-17 14:35:45 +00001041 dispatch_signal(SS_ABISIP, S_ABISIP_BIND_ACK, msg->lchan);
1042
Harald Welte75099262009-02-16 21:12:08 +00001043 return 0;
1044}
1045
1046static int abis_rsl_rx_ipacc_disc_ind(struct msgb *msg)
1047{
1048 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1049 struct tlv_parsed tv;
1050
1051 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1052 if (!TLVP_PRESENT(&tv, RSL_IE_CAUSE)) {
1053 DEBUGP(DRSL, "mandatory IE missing\n");
1054 return -EINVAL;
1055 }
1056
Harald Weltec1697102009-02-22 18:18:12 +00001057 DEBUGP(DRSL, "cause=0x%02x\n", *TLVP_VAL(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001058
1059 return 0;
1060}
1061
1062static int abis_rsl_rx_ipacc(struct msgb *msg)
1063{
1064 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1065 int rc = 0;
1066
1067 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +00001068 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ",
1069 gsm_ts_name(msg->lchan->ts), rllh->chan_nr);
Harald Welte75099262009-02-16 21:12:08 +00001070
1071 switch (rllh->c.msg_type) {
1072 case RSL_MT_IPAC_BIND_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +00001073 DEBUGP(DRSL, "IPAC_BIND_ACK ");
Harald Welte75099262009-02-16 21:12:08 +00001074 rc = abis_rsl_rx_ipacc_bindack(msg);
1075 break;
1076 case RSL_MT_IPAC_BIND_NACK:
1077 /* somehow the BTS was unable to bind the lchan to its local
1078 * port?!? */
Harald Weltef325eb42009-02-19 17:07:39 +00001079 DEBUGPC(DRSL, "IPAC_BIND_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001080 break;
1081 case RSL_MT_IPAC_CONNECT_ACK:
1082 /* the BTS tells us that a connect operation was successful */
Harald Weltef325eb42009-02-19 17:07:39 +00001083 DEBUGPC(DRSL, "IPAC_CONNECT_ACK ");
Harald Welte75099262009-02-16 21:12:08 +00001084 break;
1085 case RSL_MT_IPAC_CONNECT_NACK:
1086 /* somehow the BTS was unable to connect the lchan to a remote
1087 * port */
Harald Weltef325eb42009-02-19 17:07:39 +00001088 DEBUGPC(DRSL, "IPAC_CONNECT_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001089 break;
1090 case RSL_MT_IPAC_DISCONNECT_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001091 DEBUGPC(DRSL, "IPAC_DISCONNECT_IND ");
Harald Welte75099262009-02-16 21:12:08 +00001092 rc = abis_rsl_rx_ipacc_disc_ind(msg);
1093 break;
1094 default:
Harald Weltef325eb42009-02-19 17:07:39 +00001095 DEBUGPC(DRSL, "Unknown ip.access msg_type 0x%02x", rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001096 break;
1097 }
Harald Weltef325eb42009-02-19 17:07:39 +00001098 DEBUGP(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001099
1100 return rc;
1101}
1102
1103
Harald Welte52b1f982008-12-23 20:25:15 +00001104/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001105int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001106{
1107 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
Harald Welte8f5e2392009-02-03 12:57:37 +00001108 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001109
1110 switch (rslh->msg_discr & 0xfe) {
1111 case ABIS_RSL_MDISC_RLL:
1112 rc = abis_rsl_rx_rll(msg);
1113 break;
1114 case ABIS_RSL_MDISC_DED_CHAN:
1115 rc = abis_rsl_rx_dchan(msg);
1116 break;
1117 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001118 rc = abis_rsl_rx_cchan(msg);
1119 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001120 case ABIS_RSL_MDISC_TRX:
1121 rc = abis_rsl_rx_trx(msg);
1122 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001123 case ABIS_RSL_MDISC_LOC:
Harald Welte8f5e2392009-02-03 12:57:37 +00001124 fprintf(stderr, "unimplemented RSL msg disc 0x%02x\n",
1125 rslh->msg_discr);
1126 break;
Harald Welte75099262009-02-16 21:12:08 +00001127 case ABIS_RSL_MDISC_IPACCESS:
1128 rc = abis_rsl_rx_ipacc(msg);
1129 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001130 default:
1131 fprintf(stderr, "unknown RSL message discriminator 0x%02x\n",
1132 rslh->msg_discr);
1133 return -EINVAL;
1134 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001135 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001136 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001137}
Holger Freyther3b72a892009-02-04 00:31:39 +00001138
1139
1140/* Section 3.3.2.3 . I think this looks like a table */
1141int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1142{
1143 switch (ccch_conf) {
1144 case RSL_BCCH_CCCH_CONF_1_NC:
1145 return 1;
1146 case RSL_BCCH_CCCH_CONF_1_C:
1147 return 1;
1148 case RSL_BCCH_CCCH_CONF_2_NC:
1149 return 2;
1150 case RSL_BCCH_CCCH_CONF_3_NC:
1151 return 3;
1152 case RSL_BCCH_CCCH_CONF_4_NC:
1153 return 4;
1154 default:
1155 return -1;
1156 }
1157}
1158
1159int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1160{
1161 switch (ccch_conf) {
1162 case RSL_BCCH_CCCH_CONF_1_NC:
1163 return 0;
1164 case RSL_BCCH_CCCH_CONF_1_C:
1165 return 1;
1166 case RSL_BCCH_CCCH_CONF_2_NC:
1167 return 0;
1168 case RSL_BCCH_CCCH_CONF_3_NC:
1169 return 0;
1170 case RSL_BCCH_CCCH_CONF_4_NC:
1171 return 0;
1172 default:
1173 return -1;
1174 }
1175}
1176
1177/* From Table 10.5.33 of GSM 04.08 */
1178int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1179{
1180 if (bts->chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1181 return MAX(1, (3 - bts->chan_desc.bs_ag_blks_res))
Holger Freyther3aa8d6c2009-02-04 02:14:45 +00001182 * (bts->chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001183 } else {
1184 return (9 - bts->chan_desc.bs_ag_blks_res)
Holger Freyther3aa8d6c2009-02-04 02:14:45 +00001185 * (bts->chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001186 }
1187}