blob: 8df109c9f49857a4ddd85b2749530b139388d518 [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
Harald Welte02b0e092009-02-28 13:11:07 +0000427 memset(&ci, 0, sizeof(ci));
Harald Welte4b634542008-12-27 01:55:51 +0000428 ci.chan_desc.iei = 0x64;
429 ci.chan_desc.chan_nr = chan_nr;
Harald Welte02b0e092009-02-28 13:11:07 +0000430 ci.chan_desc.oct3 = (lchan->ts->trx->bts->tsc << 5) | ((arfcn & 0x3ff) >> 8);
Harald Welte4b634542008-12-27 01:55:51 +0000431 ci.chan_desc.oct4 = arfcn & 0xff;
432
433 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
434 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
435 dh->chan_nr = chan_nr;
436
437 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
438 /* For compatibility with Phase 1 */
439 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
440 (u_int8_t *) &cm);
441 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
442 (u_int8_t *) &ci);
Harald Welte4b634542008-12-27 01:55:51 +0000443#if 0
444 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
445 (u_int8_t *) &encr_info);
Harald Welte4b634542008-12-27 01:55:51 +0000446#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000447 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
448 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000449 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
450
Harald Weltee79769b2009-02-07 00:48:17 +0000451 msg->trx = lchan->ts->trx;
452
Harald Welte4b634542008-12-27 01:55:51 +0000453 return abis_rsl_sendmsg(msg);
454}
455
Harald Welteda783762009-02-18 03:29:53 +0000456/* Chapter 8.4.9 */
457int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
458{
459 struct abis_rsl_dchan_hdr *dh;
460 struct msgb *msg = rsl_msgb_alloc();
461
462 u_int8_t chan_nr = lchan2chan_nr(lchan);
463 struct rsl_ie_chan_mode cm;
464
465 /* FIXME: what to do with data calls ? */
466 cm.dtx_dtu = 0x00;
467 switch (lchan->type) {
468 case GSM_LCHAN_TCH_F:
469 cm.spd_ind = RSL_CMOD_SPD_SPEECH;
470 cm.chan_rt = RSL_CMOD_CRT_TCH_Bm;
471 cm.chan_rate = 0x11; /* speech coding alg version 2*/
472 break;
473 default:
474 DEBUGP(DRSL, "Unimplemented channel modification\n");
475 return -1;
476 }
477
478 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
479 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
480 dh->chan_nr = chan_nr;
481
482 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
483 (u_int8_t *) &cm);
484#if 0
485 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
486 (u_int8_t *) &encr_info);
487#endif
488
489 msg->trx = lchan->ts->trx;
490
491 return abis_rsl_sendmsg(msg);
492}
493
Holger Freyther36cbeff2008-12-30 19:15:20 +0000494/* Chapter 9.1.7 of 04.08 */
Harald Welte8470bf22008-12-25 23:28:35 +0000495int rsl_chan_release(struct gsm_lchan *lchan)
Harald Welte52b1f982008-12-23 20:25:15 +0000496{
497 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000498 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000499
500 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
501 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000502 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000503
Harald Welte8470bf22008-12-25 23:28:35 +0000504 msg->lchan = lchan;
505 msg->trx = lchan->ts->trx;
506
Harald Weltef325eb42009-02-19 17:07:39 +0000507 DEBUGP(DRSL, "Channel Release CMD channel=%s chan_nr=0x%02x\n",
508 gsm_ts_name(lchan->ts), dh->chan_nr);
Harald Welte2d5b6382008-12-27 19:46:06 +0000509
Harald Welte8470bf22008-12-25 23:28:35 +0000510 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000511}
512
513int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
514 u_int8_t *ms_ident, u_int8_t chan_needed)
515{
516 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000517 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000518
519 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
520 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
521 dh->chan_nr = RSL_CHAN_PCH_AGCH;
522
523 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
Harald Welte255539c2008-12-28 02:26:27 +0000524 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000525 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
526
Harald Welte8470bf22008-12-25 23:28:35 +0000527 msg->trx = bts->c0;
528
529 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000530}
531
Holger Freyther7448a532009-01-04 20:18:23 +0000532int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
533 struct gsm_subscriber *subscr)
534{
Holger Freytherca362a62009-01-04 21:05:01 +0000535#if 0
Holger Freyther7448a532009-01-04 20:18:23 +0000536 u_int8_t mi[128];
537 unsigned int mi_len;
538 u_int8_t paging_group;
Holger Freytherca362a62009-01-04 21:05:01 +0000539#endif
Holger Freyther7448a532009-01-04 20:18:23 +0000540
541 return -1;
542}
543
Harald Welte52b1f982008-12-23 20:25:15 +0000544int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
545{
546 int i, len = strlen(str_in);
547
548 for (i = 0; i < len; i++) {
549 int num = str_in[i] - 0x30;
550 if (num < 0 || num > 9)
551 return -1;
552 if (i % 2 == 0)
553 bcd_out[i/2] = num;
554 else
555 bcd_out[i/2] |= (num << 4);
556 }
557
558 return 0;
559}
560
Harald Welte702d8702008-12-26 20:25:35 +0000561/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000562int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
563{
Harald Welte8470bf22008-12-25 23:28:35 +0000564 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000565 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000566 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000567
568 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
569 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
570 dh->chan_nr = RSL_CHAN_PCH_AGCH;
571
Harald Welte362322e2009-02-15 14:36:38 +0000572 switch (bts->type) {
573 case GSM_BTS_TYPE_BS11:
574 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
575 break;
576 default:
577 /* If phase 2, construct a FULL_IMM_ASS_INFO */
578 pad_macblock(buf, val, len);
579 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
580 break;
581 }
Harald Welte52b1f982008-12-23 20:25:15 +0000582
Harald Welte8470bf22008-12-25 23:28:35 +0000583 msg->trx = bts->c0;
584
585 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000586}
587
Harald Welte8470bf22008-12-25 23:28:35 +0000588/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000589/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000590int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000591{
Harald Welte8470bf22008-12-25 23:28:35 +0000592 u_int8_t l3_len = msg->tail - (u_int8_t *)msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000593 struct abis_rsl_rll_hdr *rh;
594
Harald Welte8470bf22008-12-25 23:28:35 +0000595 if (msg->lchan == NULL) {
596 fprintf(stderr, "cannot send DATA REQUEST to unknown lchan\n");
597 return -EINVAL;
598 }
Harald Welte52b1f982008-12-23 20:25:15 +0000599
Harald Welte8470bf22008-12-25 23:28:35 +0000600 /* First push the L3 IE tag and length */
Harald Welte4b634542008-12-27 01:55:51 +0000601 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
Harald Welte8470bf22008-12-25 23:28:35 +0000602
603 /* Then push the RSL header */
Harald Welte52b1f982008-12-23 20:25:15 +0000604 rh = (struct abis_rsl_rll_hdr *) msgb_push(msg, sizeof(*rh));
605 init_llm_hdr(rh, RSL_MT_DATA_REQ);
Harald Welte8470bf22008-12-25 23:28:35 +0000606 rh->chan_nr = lchan2chan_nr(msg->lchan);
607 rh->link_id = link_id;
Harald Welte52b1f982008-12-23 20:25:15 +0000608
Harald Welte8470bf22008-12-25 23:28:35 +0000609 msg->trx = msg->lchan->ts->trx;
610
611 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000612}
613
Harald Welte702d8702008-12-26 20:25:35 +0000614/* Chapter 8.4.2: Channel Activate Acknowledge */
615static int rsl_rx_chan_act_ack(struct msgb *msg)
616{
617 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
618
619 /* BTS has confirmed channel activation, we now need
620 * to assign the activated channel to the MS */
Harald Welte4b634542008-12-27 01:55:51 +0000621 if (rslh->ie_chan != RSL_IE_CHAN_NR)
622 return -EINVAL;
623
Harald Welte4b634542008-12-27 01:55:51 +0000624 return 0;
625}
Harald Welte702d8702008-12-26 20:25:35 +0000626
Harald Welte4b634542008-12-27 01:55:51 +0000627/* Chapter 8.4.3: Channel Activate NACK */
628static int rsl_rx_chan_act_nack(struct msgb *msg)
629{
630 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
631
632 /* BTS has confirmed channel activation, we now need
633 * to assign the activated channel to the MS */
634 if (rslh->ie_chan != RSL_IE_CHAN_NR)
635 return -EINVAL;
636
Harald Welte4b634542008-12-27 01:55:51 +0000637 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000638}
639
Harald Welte7f93cea2009-02-23 00:02:59 +0000640/* Chapter 8.4.4: Connection Failure Indication */
641static int rsl_rx_conn_fail(struct msgb *msg)
642{
643 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
644 struct tlv_parsed tp;
645
646 DEBUGPC(DRSL, "CONNECTION FAIL: ");
647 print_rsl_cause(dh->data);
648
649 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
650
651 if (msg->trx->bts->type == GSM_BTS_TYPE_BS11) {
652 /* FIXME: we have no idea what cause 0x18 is !!! */
653 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE) &&
654 TLVP_LEN(&tp, RSL_IE_CAUSE) >= 1 &&
655 *TLVP_VAL(&tp, RSL_IE_CAUSE) == 0x18) {
656 DEBUGPC(DRSL, "IGNORING\n");
657 return 0;
658 }
659 }
660
661 DEBUGPC(DRSL, "\n");
662
663 /* FIXME: only free it after channel release ACK */
664 return rsl_chan_release(msg->lchan);
665}
666
Harald Welte52b1f982008-12-23 20:25:15 +0000667static int abis_rsl_rx_dchan(struct msgb *msg)
668{
Harald Welte8470bf22008-12-25 23:28:35 +0000669 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
670 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +0000671 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +0000672
Harald Welte8470bf22008-12-25 23:28:35 +0000673 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +0000674 ts_name = gsm_ts_name(msg->lchan->ts);
675
676 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ", ts_name, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +0000677
678 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +0000679 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000680 DEBUGPC(DRSL, "CHANNEL ACTIVATE ACK ");
Harald Welte4b634542008-12-27 01:55:51 +0000681 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000682 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000683 case RSL_MT_CHAN_ACTIV_NACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000684 DEBUGPC(DRSL, "CHANNEL ACTIVATE NACK ");
Harald Welte4b634542008-12-27 01:55:51 +0000685 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000686 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000687 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +0000688 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000689 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000690 case RSL_MT_MEAS_RES:
Harald Weltef325eb42009-02-19 17:07:39 +0000691 DEBUGPC(DRSL, "MEASUREMENT RESULT ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000692 break;
693 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000694 DEBUGPC(DRSL, "RF CHANNEL RELEASE ACK ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000695 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +0000696 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000697 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000698 DEBUGPC(DRSL, "CHANNEL MODE MODIFY ACK ");
Harald Welteda783762009-02-18 03:29:53 +0000699 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000700 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltef325eb42009-02-19 17:07:39 +0000701 DEBUGPC(DRSL, "CHANNEL MODE MODIFY NACK ");
Harald Welteda783762009-02-18 03:29:53 +0000702 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000703 case RSL_MT_PHY_CONTEXT_CONF:
704 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +0000705 case RSL_MT_TALKER_DET:
706 case RSL_MT_LISTENER_DET:
707 case RSL_MT_REMOTE_CODEC_CONF_REP:
708 case RSL_MT_MR_CODEC_MOD_ACK:
709 case RSL_MT_MR_CODEC_MOD_NACK:
710 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltef325eb42009-02-19 17:07:39 +0000711 DEBUGPC(DRSL, "Unimplemented Abis RSL DChan msg 0x%02x ",
Harald Welte8470bf22008-12-25 23:28:35 +0000712 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000713 break;
714 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000715 DEBUGPC(DRSL, "unknown Abis RSL DChan msg 0x%02x ",
Harald Welte8470bf22008-12-25 23:28:35 +0000716 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000717 return -EINVAL;
718 }
Harald Weltef325eb42009-02-19 17:07:39 +0000719 DEBUGPC(DRSL, "\n");
720
Harald Welte8470bf22008-12-25 23:28:35 +0000721 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000722}
723
Harald Welte702d8702008-12-26 20:25:35 +0000724static int rsl_rx_error_rep(struct msgb *msg)
725{
726 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte702d8702008-12-26 20:25:35 +0000727
Harald Welte7f93cea2009-02-23 00:02:59 +0000728 DEBUGP(DRSL, "ERROR REPORT ");
729 print_rsl_cause(rslh->data);
Harald Welte702d8702008-12-26 20:25:35 +0000730
731 return 0;
732}
733
Harald Welte52b1f982008-12-23 20:25:15 +0000734static int abis_rsl_rx_trx(struct msgb *msg)
735{
Harald Welte702d8702008-12-26 20:25:35 +0000736 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000737 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000738
739 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +0000740 case RSL_MT_ERROR_REPORT:
741 rc = rsl_rx_error_rep(msg);
742 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000743 case RSL_MT_RF_RES_IND:
744 /* interference on idle channels of TRX */
Harald Weltef325eb42009-02-19 17:07:39 +0000745 DEBUGP(DRSL, "TRX: RF Interference Indication\n");
Harald Welte8f5e2392009-02-03 12:57:37 +0000746 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000747 case RSL_MT_OVERLOAD:
748 /* indicate CCCH / ACCH / processor overload */
Harald Weltef325eb42009-02-19 17:07:39 +0000749 DEBUGP(DRSL, "TRX: CCCH/ACCH/CPU Overload\n");
Harald Welte52b1f982008-12-23 20:25:15 +0000750 break;
751 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000752 DEBUGP(DRSL, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +0000753 rslh->msg_type);
754 return -EINVAL;
755 }
Harald Welte8470bf22008-12-25 23:28:35 +0000756 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000757}
758
Harald Welte8470bf22008-12-25 23:28:35 +0000759/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +0000760static int rsl_rx_chan_rqd(struct msgb *msg)
761{
Harald Welte702d8702008-12-26 20:25:35 +0000762 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +0000763 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
764 struct gsm48_req_ref *rqd_ref;
Harald Welte52b1f982008-12-23 20:25:15 +0000765 struct gsm48_imm_ass ia;
Harald Welte8470bf22008-12-25 23:28:35 +0000766 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +0000767 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +0000768 struct gsm_lchan *lchan;
769 u_int8_t rqd_ta;
Holger Freyther3186bf22008-12-29 06:23:49 +0000770 int ret;
Harald Welte8470bf22008-12-25 23:28:35 +0000771
Harald Welte52b1f982008-12-23 20:25:15 +0000772 u_int16_t arfcn;
773 u_int8_t ts_number, subch;
774
Harald Welte8470bf22008-12-25 23:28:35 +0000775 /* parse request reference to be used in immediate assign */
776 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
777 return -EINVAL;
778
779 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
780
781 /* parse access delay and use as TA */
782 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
783 return -EINVAL;
784 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
785
786 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
787 * request reference RA */
788 lctype = get_ctype_by_chreq(bts, rqd_ref->ra);
Harald Welte2cbe0922008-12-29 04:09:31 +0000789 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra);
790
Harald Welte8470bf22008-12-25 23:28:35 +0000791 /* check availability / allocate channel */
792 lchan = lchan_alloc(bts, lctype);
793 if (!lchan) {
794 fprintf(stderr, "CHAN RQD: no resources\n");
795 /* FIXME: send some kind of reject ?!? */
796 return -ENOMEM;
797 }
798
799 ts_number = lchan->ts->nr;
800 arfcn = lchan->ts->trx->arfcn;
801 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +0000802
Harald Welted4c9bf32009-02-15 16:56:18 +0000803 lchan->ms_power = lchan->bs_power = 0x0f; /* 30dB reduction */
Harald Welte4b634542008-12-27 01:55:51 +0000804 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta);
Harald Welte52b1f982008-12-23 20:25:15 +0000805
806 /* create IMMEDIATE ASSIGN 04.08 messge */
807 memset(&ia, 0, sizeof(ia));
808 ia.l2_plen = 0x2d;
809 ia.proto_discr = GSM48_PDISC_RR;
810 ia.msg_type = GSM48_MT_RR_IMM_ASS;
Harald Welte2d5b6382008-12-27 19:46:06 +0000811 ia.page_mode = GSM48_PM_SAME;
Harald Welte4b634542008-12-27 01:55:51 +0000812 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000813 ia.chan_desc.h0.h = 0;
814 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
815 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
816 ia.chan_desc.h0.tsc = 7;
Harald Welte8470bf22008-12-25 23:28:35 +0000817 /* use request reference extracted from CHAN_RQD */
818 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
819 ia.timing_advance = rqd_ta;
Harald Welte52b1f982008-12-23 20:25:15 +0000820 ia.mob_alloc_len = 0;
821
Harald Welte8f5e2392009-02-03 12:57:37 +0000822 DEBUGP(DRSL, "Activating ARFCN(%u) TS(%u) SS(%u) lctype %s "
823 "chan_nr=0x%02x r=%s\n",
Harald Welteca64da92009-01-04 16:54:12 +0000824 arfcn, ts_number, subch, gsm_lchan_name(lchan->type),
825 ia.chan_desc.chan_nr, gsm_chreq_name(chreq_reason));
Harald Welte75a983f2008-12-27 21:34:06 +0000826
Harald Welte09e38af2009-02-16 22:52:23 +0000827 /* FIXME: Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
Holger Freyther3186bf22008-12-29 06:23:49 +0000828
Harald Welte52b1f982008-12-23 20:25:15 +0000829 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Freyther3186bf22008-12-29 06:23:49 +0000830 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
831
Harald Welte817f3c82008-12-30 14:57:59 +0000832 return ret;
Harald Welte52b1f982008-12-23 20:25:15 +0000833}
834
Harald Welteea280442009-02-02 22:29:56 +0000835/* MS has requested a channel on the RACH */
836static int rsl_rx_ccch_load(struct msgb *msg)
837{
838 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
839 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +0000840 u_int16_t rach_slot_count = -1;
841 u_int16_t rach_busy_count = -1;
842 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +0000843
844 switch (rslh->data[0]) {
845 case RSL_IE_PAGING_LOAD:
846 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Holger Freyther392209c2009-02-10 00:06:19 +0000847 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +0000848 break;
849 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +0000850 if (msg->data_len >= 7) {
851 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
852 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
853 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
854 }
Harald Welteea280442009-02-02 22:29:56 +0000855 break;
856 default:
857 break;
858 }
859
860 return 0;
861}
862
Harald Welte52b1f982008-12-23 20:25:15 +0000863static int abis_rsl_rx_cchan(struct msgb *msg)
864{
Harald Welteea280442009-02-02 22:29:56 +0000865 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +0000866 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +0000867
Harald Welte8470bf22008-12-25 23:28:35 +0000868 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
869
870 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +0000871 case RSL_MT_CHAN_RQD:
872 /* MS has requested a channel on the RACH */
873 rc = rsl_rx_chan_rqd(msg);
874 break;
Harald Welteea280442009-02-02 22:29:56 +0000875 case RSL_MT_CCCH_LOAD_IND:
876 /* current load on the CCCH */
877 rc = rsl_rx_ccch_load(msg);
878 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000879 case RSL_MT_DELETE_IND:
880 /* CCCH overloaded, IMM_ASSIGN was dropped */
881 case RSL_MT_CBCH_LOAD_IND:
882 /* current load on the CBCH */
Harald Welte8f5e2392009-02-03 12:57:37 +0000883 fprintf(stderr, "Unimplemented Abis RSL TRX message type "
884 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000885 break;
886 default:
887 fprintf(stderr, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte8470bf22008-12-25 23:28:35 +0000888 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +0000889 return -EINVAL;
890 }
Harald Welte8470bf22008-12-25 23:28:35 +0000891
892 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000893}
894
Harald Welte4b634542008-12-27 01:55:51 +0000895static int rsl_rx_rll_err_ind(struct msgb *msg)
896{
897 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
898 u_int8_t *rlm_cause = rllh->data;
899
Harald Weltef325eb42009-02-19 17:07:39 +0000900 DEBUGPC(DRLL, "cause=0x%02x", rlm_cause[1]);
Harald Welte4b634542008-12-27 01:55:51 +0000901
902 return 0;
903}
Harald Weltef325eb42009-02-19 17:07:39 +0000904
Harald Welte52b1f982008-12-23 20:25:15 +0000905/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
906 0x02, 0x06,
907 0x01, 0x20,
908 0x02, 0x00,
909 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
910
911static int abis_rsl_rx_rll(struct msgb *msg)
912{
913 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +0000914 int rc = 0;
915 char *ts_name;
Harald Welte8470bf22008-12-25 23:28:35 +0000916
917 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +0000918 ts_name = gsm_ts_name(msg->lchan->ts);
919 DEBUGP(DRLL, "channel=%s chan_nr=0x%02x ", ts_name, rllh->chan_nr);
Harald Welte52b1f982008-12-23 20:25:15 +0000920
921 switch (rllh->c.msg_type) {
922 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000923 DEBUGPC(DRLL, "DATA INDICATION\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000924 /* FIXME: Verify L3 info element */
Harald Welte702d8702008-12-26 20:25:35 +0000925 msg->l3h = &rllh->data[3];
Harald Weltef325eb42009-02-19 17:07:39 +0000926 return gsm0408_rcvmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000927 break;
928 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000929 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000930 /* FIXME: Verify L3 info element */
Harald Welte702d8702008-12-26 20:25:35 +0000931 msg->l3h = &rllh->data[3];
Harald Weltef325eb42009-02-19 17:07:39 +0000932 return gsm0408_rcvmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000933 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000934 case RSL_MT_REL_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000935 DEBUGPC(DRLL, "RELEASE INDICATION ");
Harald Welte2d5b6382008-12-27 19:46:06 +0000936 break;
937 case RSL_MT_REL_CONF:
Harald Weltef325eb42009-02-19 17:07:39 +0000938 DEBUGPC(DRLL, "RELEASE CONFIRMATION ");
Harald Welte4b634542008-12-27 01:55:51 +0000939 break;
940 case RSL_MT_ERROR_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000941 DEBUGPC(DRLL, "ERROR INDICATION ");
Harald Welte4b634542008-12-27 01:55:51 +0000942 rc = rsl_rx_rll_err_ind(msg);
943 break;
Harald Welte52b1f982008-12-23 20:25:15 +0000944 case RSL_MT_UNIT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +0000945 DEBUGPC(DRLL, "unimplemented Abis RLL message type 0x%02x ",
Harald Welte52b1f982008-12-23 20:25:15 +0000946 rllh->c.msg_type);
947 break;
948 default:
Harald Weltef325eb42009-02-19 17:07:39 +0000949 DEBUGPC(DRLL, "unknown Abis RLL message type 0x%02x ",
Harald Welte52b1f982008-12-23 20:25:15 +0000950 rllh->c.msg_type);
951 }
Harald Weltef325eb42009-02-19 17:07:39 +0000952 DEBUGPC(DRLL, "\n");
Harald Welte8470bf22008-12-25 23:28:35 +0000953 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +0000954}
955
Harald Welte75099262009-02-16 21:12:08 +0000956/* ip.access specific RSL extensions */
957int rsl_ipacc_bind(struct gsm_lchan *lchan)
958{
959 struct msgb *msg = rsl_msgb_alloc();
960 struct abis_rsl_dchan_hdr *dh;
961
962 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
963 init_dchan_hdr(dh, RSL_MT_IPAC_BIND);
964 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
965 dh->chan_nr = lchan2chan_nr(lchan);
966
967 msg->trx = lchan->ts->trx;
968
969 return abis_rsl_sendmsg(msg);
970}
971
972int rsl_ipacc_connect(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port, u_int16_t f8, u_int8_t fc)
973{
974 struct msgb *msg = rsl_msgb_alloc();
975 struct abis_rsl_dchan_hdr *dh;
976 u_int8_t *att_f8, *att_ip, *att_port;
977
978 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
979 init_dchan_hdr(dh, RSL_MT_IPAC_CONNECT);
980 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
981 dh->chan_nr = lchan2chan_nr(lchan);
982
983 att_f8 = msgb_put(msg, sizeof(f8)+1);
984 att_f8[0] = 0xf8;
985 att_f8[1] = f8 >> 8;
986 att_f8[2] = f8 & 0xff;
987
988 att_ip = msgb_put(msg, sizeof(ip)+1);
989 att_ip[0] = RSL_IE_IPAC_REMOTE_IP;
990 att_ip[1] = ip >> 24;
991 att_ip[2] = ip >> 16;
992 att_ip[3] = ip >> 8;
993 att_ip[4] = ip & 0xff;
Harald Welteda783762009-02-18 03:29:53 +0000994 //att_ip[4] = 11;
Harald Welte75099262009-02-16 21:12:08 +0000995
996 att_port = msgb_put(msg, sizeof(port)+1);
997 att_port[0] = RSL_IE_IPAC_REMOTE_PORT;
998 att_port[1] = port >> 8;
999 att_port[2] = port & 0xff;
1000
1001 msgb_tv_put(msg, 0xf4, 1); /* F4 01 */
1002 msgb_tv_put(msg, 0xfc, fc); /* FC 7F */
1003 msg->trx = lchan->ts->trx;
1004
1005 return abis_rsl_sendmsg(msg);
1006}
1007
1008static int abis_rsl_rx_ipacc_bindack(struct msgb *msg)
1009{
1010 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1011 struct tlv_parsed tv;
1012 struct gsm_bts_trx_ts *ts = msg->lchan->ts;
Harald Welte167df882009-02-17 14:35:45 +00001013 struct in_addr ip;
Harald Welte75099262009-02-16 21:12:08 +00001014 u_int16_t port, attr_f8;
1015
1016 /* the BTS has acknowledged a local bind, it now tells us the IP
1017 * address and port number to which it has bound the given logical
1018 * channel */
1019
1020 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1021 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1022 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
1023 !TLVP_PRESENT(&tv, 0xfc) ||
1024 !TLVP_PRESENT(&tv, 0xf8)) {
Harald Weltef325eb42009-02-19 17:07:39 +00001025 DEBUGPC(DRSL, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001026 return -EINVAL;
1027 }
Harald Welte167df882009-02-17 14:35:45 +00001028 ip.s_addr = *((u_int32_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte75099262009-02-16 21:12:08 +00001029 port = *((u_int16_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_PORT));
1030 attr_f8 = *((u_int16_t *) TLVP_VAL(&tv, 0xf8));
1031
Harald Weltef325eb42009-02-19 17:07:39 +00001032 DEBUGPC(DRSL, "IP=%s PORT=%d FC=%d F8=%d",
1033 inet_ntoa(ip), ntohs(port), *TLVP_VAL(&tv, 0xfc),
Harald Welte167df882009-02-17 14:35:45 +00001034 ntohs(attr_f8));
1035
Harald Welte75099262009-02-16 21:12:08 +00001036 /* update our local information about this TS */
Harald Welte167df882009-02-17 14:35:45 +00001037 ts->abis_ip.bound_ip = ntohl(ip.s_addr);
1038 ts->abis_ip.bound_port = ntohs(port);
Harald Welte75099262009-02-16 21:12:08 +00001039 ts->abis_ip.attr_f8 = ntohs(attr_f8);
1040 ts->abis_ip.attr_fc = *TLVP_VAL(&tv, 0xfc);
1041
Harald Welte167df882009-02-17 14:35:45 +00001042 dispatch_signal(SS_ABISIP, S_ABISIP_BIND_ACK, msg->lchan);
1043
Harald Welte75099262009-02-16 21:12:08 +00001044 return 0;
1045}
1046
1047static int abis_rsl_rx_ipacc_disc_ind(struct msgb *msg)
1048{
1049 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1050 struct tlv_parsed tv;
1051
1052 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1053 if (!TLVP_PRESENT(&tv, RSL_IE_CAUSE)) {
1054 DEBUGP(DRSL, "mandatory IE missing\n");
1055 return -EINVAL;
1056 }
1057
Harald Weltec1697102009-02-22 18:18:12 +00001058 DEBUGP(DRSL, "cause=0x%02x\n", *TLVP_VAL(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001059
1060 return 0;
1061}
1062
1063static int abis_rsl_rx_ipacc(struct msgb *msg)
1064{
1065 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1066 int rc = 0;
1067
1068 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +00001069 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ",
1070 gsm_ts_name(msg->lchan->ts), rllh->chan_nr);
Harald Welte75099262009-02-16 21:12:08 +00001071
1072 switch (rllh->c.msg_type) {
1073 case RSL_MT_IPAC_BIND_ACK:
Harald Weltef325eb42009-02-19 17:07:39 +00001074 DEBUGP(DRSL, "IPAC_BIND_ACK ");
Harald Welte75099262009-02-16 21:12:08 +00001075 rc = abis_rsl_rx_ipacc_bindack(msg);
1076 break;
1077 case RSL_MT_IPAC_BIND_NACK:
1078 /* somehow the BTS was unable to bind the lchan to its local
1079 * port?!? */
Harald Weltef325eb42009-02-19 17:07:39 +00001080 DEBUGPC(DRSL, "IPAC_BIND_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001081 break;
1082 case RSL_MT_IPAC_CONNECT_ACK:
1083 /* the BTS tells us that a connect operation was successful */
Harald Weltef325eb42009-02-19 17:07:39 +00001084 DEBUGPC(DRSL, "IPAC_CONNECT_ACK ");
Harald Welte75099262009-02-16 21:12:08 +00001085 break;
1086 case RSL_MT_IPAC_CONNECT_NACK:
1087 /* somehow the BTS was unable to connect the lchan to a remote
1088 * port */
Harald Weltef325eb42009-02-19 17:07:39 +00001089 DEBUGPC(DRSL, "IPAC_CONNECT_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001090 break;
1091 case RSL_MT_IPAC_DISCONNECT_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001092 DEBUGPC(DRSL, "IPAC_DISCONNECT_IND ");
Harald Welte75099262009-02-16 21:12:08 +00001093 rc = abis_rsl_rx_ipacc_disc_ind(msg);
1094 break;
1095 default:
Harald Weltef325eb42009-02-19 17:07:39 +00001096 DEBUGPC(DRSL, "Unknown ip.access msg_type 0x%02x", rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001097 break;
1098 }
Harald Weltef325eb42009-02-19 17:07:39 +00001099 DEBUGP(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001100
1101 return rc;
1102}
1103
1104
Harald Welte52b1f982008-12-23 20:25:15 +00001105/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001106int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001107{
1108 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
Harald Welte8f5e2392009-02-03 12:57:37 +00001109 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001110
1111 switch (rslh->msg_discr & 0xfe) {
1112 case ABIS_RSL_MDISC_RLL:
1113 rc = abis_rsl_rx_rll(msg);
1114 break;
1115 case ABIS_RSL_MDISC_DED_CHAN:
1116 rc = abis_rsl_rx_dchan(msg);
1117 break;
1118 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001119 rc = abis_rsl_rx_cchan(msg);
1120 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001121 case ABIS_RSL_MDISC_TRX:
1122 rc = abis_rsl_rx_trx(msg);
1123 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001124 case ABIS_RSL_MDISC_LOC:
Harald Welte8f5e2392009-02-03 12:57:37 +00001125 fprintf(stderr, "unimplemented RSL msg disc 0x%02x\n",
1126 rslh->msg_discr);
1127 break;
Harald Welte75099262009-02-16 21:12:08 +00001128 case ABIS_RSL_MDISC_IPACCESS:
1129 rc = abis_rsl_rx_ipacc(msg);
1130 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001131 default:
1132 fprintf(stderr, "unknown RSL message discriminator 0x%02x\n",
1133 rslh->msg_discr);
1134 return -EINVAL;
1135 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001136 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001137 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001138}
Holger Freyther3b72a892009-02-04 00:31:39 +00001139
1140
1141/* Section 3.3.2.3 . I think this looks like a table */
1142int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1143{
1144 switch (ccch_conf) {
1145 case RSL_BCCH_CCCH_CONF_1_NC:
1146 return 1;
1147 case RSL_BCCH_CCCH_CONF_1_C:
1148 return 1;
1149 case RSL_BCCH_CCCH_CONF_2_NC:
1150 return 2;
1151 case RSL_BCCH_CCCH_CONF_3_NC:
1152 return 3;
1153 case RSL_BCCH_CCCH_CONF_4_NC:
1154 return 4;
1155 default:
1156 return -1;
1157 }
1158}
1159
1160int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1161{
1162 switch (ccch_conf) {
1163 case RSL_BCCH_CCCH_CONF_1_NC:
1164 return 0;
1165 case RSL_BCCH_CCCH_CONF_1_C:
1166 return 1;
1167 case RSL_BCCH_CCCH_CONF_2_NC:
1168 return 0;
1169 case RSL_BCCH_CCCH_CONF_3_NC:
1170 return 0;
1171 case RSL_BCCH_CCCH_CONF_4_NC:
1172 return 0;
1173 default:
1174 return -1;
1175 }
1176}
1177
1178/* From Table 10.5.33 of GSM 04.08 */
1179int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1180{
1181 if (bts->chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1182 return MAX(1, (3 - bts->chan_desc.bs_ag_blks_res))
Holger Freyther3aa8d6c2009-02-04 02:14:45 +00001183 * (bts->chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001184 } else {
1185 return (9 - bts->chan_desc.bs_ag_blks_res)
Holger Freyther3aa8d6c2009-02-04 02:14:45 +00001186 * (bts->chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001187 }
1188}