blob: aa31270131b504a3aaa97d43a8bce5bc1a20e588 [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 Welte50517742009-12-20 15:42:44 +010042#include <openbsc/rtp_proxy.h>
Harald Welte59b04682009-06-10 05:40:52 +080043
44#define RSL_ALLOC_SIZE 1024
45#define RSL_ALLOC_HEADROOM 128
46
47#define MAX(a, b) (a) >= (b) ? (a) : (b)
48
49static const struct tlv_definition rsl_att_tlvdef = {
50 .def = {
51 [RSL_IE_CHAN_NR] = { TLV_TYPE_TV },
52 [RSL_IE_LINK_IDENT] = { TLV_TYPE_TV },
53 [RSL_IE_ACT_TYPE] = { TLV_TYPE_TV },
54 [RSL_IE_BS_POWER] = { TLV_TYPE_TV },
55 [RSL_IE_CHAN_IDENT] = { TLV_TYPE_TLV },
56 [RSL_IE_CHAN_MODE] = { TLV_TYPE_TLV },
57 [RSL_IE_ENCR_INFO] = { TLV_TYPE_TLV },
58 [RSL_IE_FRAME_NUMBER] = { TLV_TYPE_FIXED, 2 },
59 [RSL_IE_HANDO_REF] = { TLV_TYPE_TV },
60 [RSL_IE_L1_INFO] = { TLV_TYPE_FIXED, 2 },
61 [RSL_IE_L3_INFO] = { TLV_TYPE_TL16V },
62 [RSL_IE_MS_IDENTITY] = { TLV_TYPE_TLV },
63 [RSL_IE_MS_POWER] = { TLV_TYPE_TV },
64 [RSL_IE_PAGING_GROUP] = { TLV_TYPE_TV },
65 [RSL_IE_PAGING_LOAD] = { TLV_TYPE_FIXED, 2 },
66 [RSL_IE_PYHS_CONTEXT] = { TLV_TYPE_TLV },
67 [RSL_IE_ACCESS_DELAY] = { TLV_TYPE_TV },
68 [RSL_IE_RACH_LOAD] = { TLV_TYPE_TLV },
69 [RSL_IE_REQ_REFERENCE] = { TLV_TYPE_FIXED, 3 },
70 [RSL_IE_RELEASE_MODE] = { TLV_TYPE_TV },
71 [RSL_IE_RESOURCE_INFO] = { TLV_TYPE_TLV },
72 [RSL_IE_RLM_CAUSE] = { TLV_TYPE_TLV },
73 [RSL_IE_STARTNG_TIME] = { TLV_TYPE_FIXED, 2 },
74 [RSL_IE_TIMING_ADVANCE] = { TLV_TYPE_TV },
75 [RSL_IE_UPLINK_MEAS] = { TLV_TYPE_TLV },
76 [RSL_IE_CAUSE] = { TLV_TYPE_TLV },
77 [RSL_IE_MEAS_RES_NR] = { TLV_TYPE_TV },
78 [RSL_IE_MSG_ID] = { TLV_TYPE_TV },
79 [RSL_IE_SYSINFO_TYPE] = { TLV_TYPE_TV },
80 [RSL_IE_MS_POWER_PARAM] = { TLV_TYPE_TLV },
81 [RSL_IE_BS_POWER_PARAM] = { TLV_TYPE_TLV },
82 [RSL_IE_PREPROC_PARAM] = { TLV_TYPE_TLV },
83 [RSL_IE_PREPROC_MEAS] = { TLV_TYPE_TLV },
84 [RSL_IE_IMM_ASS_INFO] = { TLV_TYPE_TLV },
85 [RSL_IE_SMSCB_INFO] = { TLV_TYPE_FIXED, 23 },
86 [RSL_IE_MS_TIMING_OFFSET] = { TLV_TYPE_TV },
87 [RSL_IE_ERR_MSG] = { TLV_TYPE_TLV },
88 [RSL_IE_FULL_BCCH_INFO] = { TLV_TYPE_TLV },
89 [RSL_IE_CHAN_NEEDED] = { TLV_TYPE_TV },
90 [RSL_IE_CB_CMD_TYPE] = { TLV_TYPE_TV },
91 [RSL_IE_SMSCB_MSG] = { TLV_TYPE_TLV },
92 [RSL_IE_FULL_IMM_ASS_INFO] = { TLV_TYPE_TLV },
93 [RSL_IE_SACCH_INFO] = { TLV_TYPE_TLV },
94 [RSL_IE_CBCH_LOAD_INFO] = { TLV_TYPE_TV },
95 [RSL_IE_SMSCB_CHAN_INDICATOR] = { TLV_TYPE_TV },
96 [RSL_IE_GROUP_CALL_REF] = { TLV_TYPE_TLV },
97 [RSL_IE_CHAN_DESC] = { TLV_TYPE_TLV },
98 [RSL_IE_NCH_DRX_INFO] = { TLV_TYPE_TLV },
99 [RSL_IE_CMD_INDICATOR] = { TLV_TYPE_TLV },
100 [RSL_IE_EMLPP_PRIO] = { TLV_TYPE_TV },
101 [RSL_IE_UIC] = { TLV_TYPE_TLV },
102 [RSL_IE_MAIN_CHAN_REF] = { TLV_TYPE_TV },
103 [RSL_IE_MR_CONFIG] = { TLV_TYPE_TLV },
104 [RSL_IE_MR_CONTROL] = { TLV_TYPE_TV },
105 [RSL_IE_SUP_CODEC_TYPES] = { TLV_TYPE_TLV },
106 [RSL_IE_CODEC_CONFIG] = { TLV_TYPE_TLV },
107 [RSL_IE_RTD] = { TLV_TYPE_TV },
108 [RSL_IE_TFO_STATUS] = { TLV_TYPE_TV },
109 [RSL_IE_LLP_APDU] = { TLV_TYPE_TLV },
Harald Welte4684e632009-08-10 09:51:40 +0200110 [RSL_IE_SIEMENS_MRPCI] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200111 [RSL_IE_IPAC_PROXY_UDP] = { TLV_TYPE_FIXED, 2 },
112 [RSL_IE_IPAC_BSCMPL_TOUT] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800113 [RSL_IE_IPAC_REMOTE_IP] = { TLV_TYPE_FIXED, 4 },
114 [RSL_IE_IPAC_REMOTE_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welte1610d302009-07-12 09:56:39 +0200115 [RSL_IE_IPAC_RTP_PAYLOAD] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800116 [RSL_IE_IPAC_LOCAL_PORT] = { TLV_TYPE_FIXED, 2 },
Harald Welteb9498952009-07-12 09:45:05 +0200117 [RSL_IE_IPAC_SPEECH_MODE] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200118 [RSL_IE_IPAC_LOCAL_IP] = { TLV_TYPE_FIXED, 4 },
Harald Welteb9498952009-07-12 09:45:05 +0200119 [RSL_IE_IPAC_CONN_ID] = { TLV_TYPE_FIXED, 2 },
Harald Welte1610d302009-07-12 09:56:39 +0200120 [RSL_IE_IPAC_RTP_CSD_FMT] = { TLV_TYPE_TV },
121 [RSL_IE_IPAC_RTP_JIT_BUF] = { TLV_TYPE_FIXED, 2 },
122 [RSL_IE_IPAC_RTP_COMPR] = { TLV_TYPE_TV },
Harald Welteb9498952009-07-12 09:45:05 +0200123 [RSL_IE_IPAC_RTP_PAYLOAD2] = { TLV_TYPE_TV },
Harald Welte1610d302009-07-12 09:56:39 +0200124 [RSL_IE_IPAC_RTP_MPLEX] = { TLV_TYPE_FIXED, 8 },
125 [RSL_IE_IPAC_RTP_MPLEX_ID] = { TLV_TYPE_TV },
Harald Welte59b04682009-06-10 05:40:52 +0800126 },
127};
128#define rsl_tlv_parse(dec, buf, len) \
129 tlv_parse(dec, &rsl_att_tlvdef, buf, len, 0, 0)
130
131static u_int8_t mdisc_by_msgtype(u_int8_t msg_type)
132{
133 /* mask off the transparent bit ? */
134 msg_type &= 0xfe;
135
136 if ((msg_type & 0xf0) == 0x00)
137 return ABIS_RSL_MDISC_RLL;
138 if ((msg_type & 0xf0) == 0x10) {
139 if (msg_type >= 0x19 && msg_type <= 0x22)
140 return ABIS_RSL_MDISC_TRX;
141 else
142 return ABIS_RSL_MDISC_COM_CHAN;
143 }
144 if ((msg_type & 0xe0) == 0x20)
145 return ABIS_RSL_MDISC_DED_CHAN;
146
147 return ABIS_RSL_MDISC_LOC;
148}
149
150static inline void init_dchan_hdr(struct abis_rsl_dchan_hdr *dh,
151 u_int8_t msg_type)
152{
153 dh->c.msg_discr = mdisc_by_msgtype(msg_type);
154 dh->c.msg_type = msg_type;
155 dh->ie_chan = RSL_IE_CHAN_NR;
156}
157
158static inline void init_llm_hdr(struct abis_rsl_rll_hdr *dh,
159 u_int8_t msg_type)
160{
161 /* dh->c.msg_discr = mdisc_by_msgtype(msg_type); */
162 dh->c.msg_discr = ABIS_RSL_MDISC_RLL;
163 dh->c.msg_type = msg_type;
164 dh->ie_chan = RSL_IE_CHAN_NR;
165 dh->ie_link_id = RSL_IE_LINK_IDENT;
166}
167
168
169/* encode channel number as per Section 9.3.1 */
170u_int8_t rsl_enc_chan_nr(u_int8_t type, u_int8_t subch, u_int8_t timeslot)
171{
172 u_int8_t ret;
173
174 ret = (timeslot & 0x07) | type;
175
176 switch (type) {
177 case RSL_CHAN_Lm_ACCHs:
178 subch &= 0x01;
179 break;
180 case RSL_CHAN_SDCCH4_ACCH:
181 subch &= 0x07;
182 break;
183 case RSL_CHAN_SDCCH8_ACCH:
184 subch &= 0x07;
185 break;
186 default:
187 /* no subchannels allowed */
188 subch = 0x00;
189 break;
190 }
191 ret |= (subch << 3);
192
193 return ret;
194}
195
196/* determine logical channel based on TRX and channel number IE */
197struct gsm_lchan *lchan_lookup(struct gsm_bts_trx *trx, u_int8_t chan_nr)
198{
199 struct gsm_lchan *lchan;
200 u_int8_t ts_nr = chan_nr & 0x07;
201 u_int8_t cbits = chan_nr >> 3;
202 u_int8_t lch_idx;
203 struct gsm_bts_trx_ts *ts = &trx->ts[ts_nr];
204
205 if (cbits == 0x01) {
206 lch_idx = 0; /* TCH/F */
Harald Welte37884ed2009-10-24 10:25:50 +0200207 if (ts->pchan != GSM_PCHAN_TCH_F &&
208 ts->pchan != GSM_PCHAN_PDCH &&
209 ts->pchan != GSM_PCHAN_TCH_F_PDCH)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100210 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800211 chan_nr, ts->pchan);
212 } else if ((cbits & 0x1e) == 0x02) {
213 lch_idx = cbits & 0x1; /* TCH/H */
214 if (ts->pchan != GSM_PCHAN_TCH_H)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100215 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800216 chan_nr, ts->pchan);
217 } else if ((cbits & 0x1c) == 0x04) {
218 lch_idx = cbits & 0x3; /* SDCCH/4 */
219 if (ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100220 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800221 chan_nr, ts->pchan);
222 } else if ((cbits & 0x18) == 0x08) {
223 lch_idx = cbits & 0x7; /* SDCCH/8 */
224 if (ts->pchan != GSM_PCHAN_SDCCH8_SACCH8C)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100225 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800226 chan_nr, ts->pchan);
227 } else if (cbits == 0x10 || cbits == 0x11 || cbits == 0x12) {
228 lch_idx = 0;
229 if (ts->pchan != GSM_PCHAN_CCCH &&
230 ts->pchan != GSM_PCHAN_CCCH_SDCCH4)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100231 LOGP(DRSL, LOGL_ERROR, "chan_nr=0x%02x but pchan=%u\n",
Harald Welte59b04682009-06-10 05:40:52 +0800232 chan_nr, ts->pchan);
233 /* FIXME: we should not return first sdcch4 !!! */
234 } else {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100235 LOGP(DRSL, LOGL_ERROR, "unknown chan_nr=0x%02x\n", chan_nr);
Harald Welte59b04682009-06-10 05:40:52 +0800236 return NULL;
237 }
238
239 lchan = &ts->lchan[lch_idx];
Holger Hans Peter Freytherc8d862e2009-12-22 22:32:51 +0100240 debug_set_context(BSC_CTX_LCHAN, lchan);
241 debug_set_context(BSC_CTX_SUBSCR, lchan->subscr);
Harald Welte59b04682009-06-10 05:40:52 +0800242
243 return lchan;
244}
245
Holger Hans Peter Freyther942ff172009-10-22 11:47:45 +0200246/* See Table 10.5.25 of GSM04.08 */
Harald Welteb5586242009-12-09 19:18:32 +0100247u_int8_t lchan2chan_nr(const struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +0800248{
249 struct gsm_bts_trx_ts *ts = lchan->ts;
250 u_int8_t cbits, chan_nr;
251
252 switch (ts->pchan) {
253 case GSM_PCHAN_TCH_F:
Harald Welte37884ed2009-10-24 10:25:50 +0200254 case GSM_PCHAN_PDCH:
255 case GSM_PCHAN_TCH_F_PDCH:
Harald Welte59b04682009-06-10 05:40:52 +0800256 cbits = 0x01;
257 break;
258 case GSM_PCHAN_TCH_H:
259 cbits = 0x02;
260 cbits += lchan->nr;
261 break;
262 case GSM_PCHAN_CCCH_SDCCH4:
263 cbits = 0x04;
264 cbits += lchan->nr;
265 break;
266 case GSM_PCHAN_SDCCH8_SACCH8C:
267 cbits = 0x08;
268 cbits += lchan->nr;
269 break;
270 default:
271 case GSM_PCHAN_CCCH:
272 cbits = 0x10;
273 break;
274 }
275
276 chan_nr = (cbits << 3) | (ts->nr & 0x7);
277
278 return chan_nr;
279}
280
281/* As per TS 03.03 Section 2.2, the IMSI has 'not more than 15 digits' */
282u_int64_t str_to_imsi(const char *imsi_str)
283{
284 u_int64_t ret;
285
286 ret = strtoull(imsi_str, NULL, 10);
287
288 return ret;
289}
290
291/* Table 5 Clause 7 TS 05.02 */
292unsigned int n_pag_blocks(int bs_ccch_sdcch_comb, unsigned int bs_ag_blks_res)
293{
294 if (!bs_ccch_sdcch_comb)
295 return 9 - bs_ag_blks_res;
296 else
297 return 3 - bs_ag_blks_res;
298}
299
300/* Chapter 6.5.2 of TS 05.02 */
301unsigned int get_ccch_group(u_int64_t imsi, unsigned int bs_cc_chans,
302 unsigned int n_pag_blocks)
303{
304 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) / n_pag_blocks;
305}
306
307/* Chapter 6.5.2 of TS 05.02 */
308unsigned int get_paging_group(u_int64_t imsi, unsigned int bs_cc_chans,
309 int n_pag_blocks)
310{
311 return (imsi % 1000) % (bs_cc_chans * n_pag_blocks) % n_pag_blocks;
312}
313
314static struct msgb *rsl_msgb_alloc(void)
315{
Harald Welte9cfc9352009-06-26 19:39:35 +0200316 return msgb_alloc_headroom(RSL_ALLOC_SIZE, RSL_ALLOC_HEADROOM,
317 "RSL");
Harald Welte59b04682009-06-10 05:40:52 +0800318}
319
320#define MACBLOCK_SIZE 23
321static void pad_macblock(u_int8_t *out, const u_int8_t *in, int len)
322{
323 memcpy(out, in, len);
324
325 if (len < MACBLOCK_SIZE)
326 memset(out+len, 0x2b, MACBLOCK_SIZE-len);
327}
328
Harald Welted2dd9de2009-08-30 15:37:11 +0900329/* Chapter 9.3.7: Encryption Information */
330static int build_encr_info(u_int8_t *out, struct gsm_lchan *lchan)
331{
332 *out++ = lchan->encr.alg_id & 0xff;
333 if (lchan->encr.key_len)
334 memcpy(out, lchan->encr.key, lchan->encr.key_len);
335 return lchan->encr.key_len + 1;
336}
337
338
Harald Weltef1a168d2009-07-28 17:58:09 +0200339static const char *rsl_err_vals[0xff] = {
340 [RSL_ERR_RADIO_IF_FAIL] = "Radio Interface Failure",
341 [RSL_ERR_RADIO_LINK_FAIL] = "Radio Link Failure",
342 [RSL_ERR_HANDOVER_ACC_FAIL] = "Handover Access Failure",
343 [RSL_ERR_TALKER_ACC_FAIL] = "Talker Access Failure",
344 [RSL_ERR_OM_INTERVENTION] = "O&M Intervention",
345 [RSL_ERR_NORMAL_UNSPEC] = "Normal event, unspecified",
Harald Welteb1717e92009-08-04 02:31:05 +0200346 [RSL_ERR_T_MSRFPCI_EXP] = "Siemens: T_MSRFPCI Expired",
Harald Weltef1a168d2009-07-28 17:58:09 +0200347 [RSL_ERR_EQUIPMENT_FAIL] = "Equipment Failure",
348 [RSL_ERR_RR_UNAVAIL] = "Radio Resource not available",
349 [RSL_ERR_TERR_CH_FAIL] = "Terrestrial Channel Failure",
350 [RSL_ERR_CCCH_OVERLOAD] = "CCCH Overload",
351 [RSL_ERR_ACCH_OVERLOAD] = "ACCH Overload",
352 [RSL_ERR_PROCESSOR_OVERLOAD] = "Processor Overload",
353 [RSL_ERR_RES_UNAVAIL] = "Resource not available, unspecified",
354 [RSL_ERR_TRANSC_UNAVAIL] = "Transcoding not available",
355 [RSL_ERR_SERV_OPT_UNAVAIL] = "Service or Option not available",
356 [RSL_ERR_ENCR_UNIMPL] = "Encryption algorithm not implemented",
357 [RSL_ERR_SERV_OPT_UNIMPL] = "Service or Option not implemented",
358 [RSL_ERR_RCH_ALR_ACTV_ALLOC] = "Radio channel already activated",
359 [RSL_ERR_INVALID_MESSAGE] = "Invalid Message, unspecified",
360 [RSL_ERR_MSG_DISCR] = "Message Discriminator Error",
361 [RSL_ERR_MSG_TYPE] = "Message Type Error",
362 [RSL_ERR_MSG_SEQ] = "Message Sequence Error",
363 [RSL_ERR_IE_ERROR] = "General IE error",
364 [RSL_ERR_MAND_IE_ERROR] = "Mandatory IE error",
365 [RSL_ERR_OPT_IE_ERROR] = "Optional IE error",
366 [RSL_ERR_IE_NONEXIST] = "IE non-existent",
367 [RSL_ERR_IE_LENGTH] = "IE length error",
368 [RSL_ERR_IE_CONTENT] = "IE content error",
369 [RSL_ERR_PROTO] = "Protocol error, unspecified",
370 [RSL_ERR_INTERWORKING] = "Interworking error, unspecified",
371};
372
373static const char *rsl_err_name(u_int8_t err)
Harald Welte59b04682009-06-10 05:40:52 +0800374{
Harald Weltef1a168d2009-07-28 17:58:09 +0200375 if (rsl_err_vals[err])
376 return rsl_err_vals[err];
377 else
378 return "unknown";
379}
380
Harald Weltede4477a2009-12-24 12:20:20 +0100381static void print_rsl_cause(int lvl, const u_int8_t *cause_v, u_int8_t cause_len)
Harald Weltef1a168d2009-07-28 17:58:09 +0200382{
Harald Welte59b04682009-06-10 05:40:52 +0800383 int i;
384
Harald Weltede4477a2009-12-24 12:20:20 +0100385 LOGPC(DRSL, lvl, "CAUSE=0x%02x(%s) ",
Harald Weltef1a168d2009-07-28 17:58:09 +0200386 cause_v[0], rsl_err_name(cause_v[0]));
387 for (i = 1; i < cause_len-1; i++)
Harald Weltede4477a2009-12-24 12:20:20 +0100388 LOGPC(DRSL, lvl, "%02x ", cause_v[i]);
Harald Welte59b04682009-06-10 05:40:52 +0800389}
390
391/* Send a BCCH_INFO message as per Chapter 8.5.1 */
392int rsl_bcch_info(struct gsm_bts_trx *trx, u_int8_t type,
393 const u_int8_t *data, int len)
394{
395 struct abis_rsl_dchan_hdr *dh;
396 struct msgb *msg = rsl_msgb_alloc();
397
398 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof*dh);
399 init_dchan_hdr(dh, RSL_MT_BCCH_INFO);
400 dh->chan_nr = RSL_CHAN_BCCH;
401
402 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
403 msgb_tlv_put(msg, RSL_IE_FULL_BCCH_INFO, len, data);
404
405 msg->trx = trx;
406
407 return abis_rsl_sendmsg(msg);
408}
409
410int rsl_sacch_filling(struct gsm_bts_trx *trx, u_int8_t type,
411 const u_int8_t *data, int len)
412{
413 struct abis_rsl_common_hdr *ch;
414 struct msgb *msg = rsl_msgb_alloc();
415
416 ch = (struct abis_rsl_common_hdr *) msgb_put(msg, sizeof(*ch));
417 ch->msg_discr = ABIS_RSL_MDISC_TRX;
418 ch->msg_type = RSL_MT_SACCH_FILL;
419
420 msgb_tv_put(msg, RSL_IE_SYSINFO_TYPE, type);
421 msgb_tl16v_put(msg, RSL_IE_L3_INFO, len, data);
422
423 msg->trx = trx;
424
425 return abis_rsl_sendmsg(msg);
426}
427
Harald Welte91afe4c2009-06-20 18:15:19 +0200428int rsl_chan_bs_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int db)
429{
430 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200431 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200432 u_int8_t chan_nr = lchan2chan_nr(lchan);
433
434 db = abs(db);
435 if (db > 30)
436 return -EINVAL;
437
Harald Welteed831842009-06-27 03:09:08 +0200438 msg = rsl_msgb_alloc();
439
Harald Welte91afe4c2009-06-20 18:15:19 +0200440 lchan->bs_power = db/2;
441 if (fpc)
442 lchan->bs_power |= 0x10;
443
444 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
445 init_dchan_hdr(dh, RSL_MT_BS_POWER_CONTROL);
446 dh->chan_nr = chan_nr;
447
448 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
449
450 msg->trx = lchan->ts->trx;
451
452 return abis_rsl_sendmsg(msg);
453}
454
Harald Welte91afe4c2009-06-20 18:15:19 +0200455int rsl_chan_ms_power_ctrl(struct gsm_lchan *lchan, unsigned int fpc, int dbm)
456{
457 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200458 struct msgb *msg;
Harald Welte91afe4c2009-06-20 18:15:19 +0200459 u_int8_t chan_nr = lchan2chan_nr(lchan);
460 int ctl_lvl;
461
Harald Weltec4dcda02009-08-09 14:45:18 +0200462 ctl_lvl = ms_pwr_ctl_lvl(lchan->ts->trx->bts->band, dbm);
Harald Welte91afe4c2009-06-20 18:15:19 +0200463 if (ctl_lvl < 0)
464 return ctl_lvl;
465
Harald Welteed831842009-06-27 03:09:08 +0200466 msg = rsl_msgb_alloc();
467
Harald Welte91afe4c2009-06-20 18:15:19 +0200468 lchan->ms_power = ctl_lvl;
469
470 if (fpc)
471 lchan->ms_power |= 0x20;
472
473 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
474 init_dchan_hdr(dh, RSL_MT_MS_POWER_CONTROL);
475 dh->chan_nr = chan_nr;
476
477 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
478
479 msg->trx = lchan->ts->trx;
480
481 return abis_rsl_sendmsg(msg);
482}
483
Harald Welte39274f42009-07-29 15:41:29 +0200484static int channel_mode_from_lchan(struct rsl_ie_chan_mode *cm,
485 struct gsm_lchan *lchan)
486{
487 memset(cm, 0, sizeof(cm));
488
489 /* FIXME: what to do with data calls ? */
490 cm->dtx_dtu = 0x00;
491
492 /* set TCH Speech/Data */
493 cm->spd_ind = lchan->rsl_cmode;
494
Harald Welte951e3512009-11-27 08:55:16 +0100495 if (lchan->rsl_cmode == RSL_CMOD_SPD_SIGN &&
496 lchan->tch_mode != GSM48_CMODE_SIGN)
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100497 LOGP(DRSL, LOGL_ERROR, "unsupported: rsl_mode == signalling, "
Harald Welte951e3512009-11-27 08:55:16 +0100498 "but tch_mode != signalling\n");
499
Harald Welte39274f42009-07-29 15:41:29 +0200500 switch (lchan->type) {
501 case GSM_LCHAN_SDCCH:
502 cm->chan_rt = RSL_CMOD_CRT_SDCCH;
503 break;
504 case GSM_LCHAN_TCH_F:
505 cm->chan_rt = RSL_CMOD_CRT_TCH_Bm;
506 break;
507 case GSM_LCHAN_TCH_H:
508 cm->chan_rt = RSL_CMOD_CRT_TCH_Lm;
509 break;
510 case GSM_LCHAN_NONE:
511 case GSM_LCHAN_UNKNOWN:
512 default:
513 return -EINVAL;
514 }
515
516 switch (lchan->tch_mode) {
517 case GSM48_CMODE_SIGN:
518 cm->chan_rate = 0;
519 break;
520 case GSM48_CMODE_SPEECH_V1:
521 cm->chan_rate = RSL_CMOD_SP_GSM1;
522 break;
523 case GSM48_CMODE_SPEECH_EFR:
524 cm->chan_rate = RSL_CMOD_SP_GSM2;
525 break;
526 case GSM48_CMODE_SPEECH_AMR:
527 cm->chan_rate = RSL_CMOD_SP_GSM3;
528 break;
529 case GSM48_CMODE_DATA_14k5:
530 cm->chan_rate = RSL_CMOD_SP_NT_14k5;
531 break;
532 case GSM48_CMODE_DATA_12k0:
533 cm->chan_rate = RSL_CMOD_SP_NT_12k0;
534 break;
535 case GSM48_CMODE_DATA_6k0:
536 cm->chan_rate = RSL_CMOD_SP_NT_6k0;
537 break;
538 default:
539 return -EINVAL;
540 }
541
542 return 0;
543}
544
Harald Welte59b04682009-06-10 05:40:52 +0800545/* Chapter 8.4.1 */
546#if 0
547int rsl_chan_activate(struct gsm_bts_trx *trx, u_int8_t chan_nr,
548 u_int8_t act_type,
549 struct rsl_ie_chan_mode *chan_mode,
550 struct rsl_ie_chan_ident *chan_ident,
551 u_int8_t bs_power, u_int8_t ms_power,
552 u_int8_t ta)
553{
554 struct abis_rsl_dchan_hdr *dh;
555 struct msgb *msg = rsl_msgb_alloc();
556
557 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
558 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
559 dh->chan_nr = chan_nr;
560
561 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
562 /* For compatibility with Phase 1 */
563 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(*chan_mode),
564 (u_int8_t *) chan_mode);
565 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
566 (u_int8_t *) chan_ident);
567#if 0
568 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, 1,
569 (u_int8_t *) &encr_info);
570#endif
571 msgb_tv_put(msg, RSL_IE_BS_POWER, bs_power);
572 msgb_tv_put(msg, RSL_IE_MS_POWER, ms_power);
573 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
574
575 msg->trx = trx;
576
577 return abis_rsl_sendmsg(msg);
578}
579#endif
580
581int rsl_chan_activate_lchan(struct gsm_lchan *lchan, u_int8_t act_type,
Harald Welteb90d7bd2009-12-17 00:31:10 +0100582 u_int8_t ta, u_int8_t ho_ref)
Harald Welte59b04682009-06-10 05:40:52 +0800583{
584 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200585 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200586 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800587
588 u_int8_t chan_nr = lchan2chan_nr(lchan);
589 u_int16_t arfcn = lchan->ts->trx->arfcn;
590 struct rsl_ie_chan_mode cm;
591 struct rsl_ie_chan_ident ci;
592
Harald Welte39274f42009-07-29 15:41:29 +0200593 rc = channel_mode_from_lchan(&cm, lchan);
594 if (rc < 0)
595 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800596
597 memset(&ci, 0, sizeof(ci));
598 ci.chan_desc.iei = 0x64;
599 ci.chan_desc.chan_nr = chan_nr;
600 ci.chan_desc.oct3 = (lchan->ts->trx->bts->tsc << 5) | ((arfcn & 0x3ff) >> 8);
601 ci.chan_desc.oct4 = arfcn & 0xff;
602
Harald Welteed831842009-06-27 03:09:08 +0200603 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800604 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
605 init_dchan_hdr(dh, RSL_MT_CHAN_ACTIV);
606 dh->chan_nr = chan_nr;
607
608 msgb_tv_put(msg, RSL_IE_ACT_TYPE, act_type);
Harald Welte59b04682009-06-10 05:40:52 +0800609 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
610 (u_int8_t *) &cm);
Harald Welteb90d7bd2009-12-17 00:31:10 +0100611 /* For compatibility with Phase 1 */
Harald Welte59b04682009-06-10 05:40:52 +0800612 msgb_tlv_put(msg, RSL_IE_CHAN_IDENT, 4,
613 (u_int8_t *) &ci);
Harald Welted2dd9de2009-08-30 15:37:11 +0900614
615 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
616 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
617 rc = build_encr_info(encr_info, lchan);
618 if (rc > 0)
619 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
620 }
621
Harald Welteb90d7bd2009-12-17 00:31:10 +0100622 switch (act_type) {
623 case RSL_ACT_INTER_ASYNC:
624 case RSL_ACT_INTER_SYNC:
625 msgb_tv_put(msg, RSL_IE_HANDO_REF, ho_ref);
626 break;
627 default:
628 break;
629 }
630
Harald Welte59b04682009-06-10 05:40:52 +0800631 msgb_tv_put(msg, RSL_IE_BS_POWER, lchan->bs_power);
632 msgb_tv_put(msg, RSL_IE_MS_POWER, lchan->ms_power);
633 msgb_tv_put(msg, RSL_IE_TIMING_ADVANCE, ta);
634
635 msg->trx = lchan->ts->trx;
636
637 return abis_rsl_sendmsg(msg);
638}
639
Harald Welte8e770492009-07-29 11:38:15 +0200640/* Chapter 8.4.9: Modify channel mode on BTS side */
Harald Welte59b04682009-06-10 05:40:52 +0800641int rsl_chan_mode_modify_req(struct gsm_lchan *lchan)
642{
643 struct abis_rsl_dchan_hdr *dh;
Harald Welteed831842009-06-27 03:09:08 +0200644 struct msgb *msg;
Harald Welte39274f42009-07-29 15:41:29 +0200645 int rc;
Harald Welte59b04682009-06-10 05:40:52 +0800646
647 u_int8_t chan_nr = lchan2chan_nr(lchan);
648 struct rsl_ie_chan_mode cm;
649
Harald Welte39274f42009-07-29 15:41:29 +0200650 rc = channel_mode_from_lchan(&cm, lchan);
651 if (rc < 0)
652 return rc;
Harald Welte59b04682009-06-10 05:40:52 +0800653
Harald Welteed831842009-06-27 03:09:08 +0200654 msg = rsl_msgb_alloc();
Harald Welte59b04682009-06-10 05:40:52 +0800655 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
656 init_dchan_hdr(dh, RSL_MT_MODE_MODIFY_REQ);
657 dh->chan_nr = chan_nr;
658
659 msgb_tlv_put(msg, RSL_IE_CHAN_MODE, sizeof(cm),
660 (u_int8_t *) &cm);
Harald Welted2dd9de2009-08-30 15:37:11 +0900661
662 if (lchan->encr.alg_id > RSL_ENC_ALG_A5(0)) {
663 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
664 rc = build_encr_info(encr_info, lchan);
665 if (rc > 0)
666 msgb_tlv_put(msg, RSL_IE_ENCR_INFO, rc, encr_info);
667 }
668
Holger Hans Peter Freyther3cce58f2009-11-18 22:57:02 +0100669 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR) {
670 msgb_tlv_put(msg, RSL_IE_MR_CONFIG, sizeof(lchan->mr_conf),
671 (u_int8_t *) &lchan->mr_conf);
672 }
673
Harald Welted2dd9de2009-08-30 15:37:11 +0900674 msg->trx = lchan->ts->trx;
675
676 return abis_rsl_sendmsg(msg);
677}
678
679/* Chapter 8.4.6: Send the encryption command with given L3 info */
680int rsl_encryption_cmd(struct msgb *msg)
681{
682 struct abis_rsl_dchan_hdr *dh;
683 struct gsm_lchan *lchan = msg->lchan;
684 u_int8_t chan_nr = lchan2chan_nr(lchan);
685 u_int8_t encr_info[MAX_A5_KEY_LEN+2];
Sylvain Munaut01f1caf2009-09-27 11:13:18 +0200686 u_int8_t l3_len = msg->len;
Harald Welted2dd9de2009-08-30 15:37:11 +0900687 int rc;
688
689 /* First push the L3 IE tag and length */
690 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
691
692 /* then the link identifier (SAPI0, main sign link) */
693 msgb_tv_push(msg, RSL_IE_LINK_IDENT, 0);
694
695 /* then encryption information */
696 rc = build_encr_info(encr_info, lchan);
697 if (rc <= 0)
698 return rc;
699 msgb_tlv_push(msg, RSL_IE_ENCR_INFO, rc, encr_info);
700
701 /* and finally the DCHAN header */
702 dh = (struct abis_rsl_dchan_hdr *) msgb_push(msg, sizeof(*dh));
703 init_dchan_hdr(dh, RSL_MT_ENCR_CMD);
704 dh->chan_nr = chan_nr;
Harald Welte59b04682009-06-10 05:40:52 +0800705
706 msg->trx = lchan->ts->trx;
707
708 return abis_rsl_sendmsg(msg);
709}
710
Harald Welte85a163c2009-08-10 11:43:22 +0200711/* Chapter 8.4.5 / 4.6: Deactivate the SACCH after 04.08 RR CHAN RELEASE */
Harald Welteafe3c232009-07-19 18:36:49 +0200712int rsl_deact_sacch(struct gsm_lchan *lchan)
713{
714 struct abis_rsl_dchan_hdr *dh;
715 struct msgb *msg = rsl_msgb_alloc();
716
717 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
718 init_dchan_hdr(dh, RSL_MT_DEACTIVATE_SACCH);
719 dh->chan_nr = lchan2chan_nr(lchan);
720
721 msg->lchan = lchan;
722 msg->trx = lchan->ts->trx;
723
Harald Weltede4477a2009-12-24 12:20:20 +0100724 DEBUGP(DRSL, "%s DEACTivate SACCH CMD\n", gsm_ts_name(lchan->ts));
Harald Welteafe3c232009-07-19 18:36:49 +0200725
726 return abis_rsl_sendmsg(msg);
727}
728
Harald Welte85a163c2009-08-10 11:43:22 +0200729/* Chapter 8.4.14 / 4.7: Tell BTS to release the radio channel */
730int rsl_rf_chan_release(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +0800731{
732 struct abis_rsl_dchan_hdr *dh;
733 struct msgb *msg = rsl_msgb_alloc();
734
735 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
736 init_dchan_hdr(dh, RSL_MT_RF_CHAN_REL);
737 dh->chan_nr = lchan2chan_nr(lchan);
738
739 msg->lchan = lchan;
740 msg->trx = lchan->ts->trx;
741
Harald Weltede4477a2009-12-24 12:20:20 +0100742 DEBUGP(DRSL, "%s RF Channel Release CMD\n", gsm_ts_name(lchan->ts));
Harald Welte59b04682009-06-10 05:40:52 +0800743
Harald Welte85a163c2009-08-10 11:43:22 +0200744 /* BTS will respond by RF CHAN REL ACK */
Harald Welte59b04682009-06-10 05:40:52 +0800745 return abis_rsl_sendmsg(msg);
746}
747
748int rsl_paging_cmd(struct gsm_bts *bts, u_int8_t paging_group, u_int8_t len,
749 u_int8_t *ms_ident, u_int8_t chan_needed)
750{
751 struct abis_rsl_dchan_hdr *dh;
752 struct msgb *msg = rsl_msgb_alloc();
753
754 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
755 init_dchan_hdr(dh, RSL_MT_PAGING_CMD);
756 dh->chan_nr = RSL_CHAN_PCH_AGCH;
757
758 msgb_tv_put(msg, RSL_IE_PAGING_GROUP, paging_group);
759 msgb_tlv_put(msg, RSL_IE_MS_IDENTITY, len-2, ms_ident+2);
760 msgb_tv_put(msg, RSL_IE_CHAN_NEEDED, chan_needed);
761
762 msg->trx = bts->c0;
763
764 return abis_rsl_sendmsg(msg);
765}
766
767int rsl_paging_cmd_subscr(struct gsm_bts *bts, u_int8_t chan_need,
768 struct gsm_subscriber *subscr)
769{
770#if 0
771 u_int8_t mi[128];
772 unsigned int mi_len;
773 u_int8_t paging_group;
774#endif
775
776 return -1;
777}
778
779int imsi_str2bcd(u_int8_t *bcd_out, const char *str_in)
780{
781 int i, len = strlen(str_in);
782
783 for (i = 0; i < len; i++) {
784 int num = str_in[i] - 0x30;
785 if (num < 0 || num > 9)
786 return -1;
787 if (i % 2 == 0)
788 bcd_out[i/2] = num;
789 else
790 bcd_out[i/2] |= (num << 4);
791 }
792
793 return 0;
794}
795
796/* Chapter 8.5.6 */
797int rsl_imm_assign_cmd(struct gsm_bts *bts, u_int8_t len, u_int8_t *val)
798{
799 struct msgb *msg = rsl_msgb_alloc();
800 struct abis_rsl_dchan_hdr *dh;
801 u_int8_t buf[MACBLOCK_SIZE];
802
803 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
804 init_dchan_hdr(dh, RSL_MT_IMMEDIATE_ASSIGN_CMD);
805 dh->chan_nr = RSL_CHAN_PCH_AGCH;
806
807 switch (bts->type) {
808 case GSM_BTS_TYPE_BS11:
809 msgb_tlv_put(msg, RSL_IE_IMM_ASS_INFO, len, val);
810 break;
811 default:
812 /* If phase 2, construct a FULL_IMM_ASS_INFO */
813 pad_macblock(buf, val, len);
814 msgb_tlv_put(msg, RSL_IE_FULL_IMM_ASS_INFO, MACBLOCK_SIZE, buf);
815 break;
816 }
817
818 msg->trx = bts->c0;
819
820 return abis_rsl_sendmsg(msg);
821}
822
Harald Welte4684e632009-08-10 09:51:40 +0200823/* Send Siemens specific MS RF Power Capability Indication */
Harald Welte12090752009-08-10 10:07:33 +0200824int rsl_siemens_mrpci(struct gsm_lchan *lchan, struct rsl_mrpci *mrpci)
Harald Welte4684e632009-08-10 09:51:40 +0200825{
826 struct msgb *msg = rsl_msgb_alloc();
827 struct abis_rsl_dchan_hdr *dh;
828
829 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
830 init_dchan_hdr(dh, RSL_MT_SIEMENS_MRPCI);
Harald Welte874a5b42009-08-10 11:26:14 +0200831 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
Harald Welte4684e632009-08-10 09:51:40 +0200832 dh->chan_nr = lchan2chan_nr(lchan);
Harald Welte12090752009-08-10 10:07:33 +0200833 msgb_tv_put(msg, RSL_IE_SIEMENS_MRPCI, *(u_int8_t *)mrpci);
Harald Welte4684e632009-08-10 09:51:40 +0200834
Harald Weltede4477a2009-12-24 12:20:20 +0100835 DEBUGP(DRSL, "%s TX Siemens MRPCI 0x%02x\n",
836 gsm_ts_name(lchan->ts), *(u_int8_t *)mrpci);
Harald Welte874a5b42009-08-10 11:26:14 +0200837
838 msg->trx = lchan->ts->trx;
839
Harald Welte4684e632009-08-10 09:51:40 +0200840 return abis_rsl_sendmsg(msg);
841}
842
843
Harald Welte59b04682009-06-10 05:40:52 +0800844/* Send "DATA REQUEST" message with given L3 Info payload */
845/* Chapter 8.3.1 */
846int rsl_data_request(struct msgb *msg, u_int8_t link_id)
847{
848 u_int8_t l3_len = msg->tail - (u_int8_t *)msgb_l3(msg);
849 struct abis_rsl_rll_hdr *rh;
850
851 if (msg->lchan == NULL) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100852 LOGP(DRSL, LOGL_ERROR, "cannot send DATA REQUEST to unknown lchan\n");
Harald Welte59b04682009-06-10 05:40:52 +0800853 return -EINVAL;
854 }
855
856 /* First push the L3 IE tag and length */
857 msgb_tv16_push(msg, RSL_IE_L3_INFO, l3_len);
858
859 /* Then push the RSL header */
860 rh = (struct abis_rsl_rll_hdr *) msgb_push(msg, sizeof(*rh));
861 init_llm_hdr(rh, RSL_MT_DATA_REQ);
862 rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
863 rh->chan_nr = lchan2chan_nr(msg->lchan);
864 rh->link_id = link_id;
865
866 msg->trx = msg->lchan->ts->trx;
867
868 return abis_rsl_sendmsg(msg);
869}
870
Harald Welteed9a5ab2009-08-09 13:47:35 +0200871/* Send "ESTABLISH REQUEST" message with given L3 Info payload */
872/* Chapter 8.3.1 */
873int rsl_establish_request(struct gsm_lchan *lchan, u_int8_t link_id)
874{
875 struct msgb *msg = rsl_msgb_alloc();
876 struct abis_rsl_rll_hdr *rh;
877
878 rh = (struct abis_rsl_rll_hdr *) msgb_put(msg, sizeof(*rh));
Harald Welte61402172009-08-09 14:13:58 +0200879 init_llm_hdr(rh, RSL_MT_EST_REQ);
Harald Welteed9a5ab2009-08-09 13:47:35 +0200880 //rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
881 rh->chan_nr = lchan2chan_nr(lchan);
882 rh->link_id = link_id;
883
884 msg->trx = lchan->ts->trx;
885
886 return abis_rsl_sendmsg(msg);
887}
888
Harald Welte0f2e3c12009-08-08 13:15:07 +0200889/* Chapter 8.3.7 Request the release of multiframe mode of RLL connection.
890 This is what higher layers should call. The BTS then responds with
891 RELEASE CONFIRM, which we in turn use to trigger RSL CHANNEL RELEASE,
892 which in turn is acknowledged by RSL CHANNEL RELEASE ACK, which calls
893 lchan_free() */
894int rsl_release_request(struct gsm_lchan *lchan, u_int8_t link_id)
895{
896 struct msgb *msg = rsl_msgb_alloc();
897 struct abis_rsl_rll_hdr *rh;
898
899 rh = (struct abis_rsl_rll_hdr *) msgb_put(msg, sizeof(*rh));
900 init_llm_hdr(rh, RSL_MT_REL_REQ);
901 //rh->c.msg_discr |= ABIS_RSL_MDISC_TRANSP;
902 rh->chan_nr = lchan2chan_nr(lchan);
903 rh->link_id = link_id;
Harald Weltead738562009-08-10 00:19:36 +0200904 msgb_tv_put(msg, RSL_IE_RELEASE_MODE, 0); /* normal release */
Harald Welte0f2e3c12009-08-08 13:15:07 +0200905
906 msg->trx = lchan->ts->trx;
907
908 return abis_rsl_sendmsg(msg);
909}
910
Harald Welte59b04682009-06-10 05:40:52 +0800911/* Chapter 8.4.2: Channel Activate Acknowledge */
912static int rsl_rx_chan_act_ack(struct msgb *msg)
913{
914 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
915
916 /* BTS has confirmed channel activation, we now need
917 * to assign the activated channel to the MS */
918 if (rslh->ie_chan != RSL_IE_CHAN_NR)
919 return -EINVAL;
Harald Welte6720a432009-11-29 22:45:52 +0100920
Harald Welte4baa9c52009-12-21 13:27:11 +0100921 msg->lchan->state = LCHAN_S_ACTIVE;
922
Harald Welte6720a432009-11-29 22:45:52 +0100923 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_ACK, msg->lchan);
924
Harald Welte59b04682009-06-10 05:40:52 +0800925 return 0;
926}
927
928/* Chapter 8.4.3: Channel Activate NACK */
929static int rsl_rx_chan_act_nack(struct msgb *msg)
930{
931 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
932 struct tlv_parsed tp;
933
934 /* BTS has rejected channel activation ?!? */
935 if (dh->ie_chan != RSL_IE_CHAN_NR)
936 return -EINVAL;
937
938 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
939 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100940 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200941 TLVP_LEN(&tp, RSL_IE_CAUSE));
942
Harald Welte4baa9c52009-12-21 13:27:11 +0100943 msg->lchan->state = LCHAN_S_NONE;
944
Harald Welte6720a432009-11-29 22:45:52 +0100945 dispatch_signal(SS_LCHAN, S_LCHAN_ACTIVATE_NACK, msg->lchan);
946
Harald Weltecddb9802009-08-09 19:50:08 +0200947 lchan_free(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800948 return 0;
949}
950
951/* Chapter 8.4.4: Connection Failure Indication */
952static int rsl_rx_conn_fail(struct msgb *msg)
953{
954 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
955 struct tlv_parsed tp;
956
Harald Weltecf2ec4a2009-12-17 23:10:46 +0100957 /* FIXME: print which channel */
958 LOGP(DRSL, LOGL_NOTICE, "CONNECTION FAIL: RELEASING\n");
Harald Welte59b04682009-06-10 05:40:52 +0800959
960 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
961
Harald Weltef1a168d2009-07-28 17:58:09 +0200962 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100963 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200964 TLVP_LEN(&tp, RSL_IE_CAUSE));
965
Harald Welte59b04682009-06-10 05:40:52 +0800966 /* FIXME: only free it after channel release ACK */
Harald Welte85a163c2009-08-10 11:43:22 +0200967 return rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800968}
969
Harald Weltec20bd1d2009-11-29 19:07:28 +0100970static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
971 const char *prefix)
972{
Harald Welte0e4fa782009-12-16 16:52:07 +0100973 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
974 prefix, rxlev2dbm(mru->full.rx_lev),
975 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100976 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
977 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
978}
979
980static void print_meas_rep(struct gsm_meas_rep *mr)
981{
Harald Welte0e4fa782009-12-16 16:52:07 +0100982 int i;
983
Harald Weltec20bd1d2009-11-29 19:07:28 +0100984 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
985
986 if (mr->flags & MEAS_REP_F_DL_DTX)
987 DEBUGPC(DMEAS, "DTXd ");
988
989 print_meas_rep_uni(&mr->ul, "ul");
990 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
991 if (mr->flags & MEAS_REP_F_MS_TO)
992 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
993
994 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100995 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100996 DEBUGPC(DMEAS, "L1_FPC=%u ",
997 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
998 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
999 }
1000
1001 if (mr->flags & MEAS_REP_F_UL_DTX)
1002 DEBUGPC(DMEAS, "DTXu ");
1003 if (mr->flags & MEAS_REP_F_BA1)
1004 DEBUGPC(DMEAS, "BA1 ");
1005 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1006 DEBUGPC(DMEAS, "NOT VALID ");
1007 else
1008 print_meas_rep_uni(&mr->dl, "dl");
1009
1010 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001011 if (mr->num_cell == 7)
1012 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001013 for (i = 0; i < mr->num_cell; i++) {
1014 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
1015 DEBUGP(DMEAS, "ARFCN=%u BSIC=%u => %d dBm\n", mrc->arfcn, mrc->bsic,
1016 rxlev2dbm(mrc->rxlev));
1017 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001018}
1019
Harald Welte59b04682009-06-10 05:40:52 +08001020static int rsl_rx_meas_res(struct msgb *msg)
1021{
1022 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1023 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001024 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001025 u_int8_t len;
1026 const u_int8_t *val;
1027 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001028
Harald Welte4baa9c52009-12-21 13:27:11 +01001029 /* check if this channel is actually active */
1030 /* FIXME: maybe this check should be way more generic/centralized */
1031 if (msg->lchan->state != LCHAN_S_ACTIVE)
1032 return 0;
1033
Harald Weltef9476812009-12-15 21:36:05 +01001034 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001035 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001036
Harald Welte59b04682009-06-10 05:40:52 +08001037 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1038
Harald Weltec20bd1d2009-11-29 19:07:28 +01001039 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1040 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1041 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1042 return -EIO;
1043
1044 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001045 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001046
1047 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1048 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1049 if (len >= 3) {
1050 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001051 mr->flags |= MEAS_REP_F_DL_DTX;
1052 mr->ul.full.rx_lev = val[0] & 0x3f;
1053 mr->ul.sub.rx_lev = val[1] & 0x3f;
1054 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1055 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001056 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001057
Harald Weltef9476812009-12-15 21:36:05 +01001058 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001059
1060 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001061 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001062 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001063 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1064
Harald Weltea1467eb2009-06-20 18:44:35 +02001065 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001066 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001067 mr->flags |= MEAS_REP_F_MS_L1;
1068 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001069 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001070 mr->flags |= MEAS_REP_F_FPC;
1071 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001072 }
Harald Welte59b04682009-06-10 05:40:52 +08001073 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001074 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001075 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001076 if (rc < 0)
1077 return rc;
1078 }
1079
Harald Weltef9476812009-12-15 21:36:05 +01001080 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001081
Harald Weltef9476812009-12-15 21:36:05 +01001082 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001083
Harald Welte59b04682009-06-10 05:40:52 +08001084 return 0;
1085}
1086
Harald Welte6720a432009-11-29 22:45:52 +01001087/* Chapter 8.4.7 */
1088static int rsl_rx_hando_det(struct msgb *msg)
1089{
1090 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1091 struct tlv_parsed tp;
1092
1093 DEBUGP(DRSL, "HANDOVER DETECT ");
1094
1095 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1096
1097 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1098 DEBUGPC(DRSL, "access delay = %u\n",
1099 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1100 else
1101 DEBUGPC(DRSL, "\n");
1102
1103 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1104
1105 return 0;
1106}
1107
Harald Welte59b04682009-06-10 05:40:52 +08001108static int abis_rsl_rx_dchan(struct msgb *msg)
1109{
1110 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1111 int rc = 0;
1112 char *ts_name;
1113
1114 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1115 ts_name = gsm_ts_name(msg->lchan->ts);
1116
Harald Welte59b04682009-06-10 05:40:52 +08001117 switch (rslh->c.msg_type) {
1118 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001119 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001120 rc = rsl_rx_chan_act_ack(msg);
1121 break;
1122 case RSL_MT_CHAN_ACTIV_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001123 DEBUGP(DRSL, "%s CHANNEL ACTIVATE NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001124 rc = rsl_rx_chan_act_nack(msg);
1125 break;
1126 case RSL_MT_CONN_FAIL:
Harald Weltede4477a2009-12-24 12:20:20 +01001127 DEBUGP(DRSL, "%s ", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001128 rc = rsl_rx_conn_fail(msg);
1129 break;
1130 case RSL_MT_MEAS_RES:
1131 rc = rsl_rx_meas_res(msg);
1132 break;
Harald Welte6720a432009-11-29 22:45:52 +01001133 case RSL_MT_HANDO_DET:
Harald Weltede4477a2009-12-24 12:20:20 +01001134 DEBUGP(DRSL, "%s ", ts_name);
Harald Welte6720a432009-11-29 22:45:52 +01001135 rc = rsl_rx_hando_det(msg);
1136 break;
Harald Welte59b04682009-06-10 05:40:52 +08001137 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001138 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Harald Welte4baa9c52009-12-21 13:27:11 +01001139 msg->lchan->state = LCHAN_S_NONE;
Harald Welte59b04682009-06-10 05:40:52 +08001140 lchan_free(msg->lchan);
1141 break;
1142 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001143 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001144 break;
1145 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001146 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001147 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001148 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001149 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001150 break;
1151 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001152 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001153 break;
1154 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001155 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001156 break;
1157 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001158 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001159 break;
Harald Welte59b04682009-06-10 05:40:52 +08001160 case RSL_MT_PHY_CONTEXT_CONF:
1161 case RSL_MT_PREPROC_MEAS_RES:
1162 case RSL_MT_TALKER_DET:
1163 case RSL_MT_LISTENER_DET:
1164 case RSL_MT_REMOTE_CODEC_CONF_REP:
1165 case RSL_MT_MR_CODEC_MOD_ACK:
1166 case RSL_MT_MR_CODEC_MOD_NACK:
1167 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001168 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1169 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001170 break;
1171 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001172 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1173 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001174 return -EINVAL;
1175 }
1176
1177 return rc;
1178}
1179
1180static int rsl_rx_error_rep(struct msgb *msg)
1181{
1182 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001183 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001184
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001185 LOGP(DRSL, LOGL_ERROR, "ERROR REPORT ");
Harald Weltef1a168d2009-07-28 17:58:09 +02001186
1187 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1188
1189 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001190 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001191 TLVP_LEN(&tp, RSL_IE_CAUSE));
1192
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001193 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001194
1195 return 0;
1196}
1197
1198static int abis_rsl_rx_trx(struct msgb *msg)
1199{
1200 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1201 int rc = 0;
1202
1203 switch (rslh->msg_type) {
1204 case RSL_MT_ERROR_REPORT:
1205 rc = rsl_rx_error_rep(msg);
1206 break;
1207 case RSL_MT_RF_RES_IND:
1208 /* interference on idle channels of TRX */
1209 //DEBUGP(DRSL, "TRX: RF Interference Indication\n");
1210 break;
1211 case RSL_MT_OVERLOAD:
1212 /* indicate CCCH / ACCH / processor overload */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001213 LOGP(DRSL, LOGL_ERROR, "TRX: CCCH/ACCH/CPU Overload\n");
Harald Welte59b04682009-06-10 05:40:52 +08001214 break;
1215 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001216 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message "
1217 "type 0x%02x\n", rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001218 return -EINVAL;
1219 }
1220 return rc;
1221}
1222
Harald Welte427dbc42009-08-10 00:26:10 +02001223/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1224static void t3101_expired(void *data)
1225{
1226 struct gsm_lchan *lchan = data;
1227
Harald Welte85a163c2009-08-10 11:43:22 +02001228 rsl_rf_chan_release(lchan);
Harald Welte427dbc42009-08-10 00:26:10 +02001229}
1230
Harald Welte59b04682009-06-10 05:40:52 +08001231/* MS has requested a channel on the RACH */
1232static int rsl_rx_chan_rqd(struct msgb *msg)
1233{
1234 struct gsm_bts *bts = msg->trx->bts;
1235 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1236 struct gsm48_req_ref *rqd_ref;
1237 struct gsm48_imm_ass ia;
1238 enum gsm_chan_t lctype;
1239 enum gsm_chreq_reason_t chreq_reason;
1240 struct gsm_lchan *lchan;
1241 u_int8_t rqd_ta;
1242 int ret;
1243
1244 u_int16_t arfcn;
1245 u_int8_t ts_number, subch;
1246
1247 /* parse request reference to be used in immediate assign */
1248 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1249 return -EINVAL;
1250
1251 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1252
1253 /* parse access delay and use as TA */
1254 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1255 return -EINVAL;
1256 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1257
1258 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1259 * request reference RA */
Holger Hans Peter Freyther96c89822009-11-16 17:12:38 +01001260 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1261 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001262
Harald Weltebdbb7442009-12-22 19:07:32 +01001263 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001264
Harald Welte59b04682009-06-10 05:40:52 +08001265 /* check availability / allocate channel */
1266 lchan = lchan_alloc(bts, lctype);
1267 if (!lchan) {
Harald Weltede4477a2009-12-24 12:20:20 +01001268 LOGP(DRSL, LOGL_NOTICE, "CHAN RQD: no resources for %s 0x%x\n",
Harald Welte059b6a82009-12-12 20:53:23 +01001269 gsm_lchan_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001270 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte59b04682009-06-10 05:40:52 +08001271 /* FIXME: send some kind of reject ?!? */
1272 return -ENOMEM;
1273 }
1274
1275 ts_number = lchan->ts->nr;
1276 arfcn = lchan->ts->trx->arfcn;
1277 subch = lchan->nr;
1278
Harald Welted2dd9de2009-08-30 15:37:11 +09001279 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001280 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001281 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001282 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001283 lchan->tch_mode = GSM48_CMODE_SIGN;
Harald Welteb90d7bd2009-12-17 00:31:10 +01001284 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001285
1286 /* create IMMEDIATE ASSIGN 04.08 messge */
1287 memset(&ia, 0, sizeof(ia));
1288 ia.l2_plen = 0x2d;
1289 ia.proto_discr = GSM48_PDISC_RR;
1290 ia.msg_type = GSM48_MT_RR_IMM_ASS;
1291 ia.page_mode = GSM48_PM_SAME;
1292 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
1293 ia.chan_desc.h0.h = 0;
1294 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
1295 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
Harald Welte63d23c82009-07-21 20:55:56 +02001296 ia.chan_desc.h0.tsc = bts->tsc;
Harald Welte59b04682009-06-10 05:40:52 +08001297 /* use request reference extracted from CHAN_RQD */
1298 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
1299 ia.timing_advance = rqd_ta;
1300 ia.mob_alloc_len = 0;
1301
Harald Weltede4477a2009-12-24 12:20:20 +01001302 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1303 "r=%s ra=0x%02x\n", gsm_ts_name(lchan->ts), arfcn, subch,
1304 gsm_lchan_name(lchan->type), gsm_chreq_name(chreq_reason),
Harald Welte59b04682009-06-10 05:40:52 +08001305 rqd_ref->ra);
1306
Harald Welte427dbc42009-08-10 00:26:10 +02001307 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1308 lchan->T3101.cb = t3101_expired;
1309 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001310 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001311
1312 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
1313 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
1314
1315 return ret;
1316}
1317
1318/* MS has requested a channel on the RACH */
1319static int rsl_rx_ccch_load(struct msgb *msg)
1320{
1321 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1322 u_int16_t pg_buf_space;
1323 u_int16_t rach_slot_count = -1;
1324 u_int16_t rach_busy_count = -1;
1325 u_int16_t rach_access_count = -1;
1326
1327 switch (rslh->data[0]) {
1328 case RSL_IE_PAGING_LOAD:
1329 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1330 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1331 break;
1332 case RSL_IE_RACH_LOAD:
1333 if (msg->data_len >= 7) {
1334 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1335 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1336 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1337 }
1338 break;
1339 default:
1340 break;
1341 }
1342
1343 return 0;
1344}
1345
1346static int abis_rsl_rx_cchan(struct msgb *msg)
1347{
1348 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1349 int rc = 0;
1350
1351 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1352
1353 switch (rslh->c.msg_type) {
1354 case RSL_MT_CHAN_RQD:
1355 /* MS has requested a channel on the RACH */
1356 rc = rsl_rx_chan_rqd(msg);
1357 break;
1358 case RSL_MT_CCCH_LOAD_IND:
1359 /* current load on the CCCH */
1360 rc = rsl_rx_ccch_load(msg);
1361 break;
1362 case RSL_MT_DELETE_IND:
1363 /* CCCH overloaded, IMM_ASSIGN was dropped */
1364 case RSL_MT_CBCH_LOAD_IND:
1365 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001366 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1367 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001368 break;
1369 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001370 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1371 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001372 return -EINVAL;
1373 }
1374
1375 return rc;
1376}
1377
1378static int rsl_rx_rll_err_ind(struct msgb *msg)
1379{
1380 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1381 u_int8_t *rlm_cause = rllh->data;
1382
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001383 LOGP(DRLL, LOGL_ERROR, "ERROR INDICATION cause=0x%02x\n", rlm_cause[1]);
Harald Welteed9a5ab2009-08-09 13:47:35 +02001384
1385 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte59b04682009-06-10 05:40:52 +08001386
Harald Welte692f5852009-07-04 09:40:05 +02001387 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED)
Harald Welte85a163c2009-08-10 11:43:22 +02001388 return rsl_rf_chan_release(msg->lchan);
Harald Welte692f5852009-07-04 09:40:05 +02001389
Harald Welte59b04682009-06-10 05:40:52 +08001390 return 0;
1391}
1392
1393/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
1394 0x02, 0x06,
1395 0x01, 0x20,
1396 0x02, 0x00,
1397 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1398
1399static int abis_rsl_rx_rll(struct msgb *msg)
1400{
1401 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1402 int rc = 0;
1403 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001404 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001405
1406 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
1407 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Weltede4477a2009-12-24 12:20:20 +01001408 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001409
1410 switch (rllh->c.msg_type) {
1411 case RSL_MT_DATA_IND:
1412 DEBUGPC(DRLL, "DATA INDICATION\n");
1413 if (msgb_l2len(msg) >
1414 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1415 rllh->data[0] == RSL_IE_L3_INFO) {
1416 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001417 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001418 }
1419 break;
1420 case RSL_MT_EST_IND:
1421 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001422 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001423 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001424 bsc_del_timer(&msg->lchan->T3101);
Harald Welte59b04682009-06-10 05:40:52 +08001425 if (msgb_l2len(msg) >
1426 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1427 rllh->data[0] == RSL_IE_L3_INFO) {
1428 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001429 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001430 }
1431 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001432 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001433 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001434 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001435 rll_indication(msg->lchan, rllh->link_id,
1436 BSC_RLLR_IND_EST_CONF);
1437 break;
Harald Welte59b04682009-06-10 05:40:52 +08001438 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001439 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001440 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001441 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001442 rll_indication(msg->lchan, rllh->link_id,
1443 BSC_RLLR_IND_REL_IND);
Harald Welte0f2e3c12009-08-08 13:15:07 +02001444 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001445 /* FIXME: officially we need to start T3111 and wait for
1446 * some grace period */
1447 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001448 break;
1449 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001450 /* BTS informs us of having received UA from MS,
1451 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001452 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001453 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welte0f2e3c12009-08-08 13:15:07 +02001454 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001455 /* FIXME: officially we need to start T3111 and wait for
1456 * some grace period */
1457 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001458 break;
1459 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001460 rc = rsl_rx_rll_err_ind(msg);
1461 break;
1462 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001463 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1464 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001465 break;
1466 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001467 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1468 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001469 }
Harald Welte59b04682009-06-10 05:40:52 +08001470 return rc;
1471}
1472
Harald Welteb284b472009-12-02 01:58:23 +05301473static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001474{
Harald Welteb284b472009-12-02 01:58:23 +05301475 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001476 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301477 switch (lchan->type) {
1478 case GSM_LCHAN_TCH_F:
1479 return 0x00;
1480 case GSM_LCHAN_TCH_H:
1481 return 0x03;
1482 default:
1483 break;
1484 }
Harald Welte98d79f92009-07-28 18:11:56 +02001485 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301486 switch (lchan->type) {
1487 case GSM_LCHAN_TCH_F:
1488 return 0x01;
1489 /* there's no half-rate EFR */
1490 default:
1491 break;
1492 }
Harald Welte98d79f92009-07-28 18:11:56 +02001493 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301494 switch (lchan->type) {
1495 case GSM_LCHAN_TCH_F:
1496 return 0x02;
1497 case GSM_LCHAN_TCH_H:
1498 return 0x05;
1499 default:
1500 break;
1501 }
1502 default:
1503 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001504 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001505 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301506 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001507 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001508}
1509
Harald Welte59b04682009-06-10 05:40:52 +08001510/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001511static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1512{
1513 struct in_addr ip;
1514 u_int16_t port, conn_id;
1515
1516 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1517 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1518 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1519 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1520 }
1521
1522 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1523 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1524 port = ntohs(port);
1525 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1526 lchan->abis_ip.bound_port = port;
1527 }
1528
1529 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1530 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1531 conn_id = ntohs(conn_id);
1532 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1533 lchan->abis_ip.conn_id = conn_id;
1534 }
1535
1536 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1537 lchan->abis_ip.rtp_payload2 =
1538 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1539 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1540 lchan->abis_ip.rtp_payload2);
1541 }
1542
1543 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1544 lchan->abis_ip.speech_mode =
1545 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1546 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1547 lchan->abis_ip.speech_mode);
1548 }
1549
1550 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1551 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1552 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1553 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1554 }
1555
1556 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1557 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1558 port = ntohs(port);
1559 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1560 lchan->abis_ip.connect_port = port;
1561 }
1562}
1563
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001564int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001565{
1566 struct msgb *msg = rsl_msgb_alloc();
1567 struct abis_rsl_dchan_hdr *dh;
1568
1569 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001570 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001571 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1572 dh->chan_nr = lchan2chan_nr(lchan);
1573
Harald Welte98d79f92009-07-28 18:11:56 +02001574 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001575 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
1576 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001577
Harald Weltede4477a2009-12-24 12:20:20 +01001578 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x\n",
1579 gsm_ts_name(lchan->ts), lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001580
Harald Welte59b04682009-06-10 05:40:52 +08001581 msg->trx = lchan->ts->trx;
1582
1583 return abis_rsl_sendmsg(msg);
1584}
1585
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001586int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001587 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001588{
1589 struct msgb *msg = rsl_msgb_alloc();
1590 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001591 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001592 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001593
1594 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001595 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001596 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1597 dh->chan_nr = lchan2chan_nr(lchan);
1598
Harald Weltebffa4992009-12-19 16:42:06 +01001599 /* we need to store these now as MDCX_ACK does not return them :( */
1600 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1601 lchan->abis_ip.connect_port = port;
1602 lchan->abis_ip.connect_ip = ip;
1603
Harald Weltefb4a9e92009-07-29 12:12:18 +02001604 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001605 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001606
Harald Welte98d79f92009-07-28 18:11:56 +02001607 ia.s_addr = htonl(ip);
Harald Weltede4477a2009-12-24 12:20:20 +01001608 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD2=%d CONN_ID=%d "
1609 "speech_mode=0x%02x\n", gsm_ts_name(lchan->ts), inet_ntoa(ia), port,
Harald Weltebffa4992009-12-19 16:42:06 +01001610 rtp_payload2, lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001611
Harald Weltebffa4992009-12-19 16:42:06 +01001612 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1613 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1614 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1615 *att_ip = ia.s_addr;
1616 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1617 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001618 if (rtp_payload2)
1619 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1620
Harald Welte59b04682009-06-10 05:40:52 +08001621 msg->trx = lchan->ts->trx;
1622
1623 return abis_rsl_sendmsg(msg);
1624}
1625
Harald Welte9947d9f2009-12-20 16:51:09 +01001626/* tell BTS to connect RTP stream to our local RTP socket */
1627int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1628{
1629 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1630 int rc;
1631
1632 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1633 ntohs(rs->rtp.sin_local.sin_port),
1634 /* FIXME: use RTP payload of bound socket, not BTS*/
1635 lchan->abis_ip.rtp_payload2);
1636
1637 return rc;
1638}
1639
Harald Welteaed946e2009-10-24 10:29:22 +02001640int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan)
1641{
1642 struct msgb *msg = rsl_msgb_alloc();
1643 struct abis_rsl_dchan_hdr *dh;
1644
1645 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
1646 init_dchan_hdr(dh, RSL_MT_IPAC_PDCH_ACT);
1647 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1648 dh->chan_nr = lchan2chan_nr(lchan);
1649
Harald Weltede4477a2009-12-24 12:20:20 +01001650 DEBUGP(DRSL, "%s IPAC_PDCH_ACT\n", gsm_ts_name(lchan->ts));
Harald Welteaed946e2009-10-24 10:29:22 +02001651
1652 msg->trx = lchan->ts->trx;
1653
1654 return abis_rsl_sendmsg(msg);
1655}
1656
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001657static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001658{
1659 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1660 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301661 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001662
1663 /* the BTS has acknowledged a local bind, it now tells us the IP
1664 * address and port number to which it has bound the given logical
1665 * channel */
1666
1667 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1668 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1669 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001670 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001671 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001672 return -EINVAL;
1673 }
Harald Welte50517742009-12-20 15:42:44 +01001674
Harald Weltebffa4992009-12-19 16:42:06 +01001675 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001676
1677 /* in case we don't use direct BTS-to-BTS RTP */
1678 if (!ipacc_rtp_direct) {
1679 int rc;
1680 /* the BTS has successfully bound a TCH to a local ip/port,
1681 * which means we can connect our UDP socket to it */
1682 if (lchan->abis_ip.rtp_socket) {
1683 rtp_socket_free(lchan->abis_ip.rtp_socket);
1684 lchan->abis_ip.rtp_socket = NULL;
1685 }
1686
1687 lchan->abis_ip.rtp_socket = rtp_socket_create();
1688 if (!lchan->abis_ip.rtp_socket)
1689 goto out_err;
1690
1691 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1692 lchan->abis_ip.bound_ip,
1693 lchan->abis_ip.bound_port);
1694 if (rc < 0)
1695 goto out_err;
1696 }
1697
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001698 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001699
1700 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001701out_err:
1702 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001703}
1704
Harald Weltebffa4992009-12-19 16:42:06 +01001705static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1706{
1707 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1708 struct tlv_parsed tv;
1709 struct gsm_lchan *lchan = msg->lchan;
1710
1711 /* the BTS has acknowledged a remote connect request and
1712 * it now tells us the IP address and port number to which it has
1713 * connected the given logical channel */
1714
1715 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1716 ipac_parse_rtp(lchan, &tv);
1717 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1718
1719 return 0;
1720}
1721
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001722static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001723{
1724 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1725 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001726 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001727
1728 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001729
Harald Weltef1a168d2009-07-28 17:58:09 +02001730 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001731 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001732 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001733
Harald Welte50517742009-12-20 15:42:44 +01001734 /* the BTS tells us a RTP stream has been disconnected */
1735 if (lchan->abis_ip.rtp_socket) {
1736 rtp_socket_free(lchan->abis_ip.rtp_socket);
1737 lchan->abis_ip.rtp_socket = NULL;
1738 }
1739
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001740 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001741
Harald Welte59b04682009-06-10 05:40:52 +08001742 return 0;
1743}
1744
1745static int abis_rsl_rx_ipacc(struct msgb *msg)
1746{
1747 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001748 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001749 int rc = 0;
1750
1751 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltede4477a2009-12-24 12:20:20 +01001752 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Welte59b04682009-06-10 05:40:52 +08001753
1754 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001755 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001756 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001757 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001758 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001759 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001760 /* somehow the BTS was unable to bind the lchan to its local
1761 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001762 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001763 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001764 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001765 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001766 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001767 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001768 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001769 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001770 /* somehow the BTS was unable to connect the lchan to a remote
1771 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001772 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001773 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001774 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001775 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001776 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001777 break;
1778 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001779 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001780 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001781 break;
1782 }
1783 DEBUGPC(DRSL, "\n");
1784
1785 return rc;
1786}
1787
1788
1789/* Entry-point where L2 RSL from BTS enters */
1790int abis_rsl_rcvmsg(struct msgb *msg)
1791{
1792 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
1793 int rc = 0;
1794
1795 switch (rslh->msg_discr & 0xfe) {
1796 case ABIS_RSL_MDISC_RLL:
1797 rc = abis_rsl_rx_rll(msg);
1798 break;
1799 case ABIS_RSL_MDISC_DED_CHAN:
1800 rc = abis_rsl_rx_dchan(msg);
1801 break;
1802 case ABIS_RSL_MDISC_COM_CHAN:
1803 rc = abis_rsl_rx_cchan(msg);
1804 break;
1805 case ABIS_RSL_MDISC_TRX:
1806 rc = abis_rsl_rx_trx(msg);
1807 break;
1808 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001809 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001810 rslh->msg_discr);
1811 break;
1812 case ABIS_RSL_MDISC_IPACCESS:
1813 rc = abis_rsl_rx_ipacc(msg);
1814 break;
1815 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001816 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1817 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001818 return -EINVAL;
1819 }
1820 msgb_free(msg);
1821 return rc;
1822}
1823
1824
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001825/* Section 3.3.2.3 TS 05.02. I think this looks like a table */
Harald Welte59b04682009-06-10 05:40:52 +08001826int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1827{
1828 switch (ccch_conf) {
1829 case RSL_BCCH_CCCH_CONF_1_NC:
1830 return 1;
1831 case RSL_BCCH_CCCH_CONF_1_C:
1832 return 1;
1833 case RSL_BCCH_CCCH_CONF_2_NC:
1834 return 2;
1835 case RSL_BCCH_CCCH_CONF_3_NC:
1836 return 3;
1837 case RSL_BCCH_CCCH_CONF_4_NC:
1838 return 4;
1839 default:
1840 return -1;
1841 }
1842}
1843
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001844/* Section 3.3.2.3 TS 05.02 */
Harald Welte59b04682009-06-10 05:40:52 +08001845int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1846{
1847 switch (ccch_conf) {
1848 case RSL_BCCH_CCCH_CONF_1_NC:
1849 return 0;
1850 case RSL_BCCH_CCCH_CONF_1_C:
1851 return 1;
1852 case RSL_BCCH_CCCH_CONF_2_NC:
1853 return 0;
1854 case RSL_BCCH_CCCH_CONF_3_NC:
1855 return 0;
1856 case RSL_BCCH_CCCH_CONF_4_NC:
1857 return 0;
1858 default:
1859 return -1;
1860 }
1861}
1862
1863/* From Table 10.5.33 of GSM 04.08 */
1864int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1865{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301866 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1867 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1868 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001869 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301870 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1871 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001872 }
1873}