blob: d4eb632ef7f65f89de1db4c5489af1de13957fe6 [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 */
Harald Welte906a3f52009-12-24 14:49:07 +0100958 LOGP(DRSL, LOGL_NOTICE, "CONNECTION FAIL: RELEASING");
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 Welte906a3f52009-12-24 14:49:07 +0100966 LOGP(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800967 /* FIXME: only free it after channel release ACK */
Harald Welte85a163c2009-08-10 11:43:22 +0200968 return rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800969}
970
Harald Weltec20bd1d2009-11-29 19:07:28 +0100971static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
972 const char *prefix)
973{
Harald Welte0e4fa782009-12-16 16:52:07 +0100974 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
975 prefix, rxlev2dbm(mru->full.rx_lev),
976 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100977 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
978 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
979}
980
981static void print_meas_rep(struct gsm_meas_rep *mr)
982{
Harald Welte0e4fa782009-12-16 16:52:07 +0100983 int i;
984
Harald Weltec20bd1d2009-11-29 19:07:28 +0100985 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
986
987 if (mr->flags & MEAS_REP_F_DL_DTX)
988 DEBUGPC(DMEAS, "DTXd ");
989
990 print_meas_rep_uni(&mr->ul, "ul");
991 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
992 if (mr->flags & MEAS_REP_F_MS_TO)
993 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
994
995 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100996 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100997 DEBUGPC(DMEAS, "L1_FPC=%u ",
998 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
999 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1000 }
1001
1002 if (mr->flags & MEAS_REP_F_UL_DTX)
1003 DEBUGPC(DMEAS, "DTXu ");
1004 if (mr->flags & MEAS_REP_F_BA1)
1005 DEBUGPC(DMEAS, "BA1 ");
1006 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1007 DEBUGPC(DMEAS, "NOT VALID ");
1008 else
1009 print_meas_rep_uni(&mr->dl, "dl");
1010
1011 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001012 if (mr->num_cell == 7)
1013 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001014 for (i = 0; i < mr->num_cell; i++) {
1015 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +01001016 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1017 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +01001018 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001019}
1020
Harald Welte59b04682009-06-10 05:40:52 +08001021static int rsl_rx_meas_res(struct msgb *msg)
1022{
1023 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1024 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001025 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001026 u_int8_t len;
1027 const u_int8_t *val;
1028 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001029
Harald Welte4baa9c52009-12-21 13:27:11 +01001030 /* check if this channel is actually active */
1031 /* FIXME: maybe this check should be way more generic/centralized */
1032 if (msg->lchan->state != LCHAN_S_ACTIVE)
1033 return 0;
1034
Harald Weltef9476812009-12-15 21:36:05 +01001035 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001036 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001037
Harald Welte59b04682009-06-10 05:40:52 +08001038 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1039
Harald Weltec20bd1d2009-11-29 19:07:28 +01001040 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1041 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1042 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1043 return -EIO;
1044
1045 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001046 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001047
1048 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1049 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1050 if (len >= 3) {
1051 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001052 mr->flags |= MEAS_REP_F_DL_DTX;
1053 mr->ul.full.rx_lev = val[0] & 0x3f;
1054 mr->ul.sub.rx_lev = val[1] & 0x3f;
1055 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1056 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001057 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001058
Harald Weltef9476812009-12-15 21:36:05 +01001059 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001060
1061 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001062 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001063 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001064 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1065
Harald Weltea1467eb2009-06-20 18:44:35 +02001066 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001067 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001068 mr->flags |= MEAS_REP_F_MS_L1;
1069 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001070 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001071 mr->flags |= MEAS_REP_F_FPC;
1072 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001073 }
Harald Welte59b04682009-06-10 05:40:52 +08001074 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001075 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001076 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001077 if (rc < 0)
1078 return rc;
1079 }
1080
Harald Weltef9476812009-12-15 21:36:05 +01001081 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001082
Harald Weltef9476812009-12-15 21:36:05 +01001083 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001084
Harald Welte59b04682009-06-10 05:40:52 +08001085 return 0;
1086}
1087
Harald Welte6720a432009-11-29 22:45:52 +01001088/* Chapter 8.4.7 */
1089static int rsl_rx_hando_det(struct msgb *msg)
1090{
1091 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1092 struct tlv_parsed tp;
1093
1094 DEBUGP(DRSL, "HANDOVER DETECT ");
1095
1096 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1097
1098 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1099 DEBUGPC(DRSL, "access delay = %u\n",
1100 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1101 else
1102 DEBUGPC(DRSL, "\n");
1103
1104 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1105
1106 return 0;
1107}
1108
Harald Welte59b04682009-06-10 05:40:52 +08001109static int abis_rsl_rx_dchan(struct msgb *msg)
1110{
1111 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1112 int rc = 0;
1113 char *ts_name;
1114
1115 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1116 ts_name = gsm_ts_name(msg->lchan->ts);
1117
Harald Welte59b04682009-06-10 05:40:52 +08001118 switch (rslh->c.msg_type) {
1119 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001120 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001121 rc = rsl_rx_chan_act_ack(msg);
1122 break;
1123 case RSL_MT_CHAN_ACTIV_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001124 DEBUGP(DRSL, "%s CHANNEL ACTIVATE NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001125 rc = rsl_rx_chan_act_nack(msg);
1126 break;
1127 case RSL_MT_CONN_FAIL:
Harald Weltede4477a2009-12-24 12:20:20 +01001128 DEBUGP(DRSL, "%s ", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001129 rc = rsl_rx_conn_fail(msg);
1130 break;
1131 case RSL_MT_MEAS_RES:
1132 rc = rsl_rx_meas_res(msg);
1133 break;
Harald Welte6720a432009-11-29 22:45:52 +01001134 case RSL_MT_HANDO_DET:
Harald Weltede4477a2009-12-24 12:20:20 +01001135 DEBUGP(DRSL, "%s ", ts_name);
Harald Welte6720a432009-11-29 22:45:52 +01001136 rc = rsl_rx_hando_det(msg);
1137 break;
Harald Welte59b04682009-06-10 05:40:52 +08001138 case RSL_MT_RF_CHAN_REL_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001139 DEBUGP(DRSL, "%s RF CHANNEL RELEASE ACK\n", ts_name);
Harald Welte4baa9c52009-12-21 13:27:11 +01001140 msg->lchan->state = LCHAN_S_NONE;
Harald Welte59b04682009-06-10 05:40:52 +08001141 lchan_free(msg->lchan);
1142 break;
1143 case RSL_MT_MODE_MODIFY_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001144 DEBUGP(DRSL, "%s CHANNEL MODE MODIFY ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001145 break;
1146 case RSL_MT_MODE_MODIFY_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001147 LOGP(DRSL, LOGL_ERROR, "%s CHANNEL MODE MODIFY NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001148 break;
Harald Welteaed946e2009-10-24 10:29:22 +02001149 case RSL_MT_IPAC_PDCH_ACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001150 DEBUGPC(DRSL, "%s IPAC PDCH ACT ACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001151 break;
1152 case RSL_MT_IPAC_PDCH_ACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001153 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH ACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001154 break;
1155 case RSL_MT_IPAC_PDCH_DEACT_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001156 DEBUGP(DRSL, "%s IPAC PDCH DEACT ACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001157 break;
1158 case RSL_MT_IPAC_PDCH_DEACT_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001159 LOGP(DRSL, LOGL_ERROR, "%s IPAC PDCH DEACT NACK\n", ts_name);
Harald Welteaed946e2009-10-24 10:29:22 +02001160 break;
Harald Welte59b04682009-06-10 05:40:52 +08001161 case RSL_MT_PHY_CONTEXT_CONF:
1162 case RSL_MT_PREPROC_MEAS_RES:
1163 case RSL_MT_TALKER_DET:
1164 case RSL_MT_LISTENER_DET:
1165 case RSL_MT_REMOTE_CODEC_CONF_REP:
1166 case RSL_MT_MR_CODEC_MOD_ACK:
1167 case RSL_MT_MR_CODEC_MOD_NACK:
1168 case RSL_MT_MR_CODEC_MOD_PER:
Harald Weltede4477a2009-12-24 12:20:20 +01001169 LOGP(DRSL, LOGL_NOTICE, "%s Unimplemented Abis RSL DChan "
1170 "msg 0x%02x\n", ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001171 break;
1172 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001173 LOGP(DRSL, LOGL_NOTICE, "%s unknown Abis RSL DChan msg 0x%02x\n",
1174 ts_name, rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001175 return -EINVAL;
1176 }
1177
1178 return rc;
1179}
1180
1181static int rsl_rx_error_rep(struct msgb *msg)
1182{
1183 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
Harald Weltef1a168d2009-07-28 17:58:09 +02001184 struct tlv_parsed tp;
Harald Welte59b04682009-06-10 05:40:52 +08001185
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001186 LOGP(DRSL, LOGL_ERROR, "ERROR REPORT ");
Harald Weltef1a168d2009-07-28 17:58:09 +02001187
1188 rsl_tlv_parse(&tp, rslh->data, msgb_l2len(msg)-sizeof(*rslh));
1189
1190 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001191 print_rsl_cause(LOGL_ERROR, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001192 TLVP_LEN(&tp, RSL_IE_CAUSE));
1193
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001194 LOGPC(DRSL, LOGL_ERROR, "\n");
Harald Welte59b04682009-06-10 05:40:52 +08001195
1196 return 0;
1197}
1198
1199static int abis_rsl_rx_trx(struct msgb *msg)
1200{
1201 struct abis_rsl_common_hdr *rslh = msgb_l2(msg);
1202 int rc = 0;
1203
1204 switch (rslh->msg_type) {
1205 case RSL_MT_ERROR_REPORT:
1206 rc = rsl_rx_error_rep(msg);
1207 break;
1208 case RSL_MT_RF_RES_IND:
1209 /* interference on idle channels of TRX */
1210 //DEBUGP(DRSL, "TRX: RF Interference Indication\n");
1211 break;
1212 case RSL_MT_OVERLOAD:
1213 /* indicate CCCH / ACCH / processor overload */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001214 LOGP(DRSL, LOGL_ERROR, "TRX: CCCH/ACCH/CPU Overload\n");
Harald Welte59b04682009-06-10 05:40:52 +08001215 break;
1216 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001217 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message "
1218 "type 0x%02x\n", rslh->msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001219 return -EINVAL;
1220 }
1221 return rc;
1222}
1223
Harald Welte427dbc42009-08-10 00:26:10 +02001224/* If T3101 expires, we never received a response to IMMEDIATE ASSIGN */
1225static void t3101_expired(void *data)
1226{
1227 struct gsm_lchan *lchan = data;
1228
Harald Welte85a163c2009-08-10 11:43:22 +02001229 rsl_rf_chan_release(lchan);
Harald Welte427dbc42009-08-10 00:26:10 +02001230}
1231
Harald Welte59b04682009-06-10 05:40:52 +08001232/* MS has requested a channel on the RACH */
1233static int rsl_rx_chan_rqd(struct msgb *msg)
1234{
1235 struct gsm_bts *bts = msg->trx->bts;
1236 struct abis_rsl_dchan_hdr *rqd_hdr = msgb_l2(msg);
1237 struct gsm48_req_ref *rqd_ref;
1238 struct gsm48_imm_ass ia;
1239 enum gsm_chan_t lctype;
1240 enum gsm_chreq_reason_t chreq_reason;
1241 struct gsm_lchan *lchan;
1242 u_int8_t rqd_ta;
1243 int ret;
1244
1245 u_int16_t arfcn;
1246 u_int8_t ts_number, subch;
1247
1248 /* parse request reference to be used in immediate assign */
1249 if (rqd_hdr->data[0] != RSL_IE_REQ_REFERENCE)
1250 return -EINVAL;
1251
1252 rqd_ref = (struct gsm48_req_ref *) &rqd_hdr->data[1];
1253
1254 /* parse access delay and use as TA */
1255 if (rqd_hdr->data[sizeof(struct gsm48_req_ref)+1] != RSL_IE_ACCESS_DELAY)
1256 return -EINVAL;
1257 rqd_ta = rqd_hdr->data[sizeof(struct gsm48_req_ref)+2];
1258
1259 /* determine channel type (SDCCH/TCH_F/TCH_H) based on
1260 * request reference RA */
Holger Hans Peter Freyther96c89822009-11-16 17:12:38 +01001261 lctype = get_ctype_by_chreq(bts, rqd_ref->ra, bts->network->neci);
1262 chreq_reason = get_reason_by_chreq(bts, rqd_ref->ra, bts->network->neci);
Harald Welte59b04682009-06-10 05:40:52 +08001263
Harald Weltebdbb7442009-12-22 19:07:32 +01001264 counter_inc(bts->network->stats.chreq.total);
Harald Welte3edc5a92009-12-22 00:41:05 +01001265
Harald Welte59b04682009-06-10 05:40:52 +08001266 /* check availability / allocate channel */
1267 lchan = lchan_alloc(bts, lctype);
1268 if (!lchan) {
Harald Weltede4477a2009-12-24 12:20:20 +01001269 LOGP(DRSL, LOGL_NOTICE, "CHAN RQD: no resources for %s 0x%x\n",
Harald Welte059b6a82009-12-12 20:53:23 +01001270 gsm_lchan_name(lctype), rqd_ref->ra);
Harald Weltebdbb7442009-12-22 19:07:32 +01001271 counter_inc(bts->network->stats.chreq.no_channel);
Harald Welte59b04682009-06-10 05:40:52 +08001272 /* FIXME: send some kind of reject ?!? */
1273 return -ENOMEM;
1274 }
1275
1276 ts_number = lchan->ts->nr;
1277 arfcn = lchan->ts->trx->arfcn;
1278 subch = lchan->nr;
1279
Harald Welted2dd9de2009-08-30 15:37:11 +09001280 lchan->encr.alg_id = RSL_ENC_ALG_A5(0); /* no encryption */
Harald Welte (local)cbd46102009-08-13 10:14:26 +02001281 lchan->ms_power = ms_pwr_ctl_lvl(bts->band, bts->ms_max_power);
Harald Welte9a229e12009-08-10 00:45:40 +02001282 lchan->bs_power = 0; /* 0dB reduction, output power = Pn */
Harald Welte39274f42009-07-29 15:41:29 +02001283 lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
Harald Welte77234e12009-08-28 23:28:28 +09001284 lchan->tch_mode = GSM48_CMODE_SIGN;
Harald Welteb90d7bd2009-12-17 00:31:10 +01001285 rsl_chan_activate_lchan(lchan, 0x00, rqd_ta, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001286
1287 /* create IMMEDIATE ASSIGN 04.08 messge */
1288 memset(&ia, 0, sizeof(ia));
1289 ia.l2_plen = 0x2d;
1290 ia.proto_discr = GSM48_PDISC_RR;
1291 ia.msg_type = GSM48_MT_RR_IMM_ASS;
1292 ia.page_mode = GSM48_PM_SAME;
1293 ia.chan_desc.chan_nr = lchan2chan_nr(lchan);
1294 ia.chan_desc.h0.h = 0;
1295 ia.chan_desc.h0.arfcn_high = arfcn >> 8;
1296 ia.chan_desc.h0.arfcn_low = arfcn & 0xff;
Harald Welte63d23c82009-07-21 20:55:56 +02001297 ia.chan_desc.h0.tsc = bts->tsc;
Harald Welte59b04682009-06-10 05:40:52 +08001298 /* use request reference extracted from CHAN_RQD */
1299 memcpy(&ia.req_ref, rqd_ref, sizeof(ia.req_ref));
1300 ia.timing_advance = rqd_ta;
1301 ia.mob_alloc_len = 0;
1302
Harald Weltede4477a2009-12-24 12:20:20 +01001303 DEBUGP(DRSL, "%s Activating ARFCN(%u) SS(%u) lctype %s "
1304 "r=%s ra=0x%02x\n", gsm_ts_name(lchan->ts), arfcn, subch,
1305 gsm_lchan_name(lchan->type), gsm_chreq_name(chreq_reason),
Harald Welte59b04682009-06-10 05:40:52 +08001306 rqd_ref->ra);
1307
Harald Welte427dbc42009-08-10 00:26:10 +02001308 /* Start timer T3101 to wait for GSM48_MT_RR_PAG_RESP */
1309 lchan->T3101.cb = t3101_expired;
1310 lchan->T3101.data = lchan;
Holger Hans Peter Freyther26ba2e72009-11-21 21:18:38 +01001311 bsc_schedule_timer(&lchan->T3101, bts->network->T3101, 0);
Harald Welte59b04682009-06-10 05:40:52 +08001312
1313 /* send IMMEDIATE ASSIGN CMD on RSL to BTS (to send on CCCH to MS) */
1314 ret = rsl_imm_assign_cmd(bts, sizeof(ia), (u_int8_t *) &ia);
1315
1316 return ret;
1317}
1318
1319/* MS has requested a channel on the RACH */
1320static int rsl_rx_ccch_load(struct msgb *msg)
1321{
1322 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1323 u_int16_t pg_buf_space;
1324 u_int16_t rach_slot_count = -1;
1325 u_int16_t rach_busy_count = -1;
1326 u_int16_t rach_access_count = -1;
1327
1328 switch (rslh->data[0]) {
1329 case RSL_IE_PAGING_LOAD:
1330 pg_buf_space = rslh->data[1] << 8 | rslh->data[2];
1331 paging_update_buffer_space(msg->trx->bts, pg_buf_space);
1332 break;
1333 case RSL_IE_RACH_LOAD:
1334 if (msg->data_len >= 7) {
1335 rach_slot_count = rslh->data[2] << 8 | rslh->data[3];
1336 rach_busy_count = rslh->data[4] << 8 | rslh->data[5];
1337 rach_access_count = rslh->data[6] << 8 | rslh->data[7];
1338 }
1339 break;
1340 default:
1341 break;
1342 }
1343
1344 return 0;
1345}
1346
1347static int abis_rsl_rx_cchan(struct msgb *msg)
1348{
1349 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1350 int rc = 0;
1351
1352 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1353
1354 switch (rslh->c.msg_type) {
1355 case RSL_MT_CHAN_RQD:
1356 /* MS has requested a channel on the RACH */
1357 rc = rsl_rx_chan_rqd(msg);
1358 break;
1359 case RSL_MT_CCCH_LOAD_IND:
1360 /* current load on the CCCH */
1361 rc = rsl_rx_ccch_load(msg);
1362 break;
1363 case RSL_MT_DELETE_IND:
1364 /* CCCH overloaded, IMM_ASSIGN was dropped */
1365 case RSL_MT_CBCH_LOAD_IND:
1366 /* current load on the CBCH */
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001367 LOGP(DRSL, LOGL_NOTICE, "Unimplemented Abis RSL TRX message "
1368 "type 0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001369 break;
1370 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001371 LOGP(DRSL, LOGL_NOTICE, "Unknown Abis RSL TRX message type "
1372 "0x%02x\n", rslh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001373 return -EINVAL;
1374 }
1375
1376 return rc;
1377}
1378
1379static int rsl_rx_rll_err_ind(struct msgb *msg)
1380{
1381 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1382 u_int8_t *rlm_cause = rllh->data;
1383
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001384 LOGP(DRLL, LOGL_ERROR, "ERROR INDICATION cause=0x%02x\n", rlm_cause[1]);
Harald Welteed9a5ab2009-08-09 13:47:35 +02001385
1386 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte59b04682009-06-10 05:40:52 +08001387
Harald Welte692f5852009-07-04 09:40:05 +02001388 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED)
Harald Welte85a163c2009-08-10 11:43:22 +02001389 return rsl_rf_chan_release(msg->lchan);
Harald Welte692f5852009-07-04 09:40:05 +02001390
Harald Welte59b04682009-06-10 05:40:52 +08001391 return 0;
1392}
1393
1394/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
1395 0x02, 0x06,
1396 0x01, 0x20,
1397 0x02, 0x00,
1398 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1399
1400static int abis_rsl_rx_rll(struct msgb *msg)
1401{
1402 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1403 int rc = 0;
1404 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001405 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001406
1407 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
1408 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Weltede4477a2009-12-24 12:20:20 +01001409 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001410
1411 switch (rllh->c.msg_type) {
1412 case RSL_MT_DATA_IND:
1413 DEBUGPC(DRLL, "DATA INDICATION\n");
1414 if (msgb_l2len(msg) >
1415 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1416 rllh->data[0] == RSL_IE_L3_INFO) {
1417 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001418 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001419 }
1420 break;
1421 case RSL_MT_EST_IND:
1422 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001423 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001424 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001425 bsc_del_timer(&msg->lchan->T3101);
Harald Welte59b04682009-06-10 05:40:52 +08001426 if (msgb_l2len(msg) >
1427 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1428 rllh->data[0] == RSL_IE_L3_INFO) {
1429 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001430 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001431 }
1432 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001433 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001434 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001435 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001436 rll_indication(msg->lchan, rllh->link_id,
1437 BSC_RLLR_IND_EST_CONF);
1438 break;
Harald Welte59b04682009-06-10 05:40:52 +08001439 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001440 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001441 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001442 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001443 rll_indication(msg->lchan, rllh->link_id,
1444 BSC_RLLR_IND_REL_IND);
Harald Welte0f2e3c12009-08-08 13:15:07 +02001445 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001446 /* FIXME: officially we need to start T3111 and wait for
1447 * some grace period */
1448 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001449 break;
1450 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001451 /* BTS informs us of having received UA from MS,
1452 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001453 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001454 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welte0f2e3c12009-08-08 13:15:07 +02001455 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001456 /* FIXME: officially we need to start T3111 and wait for
1457 * some grace period */
1458 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001459 break;
1460 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001461 rc = rsl_rx_rll_err_ind(msg);
1462 break;
1463 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001464 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1465 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001466 break;
1467 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001468 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1469 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001470 }
Harald Welte59b04682009-06-10 05:40:52 +08001471 return rc;
1472}
1473
Harald Welteb284b472009-12-02 01:58:23 +05301474static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001475{
Harald Welteb284b472009-12-02 01:58:23 +05301476 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001477 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301478 switch (lchan->type) {
1479 case GSM_LCHAN_TCH_F:
1480 return 0x00;
1481 case GSM_LCHAN_TCH_H:
1482 return 0x03;
1483 default:
1484 break;
1485 }
Harald Welte98d79f92009-07-28 18:11:56 +02001486 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301487 switch (lchan->type) {
1488 case GSM_LCHAN_TCH_F:
1489 return 0x01;
1490 /* there's no half-rate EFR */
1491 default:
1492 break;
1493 }
Harald Welte98d79f92009-07-28 18:11:56 +02001494 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301495 switch (lchan->type) {
1496 case GSM_LCHAN_TCH_F:
1497 return 0x02;
1498 case GSM_LCHAN_TCH_H:
1499 return 0x05;
1500 default:
1501 break;
1502 }
1503 default:
1504 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001505 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001506 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301507 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001508 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001509}
1510
Harald Welte59b04682009-06-10 05:40:52 +08001511/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001512static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1513{
1514 struct in_addr ip;
1515 u_int16_t port, conn_id;
1516
1517 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1518 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1519 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1520 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1521 }
1522
1523 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1524 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1525 port = ntohs(port);
1526 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1527 lchan->abis_ip.bound_port = port;
1528 }
1529
1530 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1531 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1532 conn_id = ntohs(conn_id);
1533 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1534 lchan->abis_ip.conn_id = conn_id;
1535 }
1536
1537 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1538 lchan->abis_ip.rtp_payload2 =
1539 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1540 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1541 lchan->abis_ip.rtp_payload2);
1542 }
1543
1544 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1545 lchan->abis_ip.speech_mode =
1546 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1547 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1548 lchan->abis_ip.speech_mode);
1549 }
1550
1551 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1552 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1553 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1554 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1555 }
1556
1557 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1558 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1559 port = ntohs(port);
1560 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1561 lchan->abis_ip.connect_port = port;
1562 }
1563}
1564
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001565int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001566{
1567 struct msgb *msg = rsl_msgb_alloc();
1568 struct abis_rsl_dchan_hdr *dh;
1569
1570 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001571 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001572 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1573 dh->chan_nr = lchan2chan_nr(lchan);
1574
Harald Welte98d79f92009-07-28 18:11:56 +02001575 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001576 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
1577 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001578
Harald Weltede4477a2009-12-24 12:20:20 +01001579 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x\n",
1580 gsm_ts_name(lchan->ts), lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001581
Harald Welte59b04682009-06-10 05:40:52 +08001582 msg->trx = lchan->ts->trx;
1583
1584 return abis_rsl_sendmsg(msg);
1585}
1586
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001587int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001588 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001589{
1590 struct msgb *msg = rsl_msgb_alloc();
1591 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001592 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001593 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001594
1595 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001596 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001597 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1598 dh->chan_nr = lchan2chan_nr(lchan);
1599
Harald Weltebffa4992009-12-19 16:42:06 +01001600 /* we need to store these now as MDCX_ACK does not return them :( */
1601 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1602 lchan->abis_ip.connect_port = port;
1603 lchan->abis_ip.connect_ip = ip;
1604
Harald Weltefb4a9e92009-07-29 12:12:18 +02001605 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001606 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001607
Harald Welte98d79f92009-07-28 18:11:56 +02001608 ia.s_addr = htonl(ip);
Harald Weltede4477a2009-12-24 12:20:20 +01001609 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD2=%d CONN_ID=%d "
1610 "speech_mode=0x%02x\n", gsm_ts_name(lchan->ts), inet_ntoa(ia), port,
Harald Weltebffa4992009-12-19 16:42:06 +01001611 rtp_payload2, lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001612
Harald Weltebffa4992009-12-19 16:42:06 +01001613 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1614 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1615 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1616 *att_ip = ia.s_addr;
1617 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1618 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001619 if (rtp_payload2)
1620 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1621
Harald Welte59b04682009-06-10 05:40:52 +08001622 msg->trx = lchan->ts->trx;
1623
1624 return abis_rsl_sendmsg(msg);
1625}
1626
Harald Welte9947d9f2009-12-20 16:51:09 +01001627/* tell BTS to connect RTP stream to our local RTP socket */
1628int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1629{
1630 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1631 int rc;
1632
1633 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1634 ntohs(rs->rtp.sin_local.sin_port),
1635 /* FIXME: use RTP payload of bound socket, not BTS*/
1636 lchan->abis_ip.rtp_payload2);
1637
1638 return rc;
1639}
1640
Harald Welteaed946e2009-10-24 10:29:22 +02001641int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan)
1642{
1643 struct msgb *msg = rsl_msgb_alloc();
1644 struct abis_rsl_dchan_hdr *dh;
1645
1646 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
1647 init_dchan_hdr(dh, RSL_MT_IPAC_PDCH_ACT);
1648 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1649 dh->chan_nr = lchan2chan_nr(lchan);
1650
Harald Weltede4477a2009-12-24 12:20:20 +01001651 DEBUGP(DRSL, "%s IPAC_PDCH_ACT\n", gsm_ts_name(lchan->ts));
Harald Welteaed946e2009-10-24 10:29:22 +02001652
1653 msg->trx = lchan->ts->trx;
1654
1655 return abis_rsl_sendmsg(msg);
1656}
1657
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001658static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001659{
1660 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1661 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301662 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001663
1664 /* the BTS has acknowledged a local bind, it now tells us the IP
1665 * address and port number to which it has bound the given logical
1666 * channel */
1667
1668 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1669 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1670 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001671 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001672 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001673 return -EINVAL;
1674 }
Harald Welte50517742009-12-20 15:42:44 +01001675
Harald Weltebffa4992009-12-19 16:42:06 +01001676 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001677
1678 /* in case we don't use direct BTS-to-BTS RTP */
1679 if (!ipacc_rtp_direct) {
1680 int rc;
1681 /* the BTS has successfully bound a TCH to a local ip/port,
1682 * which means we can connect our UDP socket to it */
1683 if (lchan->abis_ip.rtp_socket) {
1684 rtp_socket_free(lchan->abis_ip.rtp_socket);
1685 lchan->abis_ip.rtp_socket = NULL;
1686 }
1687
1688 lchan->abis_ip.rtp_socket = rtp_socket_create();
1689 if (!lchan->abis_ip.rtp_socket)
1690 goto out_err;
1691
1692 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1693 lchan->abis_ip.bound_ip,
1694 lchan->abis_ip.bound_port);
1695 if (rc < 0)
1696 goto out_err;
1697 }
1698
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001699 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001700
1701 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001702out_err:
1703 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001704}
1705
Harald Weltebffa4992009-12-19 16:42:06 +01001706static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1707{
1708 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1709 struct tlv_parsed tv;
1710 struct gsm_lchan *lchan = msg->lchan;
1711
1712 /* the BTS has acknowledged a remote connect request and
1713 * it now tells us the IP address and port number to which it has
1714 * connected the given logical channel */
1715
1716 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1717 ipac_parse_rtp(lchan, &tv);
1718 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1719
1720 return 0;
1721}
1722
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001723static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001724{
1725 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1726 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001727 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001728
1729 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001730
Harald Weltef1a168d2009-07-28 17:58:09 +02001731 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001732 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001733 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001734
Harald Welte50517742009-12-20 15:42:44 +01001735 /* the BTS tells us a RTP stream has been disconnected */
1736 if (lchan->abis_ip.rtp_socket) {
1737 rtp_socket_free(lchan->abis_ip.rtp_socket);
1738 lchan->abis_ip.rtp_socket = NULL;
1739 }
1740
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001741 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001742
Harald Welte59b04682009-06-10 05:40:52 +08001743 return 0;
1744}
1745
1746static int abis_rsl_rx_ipacc(struct msgb *msg)
1747{
1748 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001749 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001750 int rc = 0;
1751
1752 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltede4477a2009-12-24 12:20:20 +01001753 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Welte59b04682009-06-10 05:40:52 +08001754
1755 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001756 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001757 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001758 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001759 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001760 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001761 /* somehow the BTS was unable to bind the lchan to its local
1762 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001763 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001764 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001765 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001766 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001767 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001768 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001769 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001770 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001771 /* somehow the BTS was unable to connect the lchan to a remote
1772 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001773 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001774 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001775 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001776 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001777 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001778 break;
1779 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001780 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001781 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001782 break;
1783 }
1784 DEBUGPC(DRSL, "\n");
1785
1786 return rc;
1787}
1788
1789
1790/* Entry-point where L2 RSL from BTS enters */
1791int abis_rsl_rcvmsg(struct msgb *msg)
1792{
1793 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
1794 int rc = 0;
1795
1796 switch (rslh->msg_discr & 0xfe) {
1797 case ABIS_RSL_MDISC_RLL:
1798 rc = abis_rsl_rx_rll(msg);
1799 break;
1800 case ABIS_RSL_MDISC_DED_CHAN:
1801 rc = abis_rsl_rx_dchan(msg);
1802 break;
1803 case ABIS_RSL_MDISC_COM_CHAN:
1804 rc = abis_rsl_rx_cchan(msg);
1805 break;
1806 case ABIS_RSL_MDISC_TRX:
1807 rc = abis_rsl_rx_trx(msg);
1808 break;
1809 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001810 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001811 rslh->msg_discr);
1812 break;
1813 case ABIS_RSL_MDISC_IPACCESS:
1814 rc = abis_rsl_rx_ipacc(msg);
1815 break;
1816 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001817 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1818 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001819 return -EINVAL;
1820 }
1821 msgb_free(msg);
1822 return rc;
1823}
1824
1825
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001826/* Section 3.3.2.3 TS 05.02. I think this looks like a table */
Harald Welte59b04682009-06-10 05:40:52 +08001827int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1828{
1829 switch (ccch_conf) {
1830 case RSL_BCCH_CCCH_CONF_1_NC:
1831 return 1;
1832 case RSL_BCCH_CCCH_CONF_1_C:
1833 return 1;
1834 case RSL_BCCH_CCCH_CONF_2_NC:
1835 return 2;
1836 case RSL_BCCH_CCCH_CONF_3_NC:
1837 return 3;
1838 case RSL_BCCH_CCCH_CONF_4_NC:
1839 return 4;
1840 default:
1841 return -1;
1842 }
1843}
1844
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001845/* Section 3.3.2.3 TS 05.02 */
Harald Welte59b04682009-06-10 05:40:52 +08001846int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1847{
1848 switch (ccch_conf) {
1849 case RSL_BCCH_CCCH_CONF_1_NC:
1850 return 0;
1851 case RSL_BCCH_CCCH_CONF_1_C:
1852 return 1;
1853 case RSL_BCCH_CCCH_CONF_2_NC:
1854 return 0;
1855 case RSL_BCCH_CCCH_CONF_3_NC:
1856 return 0;
1857 case RSL_BCCH_CCCH_CONF_4_NC:
1858 return 0;
1859 default:
1860 return -1;
1861 }
1862}
1863
1864/* From Table 10.5.33 of GSM 04.08 */
1865int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1866{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301867 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1868 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1869 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001870 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301871 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1872 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001873 }
1874}