blob: 37b9a47dc4d6e14041806af65ff19980413aeb67 [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>
Harald Welte66b6a8d2009-08-09 14:45:18 +020033#include <openbsc/gsm_utils.h>
Harald Welte8470bf22008-12-25 23:28:35 +000034#include <openbsc/abis_rsl.h>
35#include <openbsc/chan_alloc.h>
Harald Welteedcc5272009-08-09 13:47:35 +020036#include <openbsc/bsc_rll.h>
Harald Welte8470bf22008-12-25 23:28:35 +000037#include <openbsc/debug.h>
38#include <openbsc/tlv.h>
Holger Freyther392209c2009-02-10 00:06:19 +000039#include <openbsc/paging.h>
Harald Welte167df882009-02-17 14:35:45 +000040#include <openbsc/signal.h>
Harald Welte3c7dc6e2009-11-29 19:07:28 +010041#include <openbsc/meas_rep.h>
Harald Welte52b1f982008-12-23 20:25:15 +000042
Harald Welte8470bf22008-12-25 23:28:35 +000043#define RSL_ALLOC_SIZE 1024
44#define RSL_ALLOC_HEADROOM 128
Harald Welte52b1f982008-12-23 20:25:15 +000045
Holger Freyther3b72a892009-02-04 00:31:39 +000046#define MAX(a, b) (a) >= (b) ? (a) : (b)
47
Harald Welte75099262009-02-16 21:12:08 +000048static 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 Welte67fa91b2009-08-10 09:51:40 +0200109 [RSL_IE_SIEMENS_MRPCI] = { TLV_TYPE_TV },
Harald Welteab46d742009-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 Welte75099262009-02-16 21:12:08 +0000112 [RSL_IE_IPAC_REMOTE_IP] = { TLV_TYPE_FIXED, 4 },
113 [RSL_IE_IPAC_REMOTE_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welteab46d742009-07-12 09:56:39 +0200114 [RSL_IE_IPAC_RTP_PAYLOAD] = { TLV_TYPE_TV },
Harald Welte75099262009-02-16 21:12:08 +0000115 [RSL_IE_IPAC_LOCAL_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welte86c162d2009-07-12 09:45:05 +0200116 [RSL_IE_IPAC_SPEECH_MODE] = { TLV_TYPE_TV },
Harald Welteab46d742009-07-12 09:56:39 +0200117 [RSL_IE_IPAC_LOCAL_IP] = { TLV_TYPE_FIXED, 4 },
Harald Welte86c162d2009-07-12 09:45:05 +0200118 [RSL_IE_IPAC_CONN_ID] = { TLV_TYPE_FIXED, 2 },
Harald Welteab46d742009-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 Welte86c162d2009-07-12 09:45:05 +0200122 [RSL_IE_IPAC_RTP_PAYLOAD2] = { TLV_TYPE_TV },
Harald Welteab46d742009-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 Welte75099262009-02-16 21:12:08 +0000125 },
126};
Harald Weltea4d49e92009-05-23 06:39:58 +0000127#define rsl_tlv_parse(dec, buf, len) \
128 tlv_parse(dec, &rsl_att_tlvdef, buf, len, 0, 0)
Harald Welte75099262009-02-16 21:12:08 +0000129
Harald Welte52b1f982008-12-23 20:25:15 +0000130static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
131{
132 /* mask off the transparent bit ? */
133 msg_type &= 0xfe;
134
Harald Welte8470bf22008-12-25 23:28:35 +0000135 if ((msg_type & 0xf0) == 0x00)
Harald Welte52b1f982008-12-23 20:25:15 +0000136 return ABIS_RSL_MDISC_RLL;
Harald Welte8470bf22008-12-25 23:28:35 +0000137 if ((msg_type & 0xf0) == 0x10) {
Harald Welte52b1f982008-12-23 20:25:15 +0000138 if (msg_type >= 0x19 && msg_type <= 0x22)
139 return ABIS_RSL_MDISC_TRX;
140 else
141 return ABIS_RSL_MDISC_COM_CHAN;
142 }
Harald Welte2d5b6382008-12-27 19:46:06 +0000143 if ((msg_type & 0xe0) == 0x20)
Harald Welte52b1f982008-12-23 20:25:15 +0000144 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
Harald Welte8470bf22008-12-25 23:28:35 +0000195/* 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 Weltea1499d02009-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 Welte8470bf22008-12-25 23:28:35 +0000209 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 Freythere81a6102009-10-22 11:47:45 +0200243/* See Table 10.5.25 of GSM04.08 */
Harald Welte24766092009-12-09 19:18:32 +0100244u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte8470bf22008-12-25 23:28:35 +0000245{
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 Weltea1499d02009-10-24 10:25:50 +0200251 case GSM_PCHAN_PDCH:
252 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte8470bf22008-12-25 23:28:35 +0000253 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
Harald Welte52b1f982008-12-23 20:25:15 +0000278/* 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
Harald Welte8470bf22008-12-25 23:28:35 +0000311static struct msgb *rsl_msgb_alloc(void)
312{
Harald Welte966636f2009-06-26 19:39:35 +0200313 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
314 "RSL");
Harald Welte8470bf22008-12-25 23:28:35 +0000315}
316
Harald Welte362322e2009-02-15 14:36:38 +0000317#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 Welte08d91a52009-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 Welte8830e072009-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 Welte2da86292009-08-04 02:31:05 +0200343 [RSL_ERR_T_MSRFPCI_EXP] = "Siemens: T_MSRFPCI Expired",
Harald Welte8830e072009-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 Welte7f93cea2009-02-23 00:02:59 +0000371{
Harald Welte8830e072009-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 Welte7f93cea2009-02-23 00:02:59 +0000380 int i;
381
Harald Welte8830e072009-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 Welte7f93cea2009-02-23 00:02:59 +0000386}
387
Harald Welte52b1f982008-12-23 20:25:15 +0000388/* Send a BCCH_INFO message as per Chapter 8.5.1 */
Harald Weltee79769b2009-02-07 00:48:17 +0000389int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000390 const u_int8_t *data, int len)
391{
392 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000393 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000394
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
Harald Weltee79769b2009-02-07 00:48:17 +0000402 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000403
404 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000405}
406
Harald Weltee79769b2009-02-07 00:48:17 +0000407int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
Harald Welte52b1f982008-12-23 20:25:15 +0000408 const u_int8_t *data, int len)
409{
410 struct abis_rsl_common_hdr *ch;
Harald Welte8470bf22008-12-25 23:28:35 +0000411 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000412
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);
Harald Welte702d8702008-12-26 20:25:35 +0000418 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
Harald Welte52b1f982008-12-23 20:25:15 +0000419
Harald Weltee79769b2009-02-07 00:48:17 +0000420 msg->trx = trx;
Harald Welte8470bf22008-12-25 23:28:35 +0000421
422 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000423}
424
Harald Weltefcd24452009-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 Welteeab33352009-06-27 03:09:08 +0200428 struct msgb *msg;
Harald Weltefcd24452009-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 Welteeab33352009-06-27 03:09:08 +0200435 msg = rsl_msgb_alloc();
436
Harald Weltefcd24452009-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 Weltefcd24452009-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 Welteeab33352009-06-27 03:09:08 +0200455 struct msgb *msg;
Harald Weltefcd24452009-06-20 18:15:19 +0200456 u_int8_t chan_nr = lchan2chan_nr(lchan);
457 int ctl_lvl;
458
Harald Welte66b6a8d2009-08-09 14:45:18 +0200459 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Weltefcd24452009-06-20 18:15:19 +0200460 if (ctl_lvl < 0)
461 return ctl_lvl;
462
Harald Welteeab33352009-06-27 03:09:08 +0200463 msg = rsl_msgb_alloc();
464
Harald Weltefcd24452009-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 Welte9943c5b2009-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 Welte1a79d362009-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 Welte9943c5b2009-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 Welte52b1f982008-12-23 20:25:15 +0000542/* Chapter 8.4.1 */
Harald Welteddab3c72009-02-28 13:19:15 +0000543#if 0
Harald Weltee79769b2009-02-07 00:48:17 +0000544int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
Harald Welte52b1f982008-12-23 20:25:15 +0000545 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;
Harald Welte8470bf22008-12-25 23:28:35 +0000552 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000553
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,
Harald Welte702d8702008-12-26 20:25:35 +0000563 (u_int8_t *) chan_ident);
Harald Welte702d8702008-12-26 20:25:35 +0000564#if 0
Harald Welte52b1f982008-12-23 20:25:15 +0000565 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
566 (u_int8_t *) &encr_info);
Harald Welte702d8702008-12-26 20:25:35 +0000567#endif
Harald Welted4c9bf32009-02-15 16:56:18 +0000568 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
Harald Welte52b1f982008-12-23 20:25:15 +0000569 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
570 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
571
Harald Weltee79769b2009-02-07 00:48:17 +0000572 msg->trx = trx;
573
Harald Welte8470bf22008-12-25 23:28:35 +0000574 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000575}
Harald Welteddab3c72009-02-28 13:19:15 +0000576#endif
Harald Welte52b1f982008-12-23 20:25:15 +0000577
Harald Welte8f5e2392009-02-03 12:57:37 +0000578int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welte9943c5b2009-07-29 15:41:29 +0200579 u_int8_t ta)
Harald Welte4b634542008-12-27 01:55:51 +0000580{
581 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200582 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200583 int rc;
Harald Welte4b634542008-12-27 01:55:51 +0000584
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 Welte9943c5b2009-07-29 15:41:29 +0200590 rc = channel_mode_from_lchan(&cm, lchan);
591 if (rc < 0)
592 return rc;
Harald Welte4b634542008-12-27 01:55:51 +0000593
Harald Welte02b0e092009-02-28 13:11:07 +0000594 memset(&ci, 0, sizeof(ci));
Harald Welte4b634542008-12-27 01:55:51 +0000595 ci.chan_desc.iei = 0x64;
596 ci.chan_desc.chan_nr = chan_nr;
Harald Welte02b0e092009-02-28 13:11:07 +0000597 ci.chan_desc.oct3 = (lchan->ts->trx->bts->tsc << 5) | ((arfcn & 0x3ff) >> 8);
Harald Welte4b634542008-12-27 01:55:51 +0000598 ci.chan_desc.oct4 = arfcn & 0xff;
599
Harald Welteeab33352009-06-27 03:09:08 +0200600 msg = rsl_msgb_alloc();
Harald Welte4b634542008-12-27 01:55:51 +0000601 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 Welte08d91a52009-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 Welted4c9bf32009-02-15 16:56:18 +0000619 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
620 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
Harald Welte4b634542008-12-27 01:55:51 +0000621 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
622
Harald Weltee79769b2009-02-07 00:48:17 +0000623 msg->trx = lchan->ts->trx;
624
Harald Welte4b634542008-12-27 01:55:51 +0000625 return abis_rsl_sendmsg(msg);
626}
627
Harald Welte470abb72009-07-29 11:38:15 +0200628/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welteda783762009-02-18 03:29:53 +0000629int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
630{
631 struct abis_rsl_dchan_hdr *dh;
Harald Welteeab33352009-06-27 03:09:08 +0200632 struct msgb *msg;
Harald Welte9943c5b2009-07-29 15:41:29 +0200633 int rc;
Harald Welteda783762009-02-18 03:29:53 +0000634
635 u_int8_t chan_nr = lchan2chan_nr(lchan);
636 struct rsl_ie_chan_mode cm;
637
Harald Welte9943c5b2009-07-29 15:41:29 +0200638 rc = channel_mode_from_lchan(&cm, lchan);
639 if (rc < 0)
640 return rc;
Harald Welteda783762009-02-18 03:29:53 +0000641
Harald Welteeab33352009-06-27 03:09:08 +0200642 msg = rsl_msgb_alloc();
Harald Welteda783762009-02-18 03:29:53 +0000643 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 Welte08d91a52009-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 Freytherea528022009-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 Welte08d91a52009-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 Munaut82aa6842009-09-27 11:13:18 +0200674 u_int8_t l3_len = msg->len;
Harald Welte08d91a52009-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 Welteda783762009-02-18 03:29:53 +0000693
694 msg->trx = lchan->ts->trx;
695
696 return abis_rsl_sendmsg(msg);
697}
698
Harald Welte115d1032009-08-10 11:43:22 +0200699/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteae0f2362009-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 Welte115d1032009-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 Welte52b1f982008-12-23 20:25:15 +0000720{
721 struct abis_rsl_dchan_hdr *dh;
Harald Welte8470bf22008-12-25 23:28:35 +0000722 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000723
724 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
725 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
Harald Welte8470bf22008-12-25 23:28:35 +0000726 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +0000727
Harald Welte8470bf22008-12-25 23:28:35 +0000728 msg->lchan = lchan;
729 msg->trx = lchan->ts->trx;
730
Harald Welte115d1032009-08-10 11:43:22 +0200731 DEBUGP(DRSL, "RF Channel Release CMD channel=%s chan_nr=0x%02x\n",
Harald Weltef325eb42009-02-19 17:07:39 +0000732 gsm_ts_name(lchan->ts), dh->chan_nr);
Harald Welte2d5b6382008-12-27 19:46:06 +0000733
Harald Welte115d1032009-08-10 11:43:22 +0200734 /* BTS will respond by RF CHAN REL ACK */
Harald Welte8470bf22008-12-25 23:28:35 +0000735 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000736}
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;
Harald Welte8470bf22008-12-25 23:28:35 +0000742 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000743
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);
Harald Welte255539c2008-12-28 02:26:27 +0000749 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
Harald Welte52b1f982008-12-23 20:25:15 +0000750 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
751
Harald Welte8470bf22008-12-25 23:28:35 +0000752 msg->trx = bts->c0;
753
754 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000755}
756
Holger Freyther7448a532009-01-04 20:18:23 +0000757int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
758 struct gsm_subscriber *subscr)
759{
Holger Freytherca362a62009-01-04 21:05:01 +0000760#if 0
Holger Freyther7448a532009-01-04 20:18:23 +0000761 u_int8_t mi[128];
762 unsigned int mi_len;
763 u_int8_t paging_group;
Holger Freytherca362a62009-01-04 21:05:01 +0000764#endif
Holger Freyther7448a532009-01-04 20:18:23 +0000765
766 return -1;
767}
768
Harald Welte52b1f982008-12-23 20:25:15 +0000769int 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
Harald Welte702d8702008-12-26 20:25:35 +0000786/* Chapter 8.5.6 */
Harald Welte52b1f982008-12-23 20:25:15 +0000787int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
788{
Harald Welte8470bf22008-12-25 23:28:35 +0000789 struct msgb *msg = rsl_msgb_alloc();
Harald Welte52b1f982008-12-23 20:25:15 +0000790 struct abis_rsl_dchan_hdr *dh;
Harald Welte362322e2009-02-15 14:36:38 +0000791 u_int8_t buf[MACBLOCK_SIZE];
Harald Welte52b1f982008-12-23 20:25:15 +0000792
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
Harald Welte362322e2009-02-15 14:36:38 +0000797 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 }
Harald Welte52b1f982008-12-23 20:25:15 +0000807
Harald Welte8470bf22008-12-25 23:28:35 +0000808 msg->trx = bts->c0;
809
810 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000811}
812
Harald Welte67fa91b2009-08-10 09:51:40 +0200813/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte31c48932009-08-10 10:07:33 +0200814int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte67fa91b2009-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 Welte3c456d02009-08-10 11:26:14 +0200821 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte67fa91b2009-08-10 09:51:40 +0200822 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte31c48932009-08-10 10:07:33 +0200823 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte67fa91b2009-08-10 09:51:40 +0200824
Harald Welte3c456d02009-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 Welte67fa91b2009-08-10 09:51:40 +0200830 return abis_rsl_sendmsg(msg);
831}
832
833
Harald Welte8470bf22008-12-25 23:28:35 +0000834/* Send "DATA REQUEST" message with given L3 Info payload */
Harald Welte52b1f982008-12-23 20:25:15 +0000835/* Chapter 8.3.1 */
Harald Welte8470bf22008-12-25 23:28:35 +0000836int rsl_data_request(struct msgb *msg, u_int8_t link_id)
Harald Welte52b1f982008-12-23 20:25:15 +0000837{
Harald Welte8470bf22008-12-25 23:28:35 +0000838 u_int8_t l3_len = msg->tail - (u_int8_t *)msgb_l3(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000839 struct abis_rsl_rll_hdr *rh;
840
Harald Welte8470bf22008-12-25 23:28:35 +0000841 if (msg->lchan == NULL) {
842 fprintf(stderr, "cannot send DATA REQUEST to unknown lchan\n");
843 return -EINVAL;
844 }
Harald Welte52b1f982008-12-23 20:25:15 +0000845
Harald Welte8470bf22008-12-25 23:28:35 +0000846 /* First push the L3 IE tag and length */
Harald Welte4b634542008-12-27 01:55:51 +0000847 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
Harald Welte8470bf22008-12-25 23:28:35 +0000848
849 /* Then push the RSL header */
Harald Welte52b1f982008-12-23 20:25:15 +0000850 rh = (struct abis_rsl_rll_hdr *) msgb_push(msg, sizeof(*rh));
851 init_llm_hdr(rh, RSL_MT_DATA_REQ);
Harald Welte4a543e82009-02-28 13:17:55 +0000852 rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
Harald Welte8470bf22008-12-25 23:28:35 +0000853 rh->chan_nr = lchan2chan_nr(msg->lchan);
854 rh->link_id = link_id;
Harald Welte52b1f982008-12-23 20:25:15 +0000855
Harald Welte8470bf22008-12-25 23:28:35 +0000856 msg->trx = msg->lchan->ts->trx;
857
858 return abis_rsl_sendmsg(msg);
Harald Welte52b1f982008-12-23 20:25:15 +0000859}
860
Harald Welteedcc5272009-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 Welte1c409272009-08-09 14:13:58 +0200869 init_llm_hdr(rh, RSL_MT_EST_REQ);
Harald Welteedcc5272009-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 Welted2dc1de2009-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 Welte6c3d2ed2009-08-10 00:19:36 +0200894 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, 0); /* normal release */
Harald Welted2dc1de2009-08-08 13:15:07 +0200895
896 msg->trx = lchan->ts->trx;
897
898 return abis_rsl_sendmsg(msg);
899}
900
Harald Welte702d8702008-12-26 20:25:35 +0000901/* 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 */
Harald Welte4b634542008-12-27 01:55:51 +0000908 if (rslh->ie_chan != RSL_IE_CHAN_NR)
909 return -EINVAL;
Harald Welted011e8b2009-11-29 22:45:52 +0100910
911 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
912
Harald Welte4b634542008-12-27 01:55:51 +0000913 return 0;
914}
Harald Welte702d8702008-12-26 20:25:35 +0000915
Harald Welte4b634542008-12-27 01:55:51 +0000916/* Chapter 8.4.3: Channel Activate NACK */
917static int rsl_rx_chan_act_nack(struct msgb *msg)
918{
Harald Welte6dab0552009-05-01 17:21:37 +0000919 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
920 struct tlv_parsed tp;
Harald Welte4b634542008-12-27 01:55:51 +0000921
Harald Welte6dab0552009-05-01 17:21:37 +0000922 /* BTS has rejected channel activation ?!? */
923 if (dh->ie_chan != RSL_IE_CHAN_NR)
Harald Welte4b634542008-12-27 01:55:51 +0000924 return -EINVAL;
Harald Welte6dab0552009-05-01 17:21:37 +0000925
926 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
927 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Welte8830e072009-07-28 17:58:09 +0200928 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
929 TLVP_LEN(&tp, RSL_IE_CAUSE));
930
Harald Welted011e8b2009-11-29 22:45:52 +0100931 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
932
Harald Welte3073a9f2009-08-09 19:50:08 +0200933 lchan_free(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +0000934 return 0;
Harald Welte702d8702008-12-26 20:25:35 +0000935}
936
Harald Welte7f93cea2009-02-23 00:02:59 +0000937/* Chapter 8.4.4: Connection Failure Indication */
938static int rsl_rx_conn_fail(struct msgb *msg)
939{
940 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
941 struct tlv_parsed tp;
942
943 DEBUGPC(DRSL, "CONNECTION FAIL: ");
Harald Welte7f93cea2009-02-23 00:02:59 +0000944
945 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
946
Harald Welte8830e072009-07-28 17:58:09 +0200947 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
948 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
949 TLVP_LEN(&tp, RSL_IE_CAUSE));
950
Holger Freytherf7b2a0e2009-06-02 02:55:17 +0000951 DEBUGPC(DRSL, "RELEASING.\n");
Harald Welte7f93cea2009-02-23 00:02:59 +0000952
953 /* FIXME: only free it after channel release ACK */
Harald Welte115d1032009-08-10 11:43:22 +0200954 return rsl_rf_chan_release(msg->lchan);
Harald Welte7f93cea2009-02-23 00:02:59 +0000955}
956
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100957static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
958 const char *prefix)
959{
Harald Welte6739dfb2009-12-16 16:52:07 +0100960 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
961 prefix, rxlev2dbm(mru->full.rx_lev),
962 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100963 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
964 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
965}
966
967static void print_meas_rep(struct gsm_meas_rep *mr)
968{
Harald Welte6739dfb2009-12-16 16:52:07 +0100969 int i;
970
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100971 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
972
973 if (mr->flags & MEAS_REP_F_DL_DTX)
974 DEBUGPC(DMEAS, "DTXd ");
975
976 print_meas_rep_uni(&mr->ul, "ul");
977 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
978 if (mr->flags & MEAS_REP_F_MS_TO)
979 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
980
981 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte6739dfb2009-12-16 16:52:07 +0100982 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Welte3c7dc6e2009-11-29 19:07:28 +0100983 DEBUGPC(DMEAS, "L1_FPC=%u ",
984 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
985 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
986 }
987
988 if (mr->flags & MEAS_REP_F_UL_DTX)
989 DEBUGPC(DMEAS, "DTXu ");
990 if (mr->flags & MEAS_REP_F_BA1)
991 DEBUGPC(DMEAS, "BA1 ");
992 if (!(mr->flags & MEAS_REP_F_DL_VALID))
993 DEBUGPC(DMEAS, "NOT VALID ");
994 else
995 print_meas_rep_uni(&mr->dl, "dl");
996
997 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte6739dfb2009-12-16 16:52:07 +0100998 for (i = 0; i < mr->num_cell; i++) {
999 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
1000 DEBUGP(DMEAS, "ARFCN=%u BSIC=%u => %d dBm\n", mrc->arfcn, mrc->bsic,
1001 rxlev2dbm(mrc->rxlev));
1002 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001003}
1004
Harald Welte440fed02009-05-01 18:43:47 +00001005static int rsl_rx_meas_res(struct msgb *msg)
1006{
1007 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1008 struct tlv_parsed tp;
Harald Welted12b0fd2009-12-15 21:36:05 +01001009 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001010 u_int8_t len;
1011 const u_int8_t *val;
1012 int rc;
Harald Welte440fed02009-05-01 18:43:47 +00001013
Harald Welted12b0fd2009-12-15 21:36:05 +01001014 memset(mr, 0, sizeof(*mr));
Harald Weltedbb1d882009-11-30 19:16:47 +01001015
Harald Welte440fed02009-05-01 18:43:47 +00001016 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1017
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001018 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1019 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1020 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1021 return -EIO;
1022
1023 /* Mandatory Parts */
Harald Welted12b0fd2009-12-15 21:36:05 +01001024 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001025
1026 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1027 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1028 if (len >= 3) {
1029 if (val[0] & 0x40)
Harald Welted12b0fd2009-12-15 21:36:05 +01001030 mr->flags |= MEAS_REP_F_DL_DTX;
1031 mr->ul.full.rx_lev = val[0] & 0x3f;
1032 mr->ul.sub.rx_lev = val[1] & 0x3f;
1033 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1034 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte440fed02009-05-01 18:43:47 +00001035 }
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001036
Harald Welted12b0fd2009-12-15 21:36:05 +01001037 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001038
1039 /* Optional Parts */
Harald Welte440fed02009-05-01 18:43:47 +00001040 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Welted12b0fd2009-12-15 21:36:05 +01001041 mr->ms_timing_offset =
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001042 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1043
Harald Weltefe9af262009-06-20 18:44:35 +02001044 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001045 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001046 mr->flags |= MEAS_REP_F_MS_L1;
1047 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001048 if (val[0] & 0x04)
Harald Welted12b0fd2009-12-15 21:36:05 +01001049 mr->flags |= MEAS_REP_F_FPC;
1050 mr->ms_l1.ta = val[1];
Harald Weltefe9af262009-06-20 18:44:35 +02001051 }
Harald Weltef7c43522009-06-09 20:24:21 +00001052 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freytherddd918f2009-10-22 15:43:55 +02001053 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Welted12b0fd2009-12-15 21:36:05 +01001054 rc = gsm48_parse_meas_rep(mr, msg);
Harald Welte3c7dc6e2009-11-29 19:07:28 +01001055 if (rc < 0)
1056 return rc;
1057 }
1058
Harald Welted12b0fd2009-12-15 21:36:05 +01001059 print_meas_rep(mr);
Harald Welte60d68f12009-06-05 20:07:43 +00001060
Harald Welted12b0fd2009-12-15 21:36:05 +01001061 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Weltedbb1d882009-11-30 19:16:47 +01001062
Harald Welte75d34a82009-05-23 06:11:13 +00001063 return 0;
Harald Welte440fed02009-05-01 18:43:47 +00001064}
1065
Harald Welted011e8b2009-11-29 22:45:52 +01001066/* Chapter 8.4.7 */
1067static int rsl_rx_hando_det(struct msgb *msg)
1068{
1069 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1070 struct tlv_parsed tp;
1071
1072 DEBUGP(DRSL, "HANDOVER DETECT ");
1073
1074 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1075
1076 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1077 DEBUGPC(DRSL, "access delay = %u\n",
1078 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1079 else
1080 DEBUGPC(DRSL, "\n");
1081
1082 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1083
1084 return 0;
1085}
1086
Harald Welte52b1f982008-12-23 20:25:15 +00001087static int abis_rsl_rx_dchan(struct msgb *msg)
1088{
Harald Welte8470bf22008-12-25 23:28:35 +00001089 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1090 int rc = 0;
Harald Weltef325eb42009-02-19 17:07:39 +00001091 char *ts_name;
Harald Welte52b1f982008-12-23 20:25:15 +00001092
Harald Welte8470bf22008-12-25 23:28:35 +00001093 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +00001094 ts_name = gsm_ts_name(msg->lchan->ts);
1095
Harald Welte10d0e672009-06-27 02:53:10 +02001096 if (rslh->c.msg_type != RSL_MT_MEAS_RES)
1097 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ", ts_name, rslh->chan_nr);
Harald Welte8470bf22008-12-25 23:28:35 +00001098
1099 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001100 case RSL_MT_CHAN_ACTIV_ACK:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001101 DEBUGPC(DRSL, "CHANNEL ACTIVATE ACK\n");
Harald Welte4b634542008-12-27 01:55:51 +00001102 rc = rsl_rx_chan_act_ack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001103 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001104 case RSL_MT_CHAN_ACTIV_NACK:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001105 DEBUGPC(DRSL, "CHANNEL ACTIVATE NACK\n");
Harald Welte4b634542008-12-27 01:55:51 +00001106 rc = rsl_rx_chan_act_nack(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001107 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001108 case RSL_MT_CONN_FAIL:
Harald Welte7f93cea2009-02-23 00:02:59 +00001109 rc = rsl_rx_conn_fail(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001110 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001111 case RSL_MT_MEAS_RES:
Harald Welte440fed02009-05-01 18:43:47 +00001112 rc = rsl_rx_meas_res(msg);
Harald Welte2d5b6382008-12-27 19:46:06 +00001113 break;
Harald Welted011e8b2009-11-29 22:45:52 +01001114 case RSL_MT_HANDO_DET:
1115 rc = rsl_rx_hando_det(msg);
1116 break;
Harald Welte2d5b6382008-12-27 19:46:06 +00001117 case RSL_MT_RF_CHAN_REL_ACK:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001118 DEBUGPC(DRSL, "RF CHANNEL RELEASE ACK\n");
Harald Welte2d5b6382008-12-27 19:46:06 +00001119 lchan_free(msg->lchan);
Harald Welte8470bf22008-12-25 23:28:35 +00001120 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001121 case RSL_MT_MODE_MODIFY_ACK:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001122 DEBUGPC(DRSL, "CHANNEL MODE MODIFY ACK\n");
Harald Welteda783762009-02-18 03:29:53 +00001123 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001124 case RSL_MT_MODE_MODIFY_NACK:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001125 DEBUGPC(DRSL, "CHANNEL MODE MODIFY NACK\n");
Harald Welteda783762009-02-18 03:29:53 +00001126 break;
Harald Welte9c880c92009-10-24 10:29:22 +02001127 case RSL_MT_IPAC_PDCH_ACT_ACK:
1128 DEBUGPC(DRSL, "IPAC PDCH ACT ACK\n");
1129 break;
1130 case RSL_MT_IPAC_PDCH_ACT_NACK:
1131 DEBUGPC(DRSL, "IPAC PDCH ACT NACK\n");
1132 break;
1133 case RSL_MT_IPAC_PDCH_DEACT_ACK:
1134 DEBUGPC(DRSL, "IPAC PDCH DEACT ACK\n");
1135 break;
1136 case RSL_MT_IPAC_PDCH_DEACT_NACK:
1137 DEBUGPC(DRSL, "IPAC PDCH DEACT NACK\n");
1138 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001139 case RSL_MT_PHY_CONTEXT_CONF:
1140 case RSL_MT_PREPROC_MEAS_RES:
Harald Welte52b1f982008-12-23 20:25:15 +00001141 case RSL_MT_TALKER_DET:
1142 case RSL_MT_LISTENER_DET:
1143 case RSL_MT_REMOTE_CODEC_CONF_REP:
1144 case RSL_MT_MR_CODEC_MOD_ACK:
1145 case RSL_MT_MR_CODEC_MOD_NACK:
1146 case RSL_MT_MR_CODEC_MOD_PER:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001147 DEBUGPC(DRSL, "Unimplemented Abis RSL DChan msg 0x%02x\n",
Harald Welte8470bf22008-12-25 23:28:35 +00001148 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001149 break;
1150 default:
Holger Freyther79f4ae62009-06-02 03:25:04 +00001151 DEBUGPC(DRSL, "unknown Abis RSL DChan msg 0x%02x\n",
Harald Welte8470bf22008-12-25 23:28:35 +00001152 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001153 return -EINVAL;
1154 }
Harald Weltef325eb42009-02-19 17:07:39 +00001155
Harald Welte8470bf22008-12-25 23:28:35 +00001156 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001157}
1158
Harald Welte702d8702008-12-26 20:25:35 +00001159static int rsl_rx_error_rep(struct msgb *msg)
1160{
1161 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8830e072009-07-28 17:58:09 +02001162 struct tlv_parsed tp;
Harald Welte702d8702008-12-26 20:25:35 +00001163
Harald Welte7f93cea2009-02-23 00:02:59 +00001164 DEBUGP(DRSL, "ERROR REPORT ");
Harald Welte8830e072009-07-28 17:58:09 +02001165
1166 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1167
1168 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
1169 print_rsl_cause(TLVP_VAL(&tp, RSL_IE_CAUSE),
1170 TLVP_LEN(&tp, RSL_IE_CAUSE));
1171
Holger Freyther79f4ae62009-06-02 03:25:04 +00001172 DEBUGPC(DRSL, "\n");
Harald Welte702d8702008-12-26 20:25:35 +00001173
1174 return 0;
1175}
1176
Harald Welte52b1f982008-12-23 20:25:15 +00001177static int abis_rsl_rx_trx(struct msgb *msg)
1178{
Harald Welte702d8702008-12-26 20:25:35 +00001179 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001180 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001181
1182 switch (rslh->msg_type) {
Harald Welte702d8702008-12-26 20:25:35 +00001183 case RSL_MT_ERROR_REPORT:
1184 rc = rsl_rx_error_rep(msg);
1185 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001186 case RSL_MT_RF_RES_IND:
1187 /* interference on idle channels of TRX */
Harald Welte3cf7c3f2009-05-01 18:28:00 +00001188 //DEBUGP(DRSL, "TRX: RF Interference Indication\n");
Harald Welte8f5e2392009-02-03 12:57:37 +00001189 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001190 case RSL_MT_OVERLOAD:
1191 /* indicate CCCH / ACCH / processor overload */
Harald Weltef325eb42009-02-19 17:07:39 +00001192 DEBUGP(DRSL, "TRX: CCCH/ACCH/CPU Overload\n");
Harald Welte52b1f982008-12-23 20:25:15 +00001193 break;
1194 default:
Harald Weltef325eb42009-02-19 17:07:39 +00001195 DEBUGP(DRSL, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001196 rslh->msg_type);
1197 return -EINVAL;
1198 }
Harald Welte8470bf22008-12-25 23:28:35 +00001199 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001200}
1201
Harald Welteb7e81162009-08-10 00:26:10 +02001202/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1203static void t3101_expired(void *data)
1204{
1205 struct gsm_lchan *lchan = data;
1206
Harald Welte115d1032009-08-10 11:43:22 +02001207 rsl_rf_chan_release(lchan);
Harald Welteb7e81162009-08-10 00:26:10 +02001208}
1209
Harald Welte8470bf22008-12-25 23:28:35 +00001210/* MS has requested a channel on the RACH */
Harald Welte52b1f982008-12-23 20:25:15 +00001211static int rsl_rx_chan_rqd(struct msgb *msg)
1212{
Harald Welte702d8702008-12-26 20:25:35 +00001213 struct gsm_bts *bts = msg->trx->bts;
Harald Welte8470bf22008-12-25 23:28:35 +00001214 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1215 struct gsm48_req_ref *rqd_ref;
Harald Welte52b1f982008-12-23 20:25:15 +00001216 struct gsm48_imm_ass ia;
Harald Welte8470bf22008-12-25 23:28:35 +00001217 enum gsm_chan_t lctype;
Harald Welte2cbe0922008-12-29 04:09:31 +00001218 enum gsm_chreq_reason_t chreq_reason;
Harald Welte8470bf22008-12-25 23:28:35 +00001219 struct gsm_lchan *lchan;
1220 u_int8_t rqd_ta;
Holger Freyther3186bf22008-12-29 06:23:49 +00001221 int ret;
Harald Welte8470bf22008-12-25 23:28:35 +00001222
Harald Welte52b1f982008-12-23 20:25:15 +00001223 u_int16_t arfcn;
1224 u_int8_t ts_number, subch;
1225
Harald Welte8470bf22008-12-25 23:28:35 +00001226 /* parse request reference to be used in immediate assign */
1227 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1228 return -EINVAL;
1229
1230 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1231
1232 /* parse access delay and use as TA */
1233 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1234 return -EINVAL;
1235 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1236
1237 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1238 * request reference RA */
Holger Hans Peter Freytherf7d752f2009-11-16 17:12:38 +01001239 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1240 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte2cbe0922008-12-29 04:09:31 +00001241
Harald Welte8470bf22008-12-25 23:28:35 +00001242 /* check availability / allocate channel */
1243 lchan = lchan_alloc(bts, lctype);
1244 if (!lchan) {
Harald Welte9e2748e2009-12-12 20:53:23 +01001245 DEBUGP(DRSL, "CHAN RQD: no resources for %s 0x%x\n",
1246 gsm_lchan_name(lctype), rqd_ref->ra);
Harald Welte8470bf22008-12-25 23:28:35 +00001247 /* FIXME: send some kind of reject ?!? */
1248 return -ENOMEM;
1249 }
1250
1251 ts_number = lchan->ts->nr;
1252 arfcn = lchan->ts->trx->arfcn;
1253 subch = lchan->nr;
Harald Welte52b1f982008-12-23 20:25:15 +00001254
Harald Welte08d91a52009-08-30 15:37:11 +09001255 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)0e451d02009-08-13 10:14:26 +02001256 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte0b2124b2009-08-10 00:45:40 +02001257 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte9943c5b2009-07-29 15:41:29 +02001258 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte196d0522009-08-28 23:28:28 +09001259 lchan->tch_mode = GSM48_CMODE_SIGN;
Harald Welte9943c5b2009-07-29 15:41:29 +02001260 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta);
Harald Welte52b1f982008-12-23 20:25:15 +00001261
1262 /* create IMMEDIATE ASSIGN 04.08 messge */
1263 memset(&ia, 0, sizeof(ia));
1264 ia.l2_plen = 0x2d;
1265 ia.proto_discr = GSM48_PDISC_RR;
1266 ia.msg_type = GSM48_MT_RR_IMM_ASS;
Harald Welte2d5b6382008-12-27 19:46:06 +00001267 ia.page_mode = GSM48_PM_SAME;
Harald Welte4b634542008-12-27 01:55:51 +00001268 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
Harald Welte52b1f982008-12-23 20:25:15 +00001269 ia.chan_desc.h0.h = 0;
1270 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
1271 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
Harald Welte814c4b72009-07-21 20:55:56 +02001272 ia.chan_desc.h0.tsc = bts->tsc;
Harald Welte8470bf22008-12-25 23:28:35 +00001273 /* use request reference extracted from CHAN_RQD */
1274 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
1275 ia.timing_advance = rqd_ta;
Harald Welte52b1f982008-12-23 20:25:15 +00001276 ia.mob_alloc_len = 0;
1277
Harald Welte8f5e2392009-02-03 12:57:37 +00001278 DEBUGP(DRSL, "Activating ARFCN(%u) TS(%u) SS(%u) lctype %s "
Holger Freyther79f4ae62009-06-02 03:25:04 +00001279 "chan_nr=0x%02x r=%s ra=0x%02x\n",
Harald Welteca64da92009-01-04 16:54:12 +00001280 arfcn, ts_number, subch, gsm_lchan_name(lchan->type),
Harald Welte4a543e82009-02-28 13:17:55 +00001281 ia.chan_desc.chan_nr, gsm_chreq_name(chreq_reason),
1282 rqd_ref->ra);
Harald Welte75a983f2008-12-27 21:34:06 +00001283
Harald Welteb7e81162009-08-10 00:26:10 +02001284 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1285 lchan->T3101.cb = t3101_expired;
1286 lchan->T3101.data = lchan;
Holger Hans Peter Freytherc4d88ad2009-11-21 21:18:38 +01001287 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Holger Freyther3186bf22008-12-29 06:23:49 +00001288
Harald Welte52b1f982008-12-23 20:25:15 +00001289 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
Holger Freyther3186bf22008-12-29 06:23:49 +00001290 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
1291
Harald Welte817f3c82008-12-30 14:57:59 +00001292 return ret;
Harald Welte52b1f982008-12-23 20:25:15 +00001293}
1294
Harald Welteea280442009-02-02 22:29:56 +00001295/* MS has requested a channel on the RACH */
1296static int rsl_rx_ccch_load(struct msgb *msg)
1297{
1298 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1299 u_int16_t pg_buf_space;
Holger Freyther8c563cf2009-02-03 20:08:51 +00001300 u_int16_t rach_slot_count = -1;
1301 u_int16_t rach_busy_count = -1;
1302 u_int16_t rach_access_count = -1;
Harald Welteea280442009-02-02 22:29:56 +00001303
1304 switch (rslh->data[0]) {
1305 case RSL_IE_PAGING_LOAD:
1306 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
Holger Freyther392209c2009-02-10 00:06:19 +00001307 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
Harald Welteea280442009-02-02 22:29:56 +00001308 break;
1309 case RSL_IE_RACH_LOAD:
Holger Freyther8c563cf2009-02-03 20:08:51 +00001310 if (msg->data_len >= 7) {
1311 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1312 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1313 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1314 }
Harald Welteea280442009-02-02 22:29:56 +00001315 break;
1316 default:
1317 break;
1318 }
1319
1320 return 0;
1321}
1322
Harald Welte52b1f982008-12-23 20:25:15 +00001323static int abis_rsl_rx_cchan(struct msgb *msg)
1324{
Harald Welteea280442009-02-02 22:29:56 +00001325 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001326 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001327
Harald Welte8470bf22008-12-25 23:28:35 +00001328 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1329
1330 switch (rslh->c.msg_type) {
Harald Welte52b1f982008-12-23 20:25:15 +00001331 case RSL_MT_CHAN_RQD:
1332 /* MS has requested a channel on the RACH */
1333 rc = rsl_rx_chan_rqd(msg);
1334 break;
Harald Welteea280442009-02-02 22:29:56 +00001335 case RSL_MT_CCCH_LOAD_IND:
1336 /* current load on the CCCH */
1337 rc = rsl_rx_ccch_load(msg);
1338 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001339 case RSL_MT_DELETE_IND:
1340 /* CCCH overloaded, IMM_ASSIGN was dropped */
1341 case RSL_MT_CBCH_LOAD_IND:
1342 /* current load on the CBCH */
Harald Welte8f5e2392009-02-03 12:57:37 +00001343 fprintf(stderr, "Unimplemented Abis RSL TRX message type "
1344 "0x%02x\n", rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001345 break;
1346 default:
1347 fprintf(stderr, "Unknown Abis RSL TRX message type 0x%02x\n",
Harald Welte8470bf22008-12-25 23:28:35 +00001348 rslh->c.msg_type);
Harald Welte52b1f982008-12-23 20:25:15 +00001349 return -EINVAL;
1350 }
Harald Welte8470bf22008-12-25 23:28:35 +00001351
1352 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001353}
1354
Harald Welte4b634542008-12-27 01:55:51 +00001355static int rsl_rx_rll_err_ind(struct msgb *msg)
1356{
1357 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1358 u_int8_t *rlm_cause = rllh->data;
1359
Harald Welte602f2b82009-08-04 02:50:21 +02001360 DEBUGPC(DRLL, "ERROR INDICATION cause=0x%02x\n", rlm_cause[1]);
Harald Welteedcc5272009-08-09 13:47:35 +02001361
1362 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte4b634542008-12-27 01:55:51 +00001363
Harald Welte81543bc2009-07-04 09:40:05 +02001364 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED)
Harald Welte115d1032009-08-10 11:43:22 +02001365 return rsl_rf_chan_release(msg->lchan);
Harald Welte81543bc2009-07-04 09:40:05 +02001366
Harald Welte4b634542008-12-27 01:55:51 +00001367 return 0;
1368}
Harald Weltef325eb42009-02-19 17:07:39 +00001369
Harald Welte52b1f982008-12-23 20:25:15 +00001370/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
1371 0x02, 0x06,
1372 0x01, 0x20,
1373 0x02, 0x00,
1374 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1375
1376static int abis_rsl_rx_rll(struct msgb *msg)
1377{
1378 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltef325eb42009-02-19 17:07:39 +00001379 int rc = 0;
1380 char *ts_name;
Harald Welte (local)daef6062009-08-14 11:41:12 +02001381 u_int8_t sapi = rllh->link_id & 7;
Harald Welte8470bf22008-12-25 23:28:35 +00001382
1383 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +00001384 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Welte (local)daef6062009-08-14 11:41:12 +02001385 DEBUGP(DRLL, "channel=%s chan_nr=0x%02x sapi=%u ", ts_name,
1386 rllh->chan_nr, sapi);
Harald Welte52b1f982008-12-23 20:25:15 +00001387
1388 switch (rllh->c.msg_type) {
1389 case RSL_MT_DATA_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001390 DEBUGPC(DRLL, "DATA INDICATION\n");
Harald Welte4a543e82009-02-28 13:17:55 +00001391 if (msgb_l2len(msg) >
1392 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1393 rllh->data[0] == RSL_IE_L3_INFO) {
1394 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001395 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001396 }
Harald Welte52b1f982008-12-23 20:25:15 +00001397 break;
1398 case RSL_MT_EST_IND:
Harald Weltef325eb42009-02-19 17:07:39 +00001399 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welteb7e81162009-08-10 00:26:10 +02001400 /* lchan is established, stop T3101 */
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001401 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welteb7e81162009-08-10 00:26:10 +02001402 bsc_del_timer(&msg->lchan->T3101);
Harald Welte4a543e82009-02-28 13:17:55 +00001403 if (msgb_l2len(msg) >
1404 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1405 rllh->data[0] == RSL_IE_L3_INFO) {
1406 msg->l3h = &rllh->data[3];
Harald Welte (local)daef6062009-08-14 11:41:12 +02001407 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte4a543e82009-02-28 13:17:55 +00001408 }
Harald Welte52b1f982008-12-23 20:25:15 +00001409 break;
Harald Welteedcc5272009-08-09 13:47:35 +02001410 case RSL_MT_EST_CONF:
Harald Welte1c409272009-08-09 14:13:58 +02001411 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001412 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteedcc5272009-08-09 13:47:35 +02001413 rll_indication(msg->lchan, rllh->link_id,
1414 BSC_RLLR_IND_EST_CONF);
1415 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001416 case RSL_MT_REL_IND:
Harald Welted2dc1de2009-08-08 13:15:07 +02001417 /* BTS informs us of having received DISC from MS */
Harald Welte602f2b82009-08-04 02:50:21 +02001418 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001419 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteedcc5272009-08-09 13:47:35 +02001420 rll_indication(msg->lchan, rllh->link_id,
1421 BSC_RLLR_IND_REL_IND);
Harald Welted2dc1de2009-08-08 13:15:07 +02001422 /* we can now releae the channel on the BTS/Abis side */
Harald Welte115d1032009-08-10 11:43:22 +02001423 /* FIXME: officially we need to start T3111 and wait for
1424 * some grace period */
1425 rsl_rf_chan_release(msg->lchan);
Harald Welte2d5b6382008-12-27 19:46:06 +00001426 break;
1427 case RSL_MT_REL_CONF:
Harald Welted2dc1de2009-08-08 13:15:07 +02001428 /* BTS informs us of having received UA from MS,
1429 * in response to DISC that we've sent earlier */
Harald Welte602f2b82009-08-04 02:50:21 +02001430 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freyther5ba6f482009-10-28 14:23:39 +01001431 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welted2dc1de2009-08-08 13:15:07 +02001432 /* we can now releae the channel on the BTS/Abis side */
Harald Welte115d1032009-08-10 11:43:22 +02001433 /* FIXME: officially we need to start T3111 and wait for
1434 * some grace period */
1435 rsl_rf_chan_release(msg->lchan);
Harald Welte4b634542008-12-27 01:55:51 +00001436 break;
1437 case RSL_MT_ERROR_IND:
1438 rc = rsl_rx_rll_err_ind(msg);
1439 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001440 case RSL_MT_UNIT_DATA_IND:
Harald Welte602f2b82009-08-04 02:50:21 +02001441 DEBUGPC(DRLL, "unimplemented Abis RLL message type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001442 rllh->c.msg_type);
1443 break;
1444 default:
Harald Welte602f2b82009-08-04 02:50:21 +02001445 DEBUGPC(DRLL, "unknown Abis RLL message type 0x%02x\n",
Harald Welte52b1f982008-12-23 20:25:15 +00001446 rllh->c.msg_type);
1447 }
Harald Welte8470bf22008-12-25 23:28:35 +00001448 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001449}
1450
Harald Welte0603c9d2009-12-02 01:58:23 +05301451static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Weltef4e79f22009-07-28 18:11:56 +02001452{
Harald Welte0603c9d2009-12-02 01:58:23 +05301453 switch (lchan->tch_mode) {
Harald Weltef4e79f22009-07-28 18:11:56 +02001454 case GSM48_CMODE_SPEECH_V1:
Harald Welte0603c9d2009-12-02 01:58:23 +05301455 switch (lchan->type) {
1456 case GSM_LCHAN_TCH_F:
1457 return 0x00;
1458 case GSM_LCHAN_TCH_H:
1459 return 0x03;
1460 default:
1461 break;
1462 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001463 case GSM48_CMODE_SPEECH_EFR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301464 switch (lchan->type) {
1465 case GSM_LCHAN_TCH_F:
1466 return 0x01;
1467 /* there's no half-rate EFR */
1468 default:
1469 break;
1470 }
Harald Weltef4e79f22009-07-28 18:11:56 +02001471 case GSM48_CMODE_SPEECH_AMR:
Harald Welte0603c9d2009-12-02 01:58:23 +05301472 switch (lchan->type) {
1473 case GSM_LCHAN_TCH_F:
1474 return 0x02;
1475 case GSM_LCHAN_TCH_H:
1476 return 0x05;
1477 default:
1478 break;
1479 }
1480 default:
1481 break;
Harald Weltef4e79f22009-07-28 18:11:56 +02001482 }
Harald Welte58ca5b72009-07-29 12:12:18 +02001483 DEBUGPC(DRSL, "Cannot determine ip.access speech mode for "
Harald Welte0603c9d2009-12-02 01:58:23 +05301484 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001485 return 0;
Harald Weltef4e79f22009-07-28 18:11:56 +02001486}
1487
Harald Welte75099262009-02-16 21:12:08 +00001488/* ip.access specific RSL extensions */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001489int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte75099262009-02-16 21:12:08 +00001490{
1491 struct msgb *msg = rsl_msgb_alloc();
1492 struct abis_rsl_dchan_hdr *dh;
Harald Welte58ca5b72009-07-29 12:12:18 +02001493 u_int8_t speech_mode;
Harald Welte75099262009-02-16 21:12:08 +00001494
1495 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001496 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte75099262009-02-16 21:12:08 +00001497 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1498 dh->chan_nr = lchan2chan_nr(lchan);
1499
Harald Weltef4e79f22009-07-28 18:11:56 +02001500 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Welte0603c9d2009-12-02 01:58:23 +05301501 speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001502 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001503
Harald Welte58ca5b72009-07-29 12:12:18 +02001504 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_BIND "
1505 "speech_mode=0x%02x\n", gsm_ts_name(lchan->ts),
1506 dh->chan_nr, speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001507
Harald Welte75099262009-02-16 21:12:08 +00001508 msg->trx = lchan->ts->trx;
1509
1510 return abis_rsl_sendmsg(msg);
1511}
1512
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001513int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Welte20855542009-07-12 09:50:35 +02001514 u_int16_t conn_id, u_int8_t rtp_payload2)
Harald Welte75099262009-02-16 21:12:08 +00001515{
1516 struct msgb *msg = rsl_msgb_alloc();
1517 struct abis_rsl_dchan_hdr *dh;
1518 u_int8_t *att_f8, *att_ip, *att_port;
Harald Welte58ca5b72009-07-29 12:12:18 +02001519 u_int8_t speech_mode;
Harald Weltef4e79f22009-07-28 18:11:56 +02001520 struct in_addr ia;
Harald Welte75099262009-02-16 21:12:08 +00001521
1522 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001523 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte75099262009-02-16 21:12:08 +00001524 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1525 dh->chan_nr = lchan2chan_nr(lchan);
1526
Harald Welte58ca5b72009-07-29 12:12:18 +02001527 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Welte0603c9d2009-12-02 01:58:23 +05301528 speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Harald Welte58ca5b72009-07-29 12:12:18 +02001529
Harald Weltef4e79f22009-07-28 18:11:56 +02001530 ia.s_addr = htonl(ip);
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001531 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_MDCX "
Harald Welte58ca5b72009-07-29 12:12:18 +02001532 "IP=%s PORT=%d RTP_PAYLOAD2=%d CONN_ID=%d speech_mode=0x%02x\n",
Harald Weltef4e79f22009-07-28 18:11:56 +02001533 gsm_ts_name(lchan->ts), dh->chan_nr,
Harald Welte58ca5b72009-07-29 12:12:18 +02001534 inet_ntoa(ia), port, rtp_payload2, conn_id, speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001535
Harald Welte20855542009-07-12 09:50:35 +02001536 att_f8 = msgb_put(msg, sizeof(conn_id)+1);
Harald Welte86c162d2009-07-12 09:45:05 +02001537 att_f8[0] = RSL_IE_IPAC_CONN_ID;
Harald Welte20855542009-07-12 09:50:35 +02001538 att_f8[1] = conn_id >> 8;
1539 att_f8[2] = conn_id & 0xff;
Harald Welte75099262009-02-16 21:12:08 +00001540
1541 att_ip = msgb_put(msg, sizeof(ip)+1);
1542 att_ip[0] = RSL_IE_IPAC_REMOTE_IP;
1543 att_ip[1] = ip >> 24;
1544 att_ip[2] = ip >> 16;
1545 att_ip[3] = ip >> 8;
1546 att_ip[4] = ip & 0xff;
Harald Welteda783762009-02-18 03:29:53 +00001547 //att_ip[4] = 11;
Harald Welte75099262009-02-16 21:12:08 +00001548
1549 att_port = msgb_put(msg, sizeof(port)+1);
1550 att_port[0] = RSL_IE_IPAC_REMOTE_PORT;
1551 att_port[1] = port >> 8;
1552 att_port[2] = port & 0xff;
1553
Harald Welte58ca5b72009-07-29 12:12:18 +02001554 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, speech_mode);
Harald Weltef4e79f22009-07-28 18:11:56 +02001555 if (rtp_payload2)
1556 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1557
Harald Welte75099262009-02-16 21:12:08 +00001558 msg->trx = lchan->ts->trx;
1559
1560 return abis_rsl_sendmsg(msg);
1561}
1562
Harald Welte9c880c92009-10-24 10:29:22 +02001563int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan)
1564{
1565 struct msgb *msg = rsl_msgb_alloc();
1566 struct abis_rsl_dchan_hdr *dh;
1567
1568 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
1569 init_dchan_hdr(dh, RSL_MT_IPAC_PDCH_ACT);
1570 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1571 dh->chan_nr = lchan2chan_nr(lchan);
1572
1573 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x IPAC_PDCH_ACT\n",
1574 gsm_ts_name(lchan->ts), dh->chan_nr);
1575
1576 msg->trx = lchan->ts->trx;
1577
1578 return abis_rsl_sendmsg(msg);
1579}
1580
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001581static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001582{
1583 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1584 struct tlv_parsed tv;
Harald Welte2c828992009-12-02 01:56:49 +05301585 struct gsm_lchan *lchan = msg->lchan;
Harald Welte167df882009-02-17 14:35:45 +00001586 struct in_addr ip;
Harald Welte75099262009-02-16 21:12:08 +00001587 u_int16_t port, attr_f8;
1588
1589 /* the BTS has acknowledged a local bind, it now tells us the IP
1590 * address and port number to which it has bound the given logical
1591 * channel */
1592
1593 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1594 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1595 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welte86c162d2009-07-12 09:45:05 +02001596 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltef325eb42009-02-19 17:07:39 +00001597 DEBUGPC(DRSL, "mandatory IE missing");
Harald Welte75099262009-02-16 21:12:08 +00001598 return -EINVAL;
1599 }
Harald Welte167df882009-02-17 14:35:45 +00001600 ip.s_addr = *((u_int32_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_IP));
Harald Welte75099262009-02-16 21:12:08 +00001601 port = *((u_int16_t *) TLVP_VAL(&tv, RSL_IE_IPAC_LOCAL_PORT));
1602 attr_f8 = *((u_int16_t *) TLVP_VAL(&tv, 0xf8));
1603
Harald Weltef4e79f22009-07-28 18:11:56 +02001604 DEBUGPC(DRSL, "IP=%s PORT=%d CONN_ID=%d ",
1605 inet_ntoa(ip), ntohs(port), ntohs(attr_f8));
1606
1607 if (TLVP_PRESENT(&tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
Harald Welte2c828992009-12-02 01:56:49 +05301608 lchan->abis_ip.rtp_payload2 =
Harald Weltef4e79f22009-07-28 18:11:56 +02001609 *TLVP_VAL(&tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1610 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
Harald Welte2c828992009-12-02 01:56:49 +05301611 lchan->abis_ip.rtp_payload2);
Harald Weltef4e79f22009-07-28 18:11:56 +02001612 }
Harald Welte167df882009-02-17 14:35:45 +00001613
Harald Welte75099262009-02-16 21:12:08 +00001614 /* update our local information about this TS */
Harald Welte2c828992009-12-02 01:56:49 +05301615 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1616 lchan->abis_ip.bound_port = ntohs(port);
1617 lchan->abis_ip.conn_id = ntohs(attr_f8);
Harald Welte75099262009-02-16 21:12:08 +00001618
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001619 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte167df882009-02-17 14:35:45 +00001620
Harald Welte75099262009-02-16 21:12:08 +00001621 return 0;
1622}
1623
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001624static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte75099262009-02-16 21:12:08 +00001625{
1626 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1627 struct tlv_parsed tv;
1628
1629 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte75099262009-02-16 21:12:08 +00001630
Harald Welte8830e072009-07-28 17:58:09 +02001631 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
1632 print_rsl_cause(TLVP_VAL(&tv, RSL_IE_CAUSE),
1633 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte75099262009-02-16 21:12:08 +00001634
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001635 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welte888b1142009-07-28 18:02:05 +02001636
Harald Welte75099262009-02-16 21:12:08 +00001637 return 0;
1638}
1639
1640static int abis_rsl_rx_ipacc(struct msgb *msg)
1641{
1642 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1643 int rc = 0;
1644
1645 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltef325eb42009-02-19 17:07:39 +00001646 DEBUGP(DRSL, "channel=%s chan_nr=0x%02x ",
1647 gsm_ts_name(msg->lchan->ts), rllh->chan_nr);
Harald Welte75099262009-02-16 21:12:08 +00001648
1649 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001650 case RSL_MT_IPAC_CRCX_ACK:
1651 DEBUGPC(DRSL, "IPAC_CRCX_ACK ");
1652 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte75099262009-02-16 21:12:08 +00001653 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001654 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001655 /* somehow the BTS was unable to bind the lchan to its local
1656 * port?!? */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001657 DEBUGPC(DRSL, "IPAC_CRCX_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001658 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001659 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte75099262009-02-16 21:12:08 +00001660 /* the BTS tells us that a connect operation was successful */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001661 DEBUGPC(DRSL, "IPAC_MDCX_ACK ");
Harald Welte75099262009-02-16 21:12:08 +00001662 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001663 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte75099262009-02-16 21:12:08 +00001664 /* somehow the BTS was unable to connect the lchan to a remote
1665 * port */
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001666 DEBUGPC(DRSL, "IPAC_MDCX_NACK ");
Harald Welte75099262009-02-16 21:12:08 +00001667 break;
Holger Hans Peter Freyther231163d2009-11-18 21:06:12 +01001668 case RSL_MT_IPAC_DLCX_IND:
1669 DEBUGPC(DRSL, "IPAC_DLCX_IND ");
1670 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte75099262009-02-16 21:12:08 +00001671 break;
1672 default:
Harald Weltef325eb42009-02-19 17:07:39 +00001673 DEBUGPC(DRSL, "Unknown ip.access msg_type 0x%02x", rllh->c.msg_type);
Harald Welte75099262009-02-16 21:12:08 +00001674 break;
1675 }
Harald Welte6dab0552009-05-01 17:21:37 +00001676 DEBUGPC(DRSL, "\n");
Harald Welte75099262009-02-16 21:12:08 +00001677
1678 return rc;
1679}
1680
1681
Harald Welte52b1f982008-12-23 20:25:15 +00001682/* Entry-point where L2 RSL from BTS enters */
Harald Welte8470bf22008-12-25 23:28:35 +00001683int abis_rsl_rcvmsg(struct msgb *msg)
Harald Welte52b1f982008-12-23 20:25:15 +00001684{
1685 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
Harald Welte8f5e2392009-02-03 12:57:37 +00001686 int rc = 0;
Harald Welte52b1f982008-12-23 20:25:15 +00001687
1688 switch (rslh->msg_discr & 0xfe) {
1689 case ABIS_RSL_MDISC_RLL:
1690 rc = abis_rsl_rx_rll(msg);
1691 break;
1692 case ABIS_RSL_MDISC_DED_CHAN:
1693 rc = abis_rsl_rx_dchan(msg);
1694 break;
1695 case ABIS_RSL_MDISC_COM_CHAN:
Harald Welte52b1f982008-12-23 20:25:15 +00001696 rc = abis_rsl_rx_cchan(msg);
1697 break;
Harald Welte8470bf22008-12-25 23:28:35 +00001698 case ABIS_RSL_MDISC_TRX:
1699 rc = abis_rsl_rx_trx(msg);
1700 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001701 case ABIS_RSL_MDISC_LOC:
Harald Welte8f5e2392009-02-03 12:57:37 +00001702 fprintf(stderr, "unimplemented RSL msg disc 0x%02x\n",
1703 rslh->msg_discr);
1704 break;
Harald Welte75099262009-02-16 21:12:08 +00001705 case ABIS_RSL_MDISC_IPACCESS:
1706 rc = abis_rsl_rx_ipacc(msg);
1707 break;
Harald Welte52b1f982008-12-23 20:25:15 +00001708 default:
1709 fprintf(stderr, "unknown RSL message discriminator 0x%02x\n",
1710 rslh->msg_discr);
1711 return -EINVAL;
1712 }
Harald Welte4f4a3902008-12-26 00:04:49 +00001713 msgb_free(msg);
Harald Welte8470bf22008-12-25 23:28:35 +00001714 return rc;
Harald Welte52b1f982008-12-23 20:25:15 +00001715}
Holger Freyther3b72a892009-02-04 00:31:39 +00001716
1717
Holger Hans Peter Freyther3d571832009-07-09 20:43:16 +02001718/* Section 3.3.2.3 TS 05.02. I think this looks like a table */
Holger Freyther3b72a892009-02-04 00:31:39 +00001719int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1720{
1721 switch (ccch_conf) {
1722 case RSL_BCCH_CCCH_CONF_1_NC:
1723 return 1;
1724 case RSL_BCCH_CCCH_CONF_1_C:
1725 return 1;
1726 case RSL_BCCH_CCCH_CONF_2_NC:
1727 return 2;
1728 case RSL_BCCH_CCCH_CONF_3_NC:
1729 return 3;
1730 case RSL_BCCH_CCCH_CONF_4_NC:
1731 return 4;
1732 default:
1733 return -1;
1734 }
1735}
1736
Holger Hans Peter Freyther3d571832009-07-09 20:43:16 +02001737/* Section 3.3.2.3 TS 05.02 */
Holger Freyther3b72a892009-02-04 00:31:39 +00001738int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1739{
1740 switch (ccch_conf) {
1741 case RSL_BCCH_CCCH_CONF_1_NC:
1742 return 0;
1743 case RSL_BCCH_CCCH_CONF_1_C:
1744 return 1;
1745 case RSL_BCCH_CCCH_CONF_2_NC:
1746 return 0;
1747 case RSL_BCCH_CCCH_CONF_3_NC:
1748 return 0;
1749 case RSL_BCCH_CCCH_CONF_4_NC:
1750 return 0;
1751 default:
1752 return -1;
1753 }
1754}
1755
1756/* From Table 10.5.33 of GSM 04.08 */
1757int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1758{
Harald Weltea43f7892009-12-01 18:04:30 +05301759 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1760 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1761 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001762 } else {
Harald Weltea43f7892009-12-01 18:04:30 +05301763 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1764 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Holger Freyther3b72a892009-02-04 00:31:39 +00001765 }
1766}