blob: 743dc5f2be99c0a120bcd450ed0e8f80af855a5f [file] [log] [blame]
Harald Welte59b04682009-06-10 05:40:52 +08001/* 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
4/* (C) 2008-2009 by Harald Welte <laforge@gnumonks.org>
5 *
6 * 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>
25#include <stdlib.h>
26#include <errno.h>
27#include <sys/types.h>
28#include <netinet/in.h>
29#include <arpa/inet.h>
30
31#include <openbsc/gsm_data.h>
32#include <openbsc/gsm_04_08.h>
Harald Weltec4dcda02009-08-09 14:45:18 +020033#include <openbsc/gsm_utils.h>
Harald Welte59b04682009-06-10 05:40:52 +080034#include <openbsc/abis_rsl.h>
35#include <openbsc/chan_alloc.h>
Harald Welteed9a5ab2009-08-09 13:47:35 +020036#include <openbsc/bsc_rll.h>
Harald Welte59b04682009-06-10 05:40:52 +080037#include <openbsc/debug.h>
38#include <openbsc/tlv.h>
39#include <openbsc/paging.h>
40#include <openbsc/signal.h>
Harald Weltec20bd1d2009-11-29 19:07:28 +010041#include <openbsc/meas_rep.h>
Harald Welte59b04682009-06-10 05:40:52 +080042
43#define RSL_ALLOC_SIZE 1024
44#define RSL_ALLOC_HEADROOM 128
45
46#define MAX(a, b) (a) >= (b) ? (a) : (b)
47
48static const struct tlv_definition rsl_att_tlvdef = {
49 .def = {
50 [RSL_IE_CHAN_NR] = { TLV_TYPE_TV },
51 [RSL_IE_LINK_IDENT] = { TLV_TYPE_TV },
52 [RSL_IE_ACT_TYPE] = { TLV_TYPE_TV },
53 [RSL_IE_BS_POWER] = { TLV_TYPE_TV },
54 [RSL_IE_CHAN_IDENT] = { TLV_TYPE_TLV },
55 [RSL_IE_CHAN_MODE] = { TLV_TYPE_TLV },
56 [RSL_IE_ENCR_INFO] = { TLV_TYPE_TLV },
57 [RSL_IE_FRAME_NUMBER] = { TLV_TYPE_FIXED, 2 },
58 [RSL_IE_HANDO_REF] = { TLV_TYPE_TV },
59 [RSL_IE_L1_INFO] = { TLV_TYPE_FIXED, 2 },
60 [RSL_IE_L3_INFO] = { TLV_TYPE_TL16V },
61 [RSL_IE_MS_IDENTITY] = { TLV_TYPE_TLV },
62 [RSL_IE_MS_POWER] = { TLV_TYPE_TV },
63 [RSL_IE_PAGING_GROUP] = { TLV_TYPE_TV },
64 [RSL_IE_PAGING_LOAD] = { TLV_TYPE_FIXED, 2 },
65 [RSL_IE_PYHS_CONTEXT] = { TLV_TYPE_TLV },
66 [RSL_IE_ACCESS_DELAY] = { TLV_TYPE_TV },
67 [RSL_IE_RACH_LOAD] = { TLV_TYPE_TLV },
68 [RSL_IE_REQ_REFERENCE] = { TLV_TYPE_FIXED, 3 },
69 [RSL_IE_RELEASE_MODE] = { TLV_TYPE_TV },
70 [RSL_IE_RESOURCE_INFO] = { TLV_TYPE_TLV },
71 [RSL_IE_RLM_CAUSE] = { TLV_TYPE_TLV },
72 [RSL_IE_STARTNG_TIME] = { TLV_TYPE_FIXED, 2 },
73 [RSL_IE_TIMING_ADVANCE] = { TLV_TYPE_TV },
74 [RSL_IE_UPLINK_MEAS] = { TLV_TYPE_TLV },
75 [RSL_IE_CAUSE] = { TLV_TYPE_TLV },
76 [RSL_IE_MEAS_RES_NR] = { TLV_TYPE_TV },
77 [RSL_IE_MSG_ID] = { TLV_TYPE_TV },
78 [RSL_IE_SYSINFO_TYPE] = { TLV_TYPE_TV },
79 [RSL_IE_MS_POWER_PARAM] = { TLV_TYPE_TLV },
80 [RSL_IE_BS_POWER_PARAM] = { TLV_TYPE_TLV },
81 [RSL_IE_PREPROC_PARAM] = { TLV_TYPE_TLV },
82 [RSL_IE_PREPROC_MEAS] = { TLV_TYPE_TLV },
83 [RSL_IE_IMM_ASS_INFO] = { TLV_TYPE_TLV },
84 [RSL_IE_SMSCB_INFO] = { TLV_TYPE_FIXED, 23 },
85 [RSL_IE_MS_TIMING_OFFSET] = { TLV_TYPE_TV },
86 [RSL_IE_ERR_MSG] = { TLV_TYPE_TLV },
87 [RSL_IE_FULL_BCCH_INFO] = { TLV_TYPE_TLV },
88 [RSL_IE_CHAN_NEEDED] = { TLV_TYPE_TV },
89 [RSL_IE_CB_CMD_TYPE] = { TLV_TYPE_TV },
90 [RSL_IE_SMSCB_MSG] = { TLV_TYPE_TLV },
91 [RSL_IE_FULL_IMM_ASS_INFO] = { TLV_TYPE_TLV },
92 [RSL_IE_SACCH_INFO] = { TLV_TYPE_TLV },
93 [RSL_IE_CBCH_LOAD_INFO] = { TLV_TYPE_TV },
94 [RSL_IE_SMSCB_CHAN_INDICATOR] = { TLV_TYPE_TV },
95 [RSL_IE_GROUP_CALL_REF] = { TLV_TYPE_TLV },
96 [RSL_IE_CHAN_DESC] = { TLV_TYPE_TLV },
97 [RSL_IE_NCH_DRX_INFO] = { TLV_TYPE_TLV },
98 [RSL_IE_CMD_INDICATOR] = { TLV_TYPE_TLV },
99 [RSL_IE_EMLPP_PRIO] = { TLV_TYPE_TV },
100 [RSL_IE_UIC] = { TLV_TYPE_TLV },
101 [RSL_IE_MAIN_CHAN_REF] = { TLV_TYPE_TV },
102 [RSL_IE_MR_CONFIG] = { TLV_TYPE_TLV },
103 [RSL_IE_MR_CONTROL] = { TLV_TYPE_TV },
104 [RSL_IE_SUP_CODEC_TYPES] = { TLV_TYPE_TLV },
105 [RSL_IE_CODEC_CONFIG] = { TLV_TYPE_TLV },
106 [RSL_IE_RTD] = { TLV_TYPE_TV },
107 [RSL_IE_TFO_STATUS] = { TLV_TYPE_TV },
108 [RSL_IE_LLP_APDU] = { TLV_TYPE_TLV },
Harald Welte4684e632009-08-10 09:51:40 +0200109 [RSL_IE_SIEMENS_MRPCI] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200110 [RSL_IE_IPAC_PROXY_UDP] = { TLV_TYPE_FIXED, 2 },
111 [RSL_IE_IPAC_BSCMPL_TOUT] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800112 [RSL_IE_IPAC_REMOTE_IP] = { TLV_TYPE_FIXED, 4 },
113 [RSL_IE_IPAC_REMOTE_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welte1610d302009-07-12 09:56:39 +0200114 [RSL_IE_IPAC_RTP_PAYLOAD] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800115 [RSL_IE_IPAC_LOCAL_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welteb9498952009-07-12 09:45:05 +0200116 [RSL_IE_IPAC_SPEECH_MODE] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200117 [RSL_IE_IPAC_LOCAL_IP] = { TLV_TYPE_FIXED, 4 },
Harald Welteb9498952009-07-12 09:45:05 +0200118 [RSL_IE_IPAC_CONN_ID] = { TLV_TYPE_FIXED, 2 },
Harald Welte1610d302009-07-12 09:56:39 +0200119 [RSL_IE_IPAC_RTP_CSD_FMT] = { TLV_TYPE_TV },
120 [RSL_IE_IPAC_RTP_JIT_BUF] = { TLV_TYPE_FIXED, 2 },
121 [RSL_IE_IPAC_RTP_COMPR] = { TLV_TYPE_TV },
Harald Welteb9498952009-07-12 09:45:05 +0200122 [RSL_IE_IPAC_RTP_PAYLOAD2] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200123 [RSL_IE_IPAC_RTP_MPLEX] = { TLV_TYPE_FIXED, 8 },
124 [RSL_IE_IPAC_RTP_MPLEX_ID] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800125 },
126};
127#define rsl_tlv_parse(dec, buf, len) \
128 tlv_parse(dec, &rsl_att_tlvdef, buf, len, 0, 0)
129
130static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
131{
132 /* mask off the transparent bit ? */
133 msg_type &= 0xfe;
134
135 if ((msg_type & 0xf0) == 0x00)
136 return ABIS_RSL_MDISC_RLL;
137 if ((msg_type & 0xf0) == 0x10) {
138 if (msg_type >= 0x19 && msg_type <= 0x22)
139 return ABIS_RSL_MDISC_TRX;
140 else
141 return ABIS_RSL_MDISC_COM_CHAN;
142 }
143 if ((msg_type & 0xe0) == 0x20)
144 return ABIS_RSL_MDISC_DED_CHAN;
145
146 return ABIS_RSL_MDISC_LOC;
147}
148
149static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
150 u_int8_t msg_type)
151{
152 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
153 dh->c.msg_type = msg_type;
154 dh->ie_chan = RSL_IE_CHAN_NR;
155}
156
157static inline void init_llm_hdr(struct abis_rsl_rll_hdr *dh,
158 u_int8_t msg_type)
159{
160 /* dh->c.msg_discr = mdisc_by_msgtype(msg_type); */
161 dh->c.msg_discr = ABIS_RSL_MDISC_RLL;
162 dh->c.msg_type = msg_type;
163 dh->ie_chan = RSL_IE_CHAN_NR;
164 dh->ie_link_id = RSL_IE_LINK_IDENT;
165}
166
167
168/* encode channel number as per Section 9.3.1 */
169u_int8_t rsl_enc_chan_nr(u_int8_t type, u_int8_t subch, u_int8_t timeslot)
170{
171 u_int8_t ret;
172
173 ret = (timeslot & 0x07) | type;
174
175 switch (type) {
176 case RSL_CHAN_Lm_ACCHs:
177 subch &= 0x01;
178 break;
179 case RSL_CHAN_SDCCH4_ACCH:
180 subch &= 0x07;
181 break;
182 case RSL_CHAN_SDCCH8_ACCH:
183 subch &= 0x07;
184 break;
185 default:
186 /* no subchannels allowed */
187 subch = 0x00;
188 break;
189 }
190 ret |= (subch << 3);
191
192 return ret;
193}
194
195/* determine logical channel based on TRX and channel number IE */
196struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
197{
198 struct gsm_lchan *lchan;
199 u_int8_t ts_nr = chan_nr & 0x07;
200 u_int8_t cbits = chan_nr >> 3;
201 u_int8_t lch_idx;
202 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
203
204 if (cbits == 0x01) {
205 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +0200206 if (ts->pchan != GSM_PCHAN_TCH_F &&
207 ts->pchan != GSM_PCHAN_PDCH &&
208 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Welte59b04682009-06-10 05:40:52 +0800209 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
210 chan_nr, ts->pchan);
211 } else if ((cbits & 0x1e) == 0x02) {
212 lch_idx = cbits & 0x1; /* TCH/H */
213 if (ts->pchan != GSM_PCHAN_TCH_H)
214 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
215 chan_nr, ts->pchan);
216 } else if ((cbits & 0x1c) == 0x04) {
217 lch_idx = cbits & 0x3; /* SDCCH/4 */
218 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
219 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
220 chan_nr, ts->pchan);
221 } else if ((cbits & 0x18) == 0x08) {
222 lch_idx = cbits & 0x7; /* SDCCH/8 */
223 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
224 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
225 chan_nr, ts->pchan);
226 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
227 lch_idx = 0;
228 if (ts->pchan != GSM_PCHAN_CCCH &&
229 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
230 fprintf(stderr, "chan_nr=0x%02x but pchan=%u\n",
231 chan_nr, ts->pchan);
232 /* FIXME: we should not return first sdcch4 !!! */
233 } else {
234 fprintf(stderr, "unknown chan_nr=0x%02x\n", chan_nr);
235 return NULL;
236 }
237
238 lchan = &ts->lchan[lch_idx];
239
240 return lchan;
241}
242
Holger Hans Peter Freyther942ff172009-10-22 11:47:45 +0200243/* See Table 10.5.25 of GSM04.08 */
Harald Welte59b04682009-06-10 05:40:52 +0800244u_int8_t lchan2chan_nr(struct gsm_lchan *lchan)
245{
246 struct gsm_bts_trx_ts *ts = lchan->ts;
247 u_int8_t cbits, chan_nr;
248
249 switch (ts->pchan) {
250 case GSM_PCHAN_TCH_F:
Harald Welte37884ed2009-10-24 10:25:50 +0200251 case GSM_PCHAN_PDCH:
252 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte59b04682009-06-10 05:40:52 +0800253 cbits = 0x01;
254 break;
255 case GSM_PCHAN_TCH_H:
256 cbits = 0x02;
257 cbits += lchan->nr;
258 break;
259 case GSM_PCHAN_CCCH_SDCCH4:
260 cbits = 0x04;
261 cbits += lchan->nr;
262 break;
263 case GSM_PCHAN_SDCCH8_SACCH8C:
264 cbits = 0x08;
265 cbits += lchan->nr;
266 break;
267 default:
268 case GSM_PCHAN_CCCH:
269 cbits = 0x10;
270 break;
271 }
272
273 chan_nr = (cbits << 3) | (ts->nr & 0x7);
274
275 return chan_nr;
276}
277
278/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
279u_int64_t str_to_imsi(const char *imsi_str)
280{
281 u_int64_t ret;
282
283 ret = strtoull(imsi_str, NULL, 10);
284
285 return ret;
286}
287
288/* Table 5 Clause 7 TS 05.02 */
289unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
290{
291 if (!bs_ccch_sdcch_comb)
292 return 9 - bs_ag_blks_res;
293 else
294 return 3 - bs_ag_blks_res;
295}
296
297/* Chapter 6.5.2 of TS 05.02 */
298unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
299 unsigned int n_pag_blocks)
300{
301 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
302}
303
304/* Chapter 6.5.2 of TS 05.02 */
305unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
306 int n_pag_blocks)
307{
308 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
309}
310
311static struct msgb *rsl_msgb_alloc(void)
312{
Harald Welte9cfc9352009-06-26 19:39:35 +0200313 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
314 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800315}
316
317#define MACBLOCK_SIZE 23
318static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
319{
320 memcpy(out, in, len);
321
322 if (len < MACBLOCK_SIZE)
323 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
324}
325
Harald Welted2dd9de2009-08-30 15:37:11 +0900326/* Chapter 9.3.7: Encryption Information */
327static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
328{
329 *out++ = lchan->encr.alg_id & 0xff;
330 if (lchan->encr.key_len)
331 memcpy(out, lchan->encr.key, lchan->encr.key_len);
332 return lchan->encr.key_len + 1;
333}
334
335
Harald Weltef1a168d2009-07-28 17:58:09 +0200336static const char *rsl_err_vals[0xff] = {
337 [RSL_ERR_RADIO_IF_FAIL] = "Radio Interface Failure",
338 [RSL_ERR_RADIO_LINK_FAIL] = "Radio Link Failure",
339 [RSL_ERR_HANDOVER_ACC_FAIL] = "Handover Access Failure",
340 [RSL_ERR_TALKER_ACC_FAIL] = "Talker Access Failure",
341 [RSL_ERR_OM_INTERVENTION] = "O&M Intervention",
342 [RSL_ERR_NORMAL_UNSPEC] = "Normal event, unspecified",
Harald Welteb1717e92009-08-04 02:31:05 +0200343 [RSL_ERR_T_MSRFPCI_EXP] = "Siemens: T_MSRFPCI Expired",
Harald Weltef1a168d2009-07-28 17:58:09 +0200344 [RSL_ERR_EQUIPMENT_FAIL] = "Equipment Failure",
345 [RSL_ERR_RR_UNAVAIL] = "Radio Resource not available",
346 [RSL_ERR_TERR_CH_FAIL] = "Terrestrial Channel Failure",
347 [RSL_ERR_CCCH_OVERLOAD] = "CCCH Overload",
348 [RSL_ERR_ACCH_OVERLOAD] = "ACCH Overload",
349 [RSL_ERR_PROCESSOR_OVERLOAD] = "Processor Overload",
350 [RSL_ERR_RES_UNAVAIL] = "Resource not available, unspecified",
351 [RSL_ERR_TRANSC_UNAVAIL] = "Transcoding not available",
352 [RSL_ERR_SERV_OPT_UNAVAIL] = "Service or Option not available",
353 [RSL_ERR_ENCR_UNIMPL] = "Encryption algorithm not implemented",
354 [RSL_ERR_SERV_OPT_UNIMPL] = "Service or Option not implemented",
355 [RSL_ERR_RCH_ALR_ACTV_ALLOC] = "Radio channel already activated",
356 [RSL_ERR_INVALID_MESSAGE] = "Invalid Message, unspecified",
357 [RSL_ERR_MSG_DISCR] = "Message Discriminator Error",
358 [RSL_ERR_MSG_TYPE] = "Message Type Error",
359 [RSL_ERR_MSG_SEQ] = "Message Sequence Error",
360 [RSL_ERR_IE_ERROR] = "General IE error",
361 [RSL_ERR_MAND_IE_ERROR] = "Mandatory IE error",
362 [RSL_ERR_OPT_IE_ERROR] = "Optional IE error",
363 [RSL_ERR_IE_NONEXIST] = "IE non-existent",
364 [RSL_ERR_IE_LENGTH] = "IE length error",
365 [RSL_ERR_IE_CONTENT] = "IE content error",
366 [RSL_ERR_PROTO] = "Protocol error, unspecified",
367 [RSL_ERR_INTERWORKING] = "Interworking error, unspecified",
368};
369
370static const char *rsl_err_name(u_int8_t err)
Harald Welte59b04682009-06-10 05:40:52 +0800371{
Harald Weltef1a168d2009-07-28 17:58:09 +0200372 if (rsl_err_vals[err])
373 return rsl_err_vals[err];
374 else
375 return "unknown";
376}
377
378static void print_rsl_cause(const u_int8_t *cause_v, u_int8_t cause_len)
379{
Harald Welte59b04682009-06-10 05:40:52 +0800380 int i;
381
Harald Weltef1a168d2009-07-28 17:58:09 +0200382 DEBUGPC(DRSL, "CAUSE=0x%02x(%s) ",
383 cause_v[0], rsl_err_name(cause_v[0]));
384 for (i = 1; i < cause_len-1; i++)
385 DEBUGPC(DRSL, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800386}
387
388/* Send a BCCH_INFO message as per Chapter 8.5.1 */
389int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
390 const u_int8_t *data, int len)
391{
392 struct abis_rsl_dchan_hdr *dh;
393 struct msgb *msg = rsl_msgb_alloc();
394
395 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
396 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
397 dh->chan_nr = RSL_CHAN_BCCH;
398
399 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
400 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
401
402 msg->trx = trx;
403
404 return abis_rsl_sendmsg(msg);
405}
406
407int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
408 const u_int8_t *data, int len)
409{
410 struct abis_rsl_common_hdr *ch;
411 struct msgb *msg = rsl_msgb_alloc();
412
413 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
414 ch->msg_discr = ABIS_RSL_MDISC_TRX;
415 ch->msg_type = RSL_MT_SACCH_FILL;
416
417 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
418 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
419
420 msg->trx = trx;
421
422 return abis_rsl_sendmsg(msg);
423}
424
Harald Welte91afe4c2009-06-20 18:15:19 +0200425int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
426{
427 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200428 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200429 u_int8_t chan_nr = lchan2chan_nr(lchan);
430
431 db = abs(db);
432 if (db > 30)
433 return -EINVAL;
434
Harald Welteed831842009-06-27 03:09:08 +0200435 msg = rsl_msgb_alloc();
436
Harald Welte91afe4c2009-06-20 18:15:19 +0200437 lchan->bs_power = db/2;
438 if (fpc)
439 lchan->bs_power |= 0x10;
440
441 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
442 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
443 dh->chan_nr = chan_nr;
444
445 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
446
447 msg->trx = lchan->ts->trx;
448
449 return abis_rsl_sendmsg(msg);
450}
451
Harald Welte91afe4c2009-06-20 18:15:19 +0200452int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
453{
454 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200455 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200456 u_int8_t chan_nr = lchan2chan_nr(lchan);
457 int ctl_lvl;
458
Harald Weltec4dcda02009-08-09 14:45:18 +0200459 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200460 if (ctl_lvl < 0)
461 return ctl_lvl;
462
Harald Welteed831842009-06-27 03:09:08 +0200463 msg = rsl_msgb_alloc();
464
Harald Welte91afe4c2009-06-20 18:15:19 +0200465 lchan->ms_power = ctl_lvl;
466
467 if (fpc)
468 lchan->ms_power |= 0x20;
469
470 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
471 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
472 dh->chan_nr = chan_nr;
473
474 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
475
476 msg->trx = lchan->ts->trx;
477
478 return abis_rsl_sendmsg(msg);
479}
480
Harald Welte39274f42009-07-29 15:41:29 +0200481static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
482 struct gsm_lchan *lchan)
483{
484 memset(cm, 0, sizeof(cm));
485
486 /* FIXME: what to do with data calls ? */
487 cm->dtx_dtu = 0x00;
488
489 /* set TCH Speech/Data */
490 cm->spd_ind = lchan->rsl_cmode;
491
Harald Welte951e3512009-11-27 08:55:16 +0100492 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
493 lchan->tch_mode != GSM48_CMODE_SIGN)
494 DEBUGP(DRSL, "unsupported: rsl_mode == signalling, "
495 "but tch_mode != signalling\n");
496
Harald Welte39274f42009-07-29 15:41:29 +0200497 switch (lchan->type) {
498 case GSM_LCHAN_SDCCH:
499 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
500 break;
501 case GSM_LCHAN_TCH_F:
502 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
503 break;
504 case GSM_LCHAN_TCH_H:
505 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
506 break;
507 case GSM_LCHAN_NONE:
508 case GSM_LCHAN_UNKNOWN:
509 default:
510 return -EINVAL;
511 }
512
513 switch (lchan->tch_mode) {
514 case GSM48_CMODE_SIGN:
515 cm->chan_rate = 0;
516 break;
517 case GSM48_CMODE_SPEECH_V1:
518 cm->chan_rate = RSL_CMOD_SP_GSM1;
519 break;
520 case GSM48_CMODE_SPEECH_EFR:
521 cm->chan_rate = RSL_CMOD_SP_GSM2;
522 break;
523 case GSM48_CMODE_SPEECH_AMR:
524 cm->chan_rate = RSL_CMOD_SP_GSM3;
525 break;
526 case GSM48_CMODE_DATA_14k5:
527 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
528 break;
529 case GSM48_CMODE_DATA_12k0:
530 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
531 break;
532 case GSM48_CMODE_DATA_6k0:
533 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
534 break;
535 default:
536 return -EINVAL;
537 }
538
539 return 0;
540}
541
Harald Welte59b04682009-06-10 05:40:52 +0800542/* Chapter 8.4.1 */
543#if 0
544int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
545 u_int8_t act_type,
546 struct rsl_ie_chan_mode *chan_mode,
547 struct rsl_ie_chan_ident *chan_ident,
548 u_int8_t bs_power, u_int8_t ms_power,
549 u_int8_t ta)
550{
551 struct abis_rsl_dchan_hdr *dh;
552 struct msgb *msg = rsl_msgb_alloc();
553
554 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
555 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
556 dh->chan_nr = chan_nr;
557
558 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
559 /* For compatibility with Phase 1 */
560 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
561 (u_int8_t *) chan_mode);
562 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
563 (u_int8_t *) chan_ident);
564#if 0
565 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
566 (u_int8_t *) &encr_info);
567#endif
568 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
569 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
570 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
571
572 msg->trx = trx;
573
574 return abis_rsl_sendmsg(msg);
575}
576#endif
577
578int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte39274f42009-07-29 15:41:29 +0200579 u_int8_t ta)
Harald Welte59b04682009-06-10 05:40:52 +0800580{
581 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200582 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200583 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800584
585 u_int8_t chan_nr = lchan2chan_nr(lchan);
586 u_int16_t arfcn = lchan->ts->trx->arfcn;
587 struct rsl_ie_chan_mode cm;
588 struct rsl_ie_chan_ident ci;
589
Harald Welte39274f42009-07-29 15:41:29 +0200590 rc = channel_mode_from_lchan(&cm, lchan);
591 if (rc < 0)
592 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800593
594 memset(&ci, 0, sizeof(ci));
595 ci.chan_desc.iei = 0x64;
596 ci.chan_desc.chan_nr = chan_nr;
597 ci.chan_desc.oct3 = (lchan->ts->trx->bts->tsc << 5) | ((arfcn & 0x3ff) >> 8);
598 ci.chan_desc.oct4 = arfcn & 0xff;
599
Harald Welteed831842009-06-27 03:09:08 +0200600 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800601 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
602 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
603 dh->chan_nr = chan_nr;
604
605 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
606 /* For compatibility with Phase 1 */
607 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
608 (u_int8_t *) &cm);
609 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
610 (u_int8_t *) &ci);
Harald Welted2dd9de2009-08-30 15:37:11 +0900611
612 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
613 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
614 rc = build_encr_info(encr_info, lchan);
615 if (rc > 0)
616 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
617 }
618
Harald Welte59b04682009-06-10 05:40:52 +0800619 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
620 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
621 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
622
623 msg->trx = lchan->ts->trx;
624
625 return abis_rsl_sendmsg(msg);
626}
627
Harald Welte8e770492009-07-29 11:38:15 +0200628/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800629int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
630{
631 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200632 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200633 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800634
635 u_int8_t chan_nr = lchan2chan_nr(lchan);
636 struct rsl_ie_chan_mode cm;
637
Harald Welte39274f42009-07-29 15:41:29 +0200638 rc = channel_mode_from_lchan(&cm, lchan);
639 if (rc < 0)
640 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800641
Harald Welteed831842009-06-27 03:09:08 +0200642 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800643 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
644 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
645 dh->chan_nr = chan_nr;
646
647 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
648 (u_int8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900649
650 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
651 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
652 rc = build_encr_info(encr_info, lchan);
653 if (rc > 0)
654 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
655 }
656
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100657 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
658 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
659 (u_int8_t *) &lchan->mr_conf);
660 }
661
Harald Welted2dd9de2009-08-30 15:37:11 +0900662 msg->trx = lchan->ts->trx;
663
664 return abis_rsl_sendmsg(msg);
665}
666
667/* Chapter 8.4.6: Send the encryption command with given L3 info */
668int rsl_encryption_cmd(struct msgb *msg)
669{
670 struct abis_rsl_dchan_hdr *dh;
671 struct gsm_lchan *lchan = msg->lchan;
672 u_int8_t chan_nr = lchan2chan_nr(lchan);
673 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut01f1caf2009-09-27 11:13:18 +0200674 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900675 int rc;
676
677 /* First push the L3 IE tag and length */
678 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
679
680 /* then the link identifier (SAPI0, main sign link) */
681 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
682
683 /* then encryption information */
684 rc = build_encr_info(encr_info, lchan);
685 if (rc <= 0)
686 return rc;
687 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
688
689 /* and finally the DCHAN header */
690 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
691 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
692 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800693
694 msg->trx = lchan->ts->trx;
695
696 return abis_rsl_sendmsg(msg);
697}
698
Harald Welte85a163c2009-08-10 11:43:22 +0200699/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200700int rsl_deact_sacch(struct gsm_lchan *lchan)
701{
702 struct abis_rsl_dchan_hdr *dh;
703 struct msgb *msg = rsl_msgb_alloc();
704
705 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
706 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
707 dh->chan_nr = lchan2chan_nr(lchan);
708
709 msg->lchan = lchan;
710 msg->trx = lchan->ts->trx;
711
712 DEBUGP(DRSL, "DEACTivate SACCH CMD channel=%s chan_nr=0x%02x\n",
713 gsm_ts_name(lchan->ts), dh->chan_nr);
714
715 return abis_rsl_sendmsg(msg);
716}
717
Harald Welte85a163c2009-08-10 11:43:22 +0200718/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
719int rsl_rf_chan_release(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +0800720{
721 struct abis_rsl_dchan_hdr *dh;
722 struct msgb *msg = rsl_msgb_alloc();
723
724 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
725 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
726 dh->chan_nr = lchan2chan_nr(lchan);
727
728 msg->lchan = lchan;
729 msg->trx = lchan->ts->trx;
730
Harald Welte85a163c2009-08-10 11:43:22 +0200731 DEBUGP(DRSL, "RF Channel Release CMD channel=%s chan_nr=0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +0800732 gsm_ts_name(lchan->ts), dh->chan_nr);
733
Harald Welte85a163c2009-08-10 11:43:22 +0200734 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800735 return abis_rsl_sendmsg(msg);
736}
737
738int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
739 u_int8_t *ms_ident, u_int8_t chan_needed)
740{
741 struct abis_rsl_dchan_hdr *dh;
742 struct msgb *msg = rsl_msgb_alloc();
743
744 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
745 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
746 dh->chan_nr = RSL_CHAN_PCH_AGCH;
747
748 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
749 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
750 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
751
752 msg->trx = bts->c0;
753
754 return abis_rsl_sendmsg(msg);
755}
756
757int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
758 struct gsm_subscriber *subscr)
759{
760#if 0
761 u_int8_t mi[128];
762 unsigned int mi_len;
763 u_int8_t paging_group;
764#endif
765
766 return -1;
767}
768
769int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
770{
771 int i, len = strlen(str_in);
772
773 for (i = 0; i < len; i++) {
774 int num = str_in[i] - 0x30;
775 if (num < 0 || num > 9)
776 return -1;
777 if (i % 2 == 0)
778 bcd_out[i/2] = num;
779 else
780 bcd_out[i/2] |= (num << 4);
781 }
782
783 return 0;
784}
785
786/* Chapter 8.5.6 */
787int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
788{
789 struct msgb *msg = rsl_msgb_alloc();
790 struct abis_rsl_dchan_hdr *dh;
791 u_int8_t buf[MACBLOCK_SIZE];
792
793 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
794 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
795 dh->chan_nr = RSL_CHAN_PCH_AGCH;
796
797 switch (bts->type) {
798 case GSM_BTS_TYPE_BS11:
799 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
800 break;
801 default:
802 /* If phase 2, construct a FULL_IMM_ASS_INFO */
803 pad_macblock(buf, val, len);
804 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
805 break;
806 }
807
808 msg->trx = bts->c0;
809
810 return abis_rsl_sendmsg(msg);
811}
812
Harald Welte4684e632009-08-10 09:51:40 +0200813/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200814int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200815{
816 struct msgb *msg = rsl_msgb_alloc();
817 struct abis_rsl_dchan_hdr *dh;
818
819 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
820 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200821 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200822 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200823 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200824
Harald Welte874a5b42009-08-10 11:26:14 +0200825 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x TX Siemens MRPCI 0x%02x\n",
826 gsm_ts_name(lchan->ts), dh->chan_nr, *(u_int8_t *)mrpci);
827
828 msg->trx = lchan->ts->trx;
829
Harald Welte4684e632009-08-10 09:51:40 +0200830 return abis_rsl_sendmsg(msg);
831}
832
833
Harald Welte59b04682009-06-10 05:40:52 +0800834/* Send "DATA REQUEST" message with given L3 Info payload */
835/* Chapter 8.3.1 */
836int rsl_data_request(struct msgb *msg, u_int8_t link_id)
837{
838 u_int8_t l3_len = msg->tail - (u_int8_t *)msgb_l3(msg);
839 struct abis_rsl_rll_hdr *rh;
840
841 if (msg->lchan == NULL) {
842 fprintf(stderr, "cannot send DATA REQUEST to unknown lchan\n");
843 return -EINVAL;
844 }
845
846 /* First push the L3 IE tag and length */
847 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
848
849 /* Then push the RSL header */
850 rh = (struct abis_rsl_rll_hdr *) msgb_push(msg, sizeof(*rh));
851 init_llm_hdr(rh, RSL_MT_DATA_REQ);
852 rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
853 rh->chan_nr = lchan2chan_nr(msg->lchan);
854 rh->link_id = link_id;
855
856 msg->trx = msg->lchan->ts->trx;
857
858 return abis_rsl_sendmsg(msg);
859}
860
Harald Welteed9a5ab2009-08-09 13:47:35 +0200861/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
862/* Chapter 8.3.1 */
863int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
864{
865 struct msgb *msg = rsl_msgb_alloc();
866 struct abis_rsl_rll_hdr *rh;
867
868 rh = (struct abis_rsl_rll_hdr *) msgb_put(msg, sizeof(*rh));
Harald Welte61402172009-08-09 14:13:58 +0200869 init_llm_hdr(rh, RSL_MT_EST_REQ);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200870 //rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
871 rh->chan_nr = lchan2chan_nr(lchan);
872 rh->link_id = link_id;
873
874 msg->trx = lchan->ts->trx;
875
876 return abis_rsl_sendmsg(msg);
877}
878
Harald Welte0f2e3c12009-08-08 13:15:07 +0200879/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
880 This is what higher layers should call. The BTS then responds with
881 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
882 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
883 lchan_free() */
884int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id)
885{
886 struct msgb *msg = rsl_msgb_alloc();
887 struct abis_rsl_rll_hdr *rh;
888
889 rh = (struct abis_rsl_rll_hdr *) msgb_put(msg, sizeof(*rh));
890 init_llm_hdr(rh, RSL_MT_REL_REQ);
891 //rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
892 rh->chan_nr = lchan2chan_nr(lchan);
893 rh->link_id = link_id;
Harald Weltead738562009-08-10 00:19:36 +0200894 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, 0); /* normal release */
Harald Welte0f2e3c12009-08-08 13:15:07 +0200895
896 msg->trx = lchan->ts->trx;
897
898 return abis_rsl_sendmsg(msg);
899}
900
Harald Welte59b04682009-06-10 05:40:52 +0800901/* Chapter 8.4.2: Channel Activate Acknowledge */
902static int rsl_rx_chan_act_ack(struct msgb *msg)
903{
904 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
905
906 /* BTS has confirmed channel activation, we now need
907 * to assign the activated channel to the MS */
908 if (rslh->ie_chan != RSL_IE_CHAN_NR)
909 return -EINVAL;
910
911 return 0;
912}
913
914/* Chapter 8.4.3: Channel Activate NACK */
915static int rsl_rx_chan_act_nack(struct msgb *msg)
916{
917 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
918 struct tlv_parsed tp;
919
920 /* BTS has rejected channel activation ?!? */
921 if (dh->ie_chan != RSL_IE_CHAN_NR)
922 return -EINVAL;
923
924 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
925 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltef1a168d2009-07-28 17:58:09 +0200926 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
927 TLVP_LEN(&tp, RSL_IE_CAUSE));
928
Harald Weltecddb9802009-08-09 19:50:08 +0200929 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800930 return 0;
931}
932
933/* Chapter 8.4.4: Connection Failure Indication */
934static int rsl_rx_conn_fail(struct msgb *msg)
935{
936 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
937 struct tlv_parsed tp;
938
939 DEBUGPC(DRSL, "CONNECTION FAIL: ");
Harald Welte59b04682009-06-10 05:40:52 +0800940
941 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
942
Harald Weltef1a168d2009-07-28 17:58:09 +0200943 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
944 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
945 TLVP_LEN(&tp, RSL_IE_CAUSE));
946
Harald Welte59b04682009-06-10 05:40:52 +0800947 DEBUGPC(DRSL, "RELEASING.\n");
948
949 /* FIXME: only free it after channel release ACK */
Harald Welte85a163c2009-08-10 11:43:22 +0200950 return rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800951}
952
Harald Weltec20bd1d2009-11-29 19:07:28 +0100953static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
954 const char *prefix)
955{
956 DEBUGPC(DMEAS, "RXL-FULL-%s=%d RXL-SUB-%s=%d ",
957 prefix, mru->full.rx_lev, prefix, mru->sub.rx_lev);
958 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
959 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
960}
961
962static void print_meas_rep(struct gsm_meas_rep *mr)
963{
964 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
965
966 if (mr->flags & MEAS_REP_F_DL_DTX)
967 DEBUGPC(DMEAS, "DTXd ");
968
969 print_meas_rep_uni(&mr->ul, "ul");
970 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
971 if (mr->flags & MEAS_REP_F_MS_TO)
972 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
973
974 if (mr->flags & MEAS_REP_F_MS_L1) {
975 DEBUGPC(DMEAS, "L1_MS_PWR=%ddBm ", mr->ms_l1.pwr);
976 DEBUGPC(DMEAS, "L1_FPC=%u ",
977 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
978 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
979 }
980
981 if (mr->flags & MEAS_REP_F_UL_DTX)
982 DEBUGPC(DMEAS, "DTXu ");
983 if (mr->flags & MEAS_REP_F_BA1)
984 DEBUGPC(DMEAS, "BA1 ");
985 if (!(mr->flags & MEAS_REP_F_DL_VALID))
986 DEBUGPC(DMEAS, "NOT VALID ");
987 else
988 print_meas_rep_uni(&mr->dl, "dl");
989
990 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
991}
992
Harald Welte59b04682009-06-10 05:40:52 +0800993static int rsl_rx_meas_res(struct msgb *msg)
994{
995 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
996 struct tlv_parsed tp;
Harald Weltec20bd1d2009-11-29 19:07:28 +0100997 struct gsm_meas_rep mr;
998 u_int8_t len;
999 const u_int8_t *val;
1000 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001001
Harald Weltec20bd1d2009-11-29 19:07:28 +01001002 memset(&mr, 0, sizeof(mr));
1003
Harald Welte59b04682009-06-10 05:40:52 +08001004 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1005
Harald Weltec20bd1d2009-11-29 19:07:28 +01001006 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1007 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1008 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1009 return -EIO;
1010
1011 /* Mandatory Parts */
1012 mr.nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
1013
1014 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1015 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1016 if (len >= 3) {
1017 if (val[0] & 0x40)
1018 mr.flags |= MEAS_REP_F_DL_DTX;
1019 mr.ul.full.rx_lev = val[0] & 0x3f;
1020 mr.ul.sub.rx_lev = val[1] & 0x3f;
1021 mr.ul.full.rx_qual = val[2]>>3 & 0x7;
1022 mr.ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001023 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001024
1025 mr.bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
1026
1027 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001028 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltec20bd1d2009-11-29 19:07:28 +01001029 mr.ms_timing_offset =
1030 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1031
Harald Weltea1467eb2009-06-20 18:44:35 +02001032 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001033 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
1034 mr.flags |= MEAS_REP_F_MS_L1;
1035 mr.ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
1036 if (val[0] & 0x04)
1037 mr.flags |= MEAS_REP_F_FPC;
1038 mr.ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001039 }
Harald Welte59b04682009-06-10 05:40:52 +08001040 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001041 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001042 rc = gsm48_parse_meas_rep(&mr, msg);
1043 if (rc < 0)
1044 return rc;
1045 }
1046
1047 /* FIXME: do something with the actual result*/
1048 print_meas_rep(&mr);
Harald Welte59b04682009-06-10 05:40:52 +08001049
1050 return 0;
1051}
1052
1053static int abis_rsl_rx_dchan(struct msgb *msg)
1054{
1055 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1056 int rc = 0;
1057 char *ts_name;
1058
1059 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1060 ts_name = gsm_ts_name(msg->lchan->ts);
1061
Harald Welte02993682009-06-27 02:53:10 +02001062 if (rslh->c.msg_type != RSL_MT_MEAS_RES)
1063 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ", ts_name, rslh->chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +08001064
1065 switch (rslh->c.msg_type) {
1066 case RSL_MT_CHAN_ACTIV_ACK:
1067 DEBUGPC(DRSL, "CHANNEL ACTIVATE ACK\n");
1068 rc = rsl_rx_chan_act_ack(msg);
1069 break;
1070 case RSL_MT_CHAN_ACTIV_NACK:
1071 DEBUGPC(DRSL, "CHANNEL ACTIVATE NACK\n");
1072 rc = rsl_rx_chan_act_nack(msg);
1073 break;
1074 case RSL_MT_CONN_FAIL:
1075 rc = rsl_rx_conn_fail(msg);
1076 break;
1077 case RSL_MT_MEAS_RES:
1078 rc = rsl_rx_meas_res(msg);
1079 break;
1080 case RSL_MT_RF_CHAN_REL_ACK:
1081 DEBUGPC(DRSL, "RF CHANNEL RELEASE ACK\n");
1082 lchan_free(msg->lchan);
1083 break;
1084 case RSL_MT_MODE_MODIFY_ACK:
1085 DEBUGPC(DRSL, "CHANNEL MODE MODIFY ACK\n");
1086 break;
1087 case RSL_MT_MODE_MODIFY_NACK:
1088 DEBUGPC(DRSL, "CHANNEL MODE MODIFY NACK\n");
1089 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001090 case RSL_MT_IPAC_PDCH_ACT_ACK:
1091 DEBUGPC(DRSL, "IPAC PDCH ACT ACK\n");
1092 break;
1093 case RSL_MT_IPAC_PDCH_ACT_NACK:
1094 DEBUGPC(DRSL, "IPAC PDCH ACT NACK\n");
1095 break;
1096 case RSL_MT_IPAC_PDCH_DEACT_ACK:
1097 DEBUGPC(DRSL, "IPAC PDCH DEACT ACK\n");
1098 break;
1099 case RSL_MT_IPAC_PDCH_DEACT_NACK:
1100 DEBUGPC(DRSL, "IPAC PDCH DEACT NACK\n");
1101 break;
Harald Welte59b04682009-06-10 05:40:52 +08001102 case RSL_MT_PHY_CONTEXT_CONF:
1103 case RSL_MT_PREPROC_MEAS_RES:
1104 case RSL_MT_TALKER_DET:
1105 case RSL_MT_LISTENER_DET:
1106 case RSL_MT_REMOTE_CODEC_CONF_REP:
1107 case RSL_MT_MR_CODEC_MOD_ACK:
1108 case RSL_MT_MR_CODEC_MOD_NACK:
1109 case RSL_MT_MR_CODEC_MOD_PER:
1110 DEBUGPC(DRSL, "Unimplemented Abis RSL DChan msg 0x%02x\n",
1111 rslh->c.msg_type);
1112 break;
1113 default:
1114 DEBUGPC(DRSL, "unknown Abis RSL DChan msg 0x%02x\n",
1115 rslh->c.msg_type);
1116 return -EINVAL;
1117 }
1118
1119 return rc;
1120}
1121
1122static int rsl_rx_error_rep(struct msgb *msg)
1123{
1124 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001125 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001126
1127 DEBUGP(DRSL, "ERROR REPORT ");
Harald Weltef1a168d2009-07-28 17:58:09 +02001128
1129 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1130
1131 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
1132 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
1133 TLVP_LEN(&tp, RSL_IE_CAUSE));
1134
Harald Welte59b04682009-06-10 05:40:52 +08001135 DEBUGPC(DRSL, "\n");
1136
1137 return 0;
1138}
1139
1140static int abis_rsl_rx_trx(struct msgb *msg)
1141{
1142 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1143 int rc = 0;
1144
1145 switch (rslh->msg_type) {
1146 case RSL_MT_ERROR_REPORT:
1147 rc = rsl_rx_error_rep(msg);
1148 break;
1149 case RSL_MT_RF_RES_IND:
1150 /* interference on idle channels of TRX */
1151 //DEBUGP(DRSL, "TRX: RF Interference Indication\n");
1152 break;
1153 case RSL_MT_OVERLOAD:
1154 /* indicate CCCH / ACCH / processor overload */
1155 DEBUGP(DRSL, "TRX: CCCH/ACCH/CPU Overload\n");
1156 break;
1157 default:
1158 DEBUGP(DRSL, "Unknown Abis RSL TRX message type 0x%02x\n",
1159 rslh->msg_type);
1160 return -EINVAL;
1161 }
1162 return rc;
1163}
1164
Harald Welte427dbc42009-08-10 00:26:10 +02001165/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1166static void t3101_expired(void *data)
1167{
1168 struct gsm_lchan *lchan = data;
1169
Harald Welte85a163c2009-08-10 11:43:22 +02001170 rsl_rf_chan_release(lchan);
Harald Welte427dbc42009-08-10 00:26:10 +02001171}
1172
Harald Welte59b04682009-06-10 05:40:52 +08001173/* MS has requested a channel on the RACH */
1174static int rsl_rx_chan_rqd(struct msgb *msg)
1175{
1176 struct gsm_bts *bts = msg->trx->bts;
1177 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1178 struct gsm48_req_ref *rqd_ref;
1179 struct gsm48_imm_ass ia;
1180 enum gsm_chan_t lctype;
1181 enum gsm_chreq_reason_t chreq_reason;
1182 struct gsm_lchan *lchan;
1183 u_int8_t rqd_ta;
1184 int ret;
1185
1186 u_int16_t arfcn;
1187 u_int8_t ts_number, subch;
1188
1189 /* parse request reference to be used in immediate assign */
1190 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1191 return -EINVAL;
1192
1193 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1194
1195 /* parse access delay and use as TA */
1196 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1197 return -EINVAL;
1198 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1199
1200 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1201 * request reference RA */
Holger Hans Peter Freyther96c89822009-11-16 17:12:38 +01001202 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1203 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001204
1205 /* check availability / allocate channel */
1206 lchan = lchan_alloc(bts, lctype);
1207 if (!lchan) {
Holger Hans Peter Freyther21ccb452009-11-16 15:37:05 +01001208 DEBUGP(DRSL, "CHAN RQD: no resources for %u 0x%x\n",
1209 lctype, rqd_ref->ra);
Harald Welte59b04682009-06-10 05:40:52 +08001210 /* FIXME: send some kind of reject ?!? */
1211 return -ENOMEM;
1212 }
1213
1214 ts_number = lchan->ts->nr;
1215 arfcn = lchan->ts->trx->arfcn;
1216 subch = lchan->nr;
1217
Harald Welted2dd9de2009-08-30 15:37:11 +09001218 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001219 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001220 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001221 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001222 lchan->tch_mode = GSM48_CMODE_SIGN;
Harald Welte39274f42009-07-29 15:41:29 +02001223 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta);
Harald Welte59b04682009-06-10 05:40:52 +08001224
1225 /* create IMMEDIATE ASSIGN 04.08 messge */
1226 memset(&ia, 0, sizeof(ia));
1227 ia.l2_plen = 0x2d;
1228 ia.proto_discr = GSM48_PDISC_RR;
1229 ia.msg_type = GSM48_MT_RR_IMM_ASS;
1230 ia.page_mode = GSM48_PM_SAME;
1231 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
1232 ia.chan_desc.h0.h = 0;
1233 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
1234 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
Harald Welte63d23c82009-07-21 20:55:56 +02001235 ia.chan_desc.h0.tsc = bts->tsc;
Harald Welte59b04682009-06-10 05:40:52 +08001236 /* use request reference extracted from CHAN_RQD */
1237 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
1238 ia.timing_advance = rqd_ta;
1239 ia.mob_alloc_len = 0;
1240
1241 DEBUGP(DRSL, "Activating ARFCN(%u) TS(%u) SS(%u) lctype %s "
1242 "chan_nr=0x%02x r=%s ra=0x%02x\n",
1243 arfcn, ts_number, subch, gsm_lchan_name(lchan->type),
1244 ia.chan_desc.chan_nr, gsm_chreq_name(chreq_reason),
1245 rqd_ref->ra);
1246
Harald Welte427dbc42009-08-10 00:26:10 +02001247 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1248 lchan->T3101.cb = t3101_expired;
1249 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001250 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001251
1252 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
1253 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
1254
1255 return ret;
1256}
1257
1258/* MS has requested a channel on the RACH */
1259static int rsl_rx_ccch_load(struct msgb *msg)
1260{
1261 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1262 u_int16_t pg_buf_space;
1263 u_int16_t rach_slot_count = -1;
1264 u_int16_t rach_busy_count = -1;
1265 u_int16_t rach_access_count = -1;
1266
1267 switch (rslh->data[0]) {
1268 case RSL_IE_PAGING_LOAD:
1269 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1270 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1271 break;
1272 case RSL_IE_RACH_LOAD:
1273 if (msg->data_len >= 7) {
1274 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1275 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1276 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1277 }
1278 break;
1279 default:
1280 break;
1281 }
1282
1283 return 0;
1284}
1285
1286static int abis_rsl_rx_cchan(struct msgb *msg)
1287{
1288 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1289 int rc = 0;
1290
1291 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1292
1293 switch (rslh->c.msg_type) {
1294 case RSL_MT_CHAN_RQD:
1295 /* MS has requested a channel on the RACH */
1296 rc = rsl_rx_chan_rqd(msg);
1297 break;
1298 case RSL_MT_CCCH_LOAD_IND:
1299 /* current load on the CCCH */
1300 rc = rsl_rx_ccch_load(msg);
1301 break;
1302 case RSL_MT_DELETE_IND:
1303 /* CCCH overloaded, IMM_ASSIGN was dropped */
1304 case RSL_MT_CBCH_LOAD_IND:
1305 /* current load on the CBCH */
1306 fprintf(stderr, "Unimplemented Abis RSL TRX message type "
1307 "0x%02x\n", rslh->c.msg_type);
1308 break;
1309 default:
1310 fprintf(stderr, "Unknown Abis RSL TRX message type 0x%02x\n",
1311 rslh->c.msg_type);
1312 return -EINVAL;
1313 }
1314
1315 return rc;
1316}
1317
1318static int rsl_rx_rll_err_ind(struct msgb *msg)
1319{
1320 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1321 u_int8_t *rlm_cause = rllh->data;
1322
Harald Welteb6601442009-08-04 02:50:21 +02001323 DEBUGPC(DRLL, "ERROR INDICATION cause=0x%02x\n", rlm_cause[1]);
Harald Welteed9a5ab2009-08-09 13:47:35 +02001324
1325 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte59b04682009-06-10 05:40:52 +08001326
Harald Welte692f5852009-07-04 09:40:05 +02001327 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED)
Harald Welte85a163c2009-08-10 11:43:22 +02001328 return rsl_rf_chan_release(msg->lchan);
Harald Welte692f5852009-07-04 09:40:05 +02001329
Harald Welte59b04682009-06-10 05:40:52 +08001330 return 0;
1331}
1332
1333/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
1334 0x02, 0x06,
1335 0x01, 0x20,
1336 0x02, 0x00,
1337 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1338
1339static int abis_rsl_rx_rll(struct msgb *msg)
1340{
1341 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1342 int rc = 0;
1343 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001344 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001345
1346 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
1347 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001348 DEBUGP(DRLL, "channel=%s chan_nr=0x%02x sapi=%u ", ts_name,
1349 rllh->chan_nr, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001350
1351 switch (rllh->c.msg_type) {
1352 case RSL_MT_DATA_IND:
1353 DEBUGPC(DRLL, "DATA INDICATION\n");
1354 if (msgb_l2len(msg) >
1355 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1356 rllh->data[0] == RSL_IE_L3_INFO) {
1357 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001358 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001359 }
1360 break;
1361 case RSL_MT_EST_IND:
1362 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001363 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001364 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001365 bsc_del_timer(&msg->lchan->T3101);
Harald Welte59b04682009-06-10 05:40:52 +08001366 if (msgb_l2len(msg) >
1367 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1368 rllh->data[0] == RSL_IE_L3_INFO) {
1369 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001370 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001371 }
1372 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001373 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001374 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001375 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001376 rll_indication(msg->lchan, rllh->link_id,
1377 BSC_RLLR_IND_EST_CONF);
1378 break;
Harald Welte59b04682009-06-10 05:40:52 +08001379 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001380 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001381 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001382 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001383 rll_indication(msg->lchan, rllh->link_id,
1384 BSC_RLLR_IND_REL_IND);
Harald Welte0f2e3c12009-08-08 13:15:07 +02001385 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001386 /* FIXME: officially we need to start T3111 and wait for
1387 * some grace period */
1388 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001389 break;
1390 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001391 /* BTS informs us of having received UA from MS,
1392 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001393 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001394 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welte0f2e3c12009-08-08 13:15:07 +02001395 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001396 /* FIXME: officially we need to start T3111 and wait for
1397 * some grace period */
1398 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001399 break;
1400 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001401 rc = rsl_rx_rll_err_ind(msg);
1402 break;
1403 case RSL_MT_UNIT_DATA_IND:
Harald Welteb6601442009-08-04 02:50:21 +02001404 DEBUGPC(DRLL, "unimplemented Abis RLL message type 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001405 rllh->c.msg_type);
1406 break;
1407 default:
Harald Welteb6601442009-08-04 02:50:21 +02001408 DEBUGPC(DRLL, "unknown Abis RLL message type 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001409 rllh->c.msg_type);
1410 }
Harald Welte59b04682009-06-10 05:40:52 +08001411 return rc;
1412}
1413
Harald Welte98d79f92009-07-28 18:11:56 +02001414static u_int8_t ipa_smod_s_for_tch_mode(u_int8_t tch_mode)
1415{
Harald Welte98d79f92009-07-28 18:11:56 +02001416 switch (tch_mode) {
1417 case GSM48_CMODE_SPEECH_V1:
1418 return 0x00;
1419 case GSM48_CMODE_SPEECH_EFR:
1420 return 0x01;
1421 case GSM48_CMODE_SPEECH_AMR:
1422 return 0x02;
1423 /* FIXME: Type1 half-rate and type3 half-rate */
1424 }
Harald Weltefb4a9e92009-07-29 12:12:18 +02001425 DEBUGPC(DRSL, "Cannot determine ip.access speech mode for "
1426 "tch_mode == 0x%02x\n", tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001427 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001428}
1429
Harald Welte59b04682009-06-10 05:40:52 +08001430/* ip.access specific RSL extensions */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001431int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001432{
1433 struct msgb *msg = rsl_msgb_alloc();
1434 struct abis_rsl_dchan_hdr *dh;
Harald Weltefb4a9e92009-07-29 12:12:18 +02001435 u_int8_t speech_mode;
Harald Welte59b04682009-06-10 05:40:52 +08001436
1437 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001438 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001439 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1440 dh->chan_nr = lchan2chan_nr(lchan);
1441
Harald Welte98d79f92009-07-28 18:11:56 +02001442 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltefb4a9e92009-07-29 12:12:18 +02001443 speech_mode = 0x10 | ipa_smod_s_for_tch_mode(lchan->tch_mode);
1444 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001445
Harald Weltefb4a9e92009-07-29 12:12:18 +02001446 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_BIND "
1447 "speech_mode=0x%02x\n", gsm_ts_name(lchan->ts),
1448 dh->chan_nr, speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001449
Harald Welte59b04682009-06-10 05:40:52 +08001450 msg->trx = lchan->ts->trx;
1451
1452 return abis_rsl_sendmsg(msg);
1453}
1454
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001455int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte8cdeaad2009-07-12 09:50:35 +02001456 u_int16_t conn_id, u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001457{
1458 struct msgb *msg = rsl_msgb_alloc();
1459 struct abis_rsl_dchan_hdr *dh;
1460 u_int8_t *att_f8, *att_ip, *att_port;
Harald Weltefb4a9e92009-07-29 12:12:18 +02001461 u_int8_t speech_mode;
Harald Welte98d79f92009-07-28 18:11:56 +02001462 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001463
1464 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001465 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001466 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1467 dh->chan_nr = lchan2chan_nr(lchan);
1468
Harald Weltefb4a9e92009-07-29 12:12:18 +02001469 /* 0x0- == both directions, 0x-1 == EFR codec */
1470 speech_mode = 0x00 | ipa_smod_s_for_tch_mode(lchan->tch_mode);
1471
Harald Welte98d79f92009-07-28 18:11:56 +02001472 ia.s_addr = htonl(ip);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001473 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_MDCX "
Harald Weltefb4a9e92009-07-29 12:12:18 +02001474 "IP=%s PORT=%d RTP_PAYLOAD2=%d CONN_ID=%d speech_mode=0x%02x\n",
Harald Welte98d79f92009-07-28 18:11:56 +02001475 gsm_ts_name(lchan->ts), dh->chan_nr,
Harald Weltefb4a9e92009-07-29 12:12:18 +02001476 inet_ntoa(ia), port, rtp_payload2, conn_id, speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001477
Harald Welte8cdeaad2009-07-12 09:50:35 +02001478 att_f8 = msgb_put(msg, sizeof(conn_id)+1);
Harald Welteb9498952009-07-12 09:45:05 +02001479 att_f8[0] = RSL_IE_IPAC_CONN_ID;
Harald Welte8cdeaad2009-07-12 09:50:35 +02001480 att_f8[1] = conn_id >> 8;
1481 att_f8[2] = conn_id & 0xff;
Harald Welte59b04682009-06-10 05:40:52 +08001482
1483 att_ip = msgb_put(msg, sizeof(ip)+1);
1484 att_ip[0] = RSL_IE_IPAC_REMOTE_IP;
1485 att_ip[1] = ip >> 24;
1486 att_ip[2] = ip >> 16;
1487 att_ip[3] = ip >> 8;
1488 att_ip[4] = ip & 0xff;
1489 //att_ip[4] = 11;
1490
1491 att_port = msgb_put(msg, sizeof(port)+1);
1492 att_port[0] = RSL_IE_IPAC_REMOTE_PORT;
1493 att_port[1] = port >> 8;
1494 att_port[2] = port & 0xff;
1495
Harald Weltefb4a9e92009-07-29 12:12:18 +02001496 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001497 if (rtp_payload2)
1498 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1499
Harald Welte59b04682009-06-10 05:40:52 +08001500 msg->trx = lchan->ts->trx;
1501
1502 return abis_rsl_sendmsg(msg);
1503}
1504
Harald Welteaed946e2009-10-24 10:29:22 +02001505int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan)
1506{
1507 struct msgb *msg = rsl_msgb_alloc();
1508 struct abis_rsl_dchan_hdr *dh;
1509
1510 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
1511 init_dchan_hdr(dh, RSL_MT_IPAC_PDCH_ACT);
1512 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1513 dh->chan_nr = lchan2chan_nr(lchan);
1514
1515 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_PDCH_ACT\n",
1516 gsm_ts_name(lchan->ts), dh->chan_nr);
1517
1518 msg->trx = lchan->ts->trx;
1519
1520 return abis_rsl_sendmsg(msg);
1521}
1522
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001523static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001524{
1525 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1526 struct tlv_parsed tv;
1527 struct gsm_bts_trx_ts *ts = msg->lchan->ts;
1528 struct in_addr ip;
1529 u_int16_t port, attr_f8;
1530
1531 /* the BTS has acknowledged a local bind, it now tells us the IP
1532 * address and port number to which it has bound the given logical
1533 * channel */
1534
1535 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1536 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1537 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001538 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Welte59b04682009-06-10 05:40:52 +08001539 DEBUGPC(DRSL, "mandatory IE missing");
1540 return -EINVAL;
1541 }
1542 ip.s_addr = *((u_int32_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_IP));
1543 port = *((u_int16_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_PORT));
1544 attr_f8 = *((u_int16_t *) TLVP_VAL(&tv, 0xf8));
1545
Harald Welte98d79f92009-07-28 18:11:56 +02001546 DEBUGPC(DRSL, "IP=%s PORT=%d CONN_ID=%d ",
1547 inet_ntoa(ip), ntohs(port), ntohs(attr_f8));
1548
1549 if (TLVP_PRESENT(&tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1550 ts->abis_ip.rtp_payload2 =
1551 *TLVP_VAL(&tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1552 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1553 ts->abis_ip.rtp_payload2);
1554 }
Harald Welte59b04682009-06-10 05:40:52 +08001555
1556 /* update our local information about this TS */
1557 ts->abis_ip.bound_ip = ntohl(ip.s_addr);
1558 ts->abis_ip.bound_port = ntohs(port);
Harald Welte8cdeaad2009-07-12 09:50:35 +02001559 ts->abis_ip.conn_id = ntohs(attr_f8);
Harald Welte59b04682009-06-10 05:40:52 +08001560
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001561 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001562
1563 return 0;
1564}
1565
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001566static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001567{
1568 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1569 struct tlv_parsed tv;
1570
1571 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001572
Harald Weltef1a168d2009-07-28 17:58:09 +02001573 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
1574 print_rsl_cause(TLVP_VAL(&tv, RSL_IE_CAUSE),
1575 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001576
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001577 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001578
Harald Welte59b04682009-06-10 05:40:52 +08001579 return 0;
1580}
1581
1582static int abis_rsl_rx_ipacc(struct msgb *msg)
1583{
1584 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1585 int rc = 0;
1586
1587 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
1588 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ",
1589 gsm_ts_name(msg->lchan->ts), rllh->chan_nr);
1590
1591 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001592 case RSL_MT_IPAC_CRCX_ACK:
1593 DEBUGPC(DRSL, "IPAC_CRCX_ACK ");
1594 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001595 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001596 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001597 /* somehow the BTS was unable to bind the lchan to its local
1598 * port?!? */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001599 DEBUGPC(DRSL, "IPAC_CRCX_NACK ");
Harald Welte59b04682009-06-10 05:40:52 +08001600 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001601 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001602 /* the BTS tells us that a connect operation was successful */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001603 DEBUGPC(DRSL, "IPAC_MDCX_ACK ");
Harald Welte59b04682009-06-10 05:40:52 +08001604 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001605 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001606 /* somehow the BTS was unable to connect the lchan to a remote
1607 * port */
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001608 DEBUGPC(DRSL, "IPAC_MDCX_NACK ");
Harald Welte59b04682009-06-10 05:40:52 +08001609 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001610 case RSL_MT_IPAC_DLCX_IND:
1611 DEBUGPC(DRSL, "IPAC_DLCX_IND ");
1612 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001613 break;
1614 default:
1615 DEBUGPC(DRSL, "Unknown ip.access msg_type 0x%02x", rllh->c.msg_type);
1616 break;
1617 }
1618 DEBUGPC(DRSL, "\n");
1619
1620 return rc;
1621}
1622
1623
1624/* Entry-point where L2 RSL from BTS enters */
1625int abis_rsl_rcvmsg(struct msgb *msg)
1626{
1627 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
1628 int rc = 0;
1629
1630 switch (rslh->msg_discr & 0xfe) {
1631 case ABIS_RSL_MDISC_RLL:
1632 rc = abis_rsl_rx_rll(msg);
1633 break;
1634 case ABIS_RSL_MDISC_DED_CHAN:
1635 rc = abis_rsl_rx_dchan(msg);
1636 break;
1637 case ABIS_RSL_MDISC_COM_CHAN:
1638 rc = abis_rsl_rx_cchan(msg);
1639 break;
1640 case ABIS_RSL_MDISC_TRX:
1641 rc = abis_rsl_rx_trx(msg);
1642 break;
1643 case ABIS_RSL_MDISC_LOC:
1644 fprintf(stderr, "unimplemented RSL msg disc 0x%02x\n",
1645 rslh->msg_discr);
1646 break;
1647 case ABIS_RSL_MDISC_IPACCESS:
1648 rc = abis_rsl_rx_ipacc(msg);
1649 break;
1650 default:
1651 fprintf(stderr, "unknown RSL message discriminator 0x%02x\n",
1652 rslh->msg_discr);
1653 return -EINVAL;
1654 }
1655 msgb_free(msg);
1656 return rc;
1657}
1658
1659
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001660/* Section 3.3.2.3 TS 05.02. I think this looks like a table */
Harald Welte59b04682009-06-10 05:40:52 +08001661int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1662{
1663 switch (ccch_conf) {
1664 case RSL_BCCH_CCCH_CONF_1_NC:
1665 return 1;
1666 case RSL_BCCH_CCCH_CONF_1_C:
1667 return 1;
1668 case RSL_BCCH_CCCH_CONF_2_NC:
1669 return 2;
1670 case RSL_BCCH_CCCH_CONF_3_NC:
1671 return 3;
1672 case RSL_BCCH_CCCH_CONF_4_NC:
1673 return 4;
1674 default:
1675 return -1;
1676 }
1677}
1678
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001679/* Section 3.3.2.3 TS 05.02 */
Harald Welte59b04682009-06-10 05:40:52 +08001680int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1681{
1682 switch (ccch_conf) {
1683 case RSL_BCCH_CCCH_CONF_1_NC:
1684 return 0;
1685 case RSL_BCCH_CCCH_CONF_1_C:
1686 return 1;
1687 case RSL_BCCH_CCCH_CONF_2_NC:
1688 return 0;
1689 case RSL_BCCH_CCCH_CONF_3_NC:
1690 return 0;
1691 case RSL_BCCH_CCCH_CONF_4_NC:
1692 return 0;
1693 default:
1694 return -1;
1695 }
1696}
1697
1698/* From Table 10.5.33 of GSM 04.08 */
1699int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1700{
1701 if (bts->chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1702 return MAX(1, (3 - bts->chan_desc.bs_ag_blks_res))
1703 * (bts->chan_desc.bs_pa_mfrms + 2);
1704 } else {
1705 return (9 - bts->chan_desc.bs_ag_blks_res)
1706 * (bts->chan_desc.bs_pa_mfrms + 2);
1707 }
1708}