blob: df0f1bc22f75eb50a8e5482b3dfea33ad52741d2 [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 Welte (local)4bd76642009-12-26 22:33:09 +0100958 LOGP(DRSL, LOGL_NOTICE, "%s CONNECTION FAIL: RELEASING ",
959 gsm_ts_name(msg->lchan->ts));
Harald Welte59b04682009-06-10 05:40:52 +0800960
961 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
962
Harald Weltef1a168d2009-07-28 17:58:09 +0200963 if (TLVP_PRESENT(&tp, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +0100964 print_rsl_cause(LOGL_NOTICE, TLVP_VAL(&tp, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +0200965 TLVP_LEN(&tp, RSL_IE_CAUSE));
966
Harald Welte (local)4bd76642009-12-26 22:33:09 +0100967 LOGPC(DRSL, LOGL_NOTICE, "\n");
Harald Welte59b04682009-06-10 05:40:52 +0800968 /* FIXME: only free it after channel release ACK */
Harald Welte85a163c2009-08-10 11:43:22 +0200969 return rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +0800970}
971
Harald Weltec20bd1d2009-11-29 19:07:28 +0100972static void print_meas_rep_uni(struct gsm_meas_rep_unidir *mru,
973 const char *prefix)
974{
Harald Welte0e4fa782009-12-16 16:52:07 +0100975 DEBUGPC(DMEAS, "RXL-FULL-%s=%3ddBm RXL-SUB-%s=%3ddBm ",
976 prefix, rxlev2dbm(mru->full.rx_lev),
977 prefix, rxlev2dbm(mru->sub.rx_lev));
Harald Weltec20bd1d2009-11-29 19:07:28 +0100978 DEBUGPC(DMEAS, "RXQ-FULL-%s=%d RXQ-SUB-%s=%d ",
979 prefix, mru->full.rx_qual, prefix, mru->sub.rx_qual);
980}
981
982static void print_meas_rep(struct gsm_meas_rep *mr)
983{
Harald Welte0e4fa782009-12-16 16:52:07 +0100984 int i;
985
Harald Weltec20bd1d2009-11-29 19:07:28 +0100986 DEBUGP(DMEAS, "MEASUREMENT RESULT NR=%d ", mr->nr);
987
988 if (mr->flags & MEAS_REP_F_DL_DTX)
989 DEBUGPC(DMEAS, "DTXd ");
990
991 print_meas_rep_uni(&mr->ul, "ul");
992 DEBUGPC(DMEAS, "BS_POWER=%d ", mr->bs_power);
993 if (mr->flags & MEAS_REP_F_MS_TO)
994 DEBUGPC(DMEAS, "MS_TO=%d ", mr->ms_timing_offset);
995
996 if (mr->flags & MEAS_REP_F_MS_L1) {
Harald Welte0e4fa782009-12-16 16:52:07 +0100997 DEBUGPC(DMEAS, "L1_MS_PWR=%3ddBm ", mr->ms_l1.pwr);
Harald Weltec20bd1d2009-11-29 19:07:28 +0100998 DEBUGPC(DMEAS, "L1_FPC=%u ",
999 mr->flags & MEAS_REP_F_FPC ? 1 : 0);
1000 DEBUGPC(DMEAS, "L1_TA=%u ", mr->ms_l1.ta);
1001 }
1002
1003 if (mr->flags & MEAS_REP_F_UL_DTX)
1004 DEBUGPC(DMEAS, "DTXu ");
1005 if (mr->flags & MEAS_REP_F_BA1)
1006 DEBUGPC(DMEAS, "BA1 ");
1007 if (!(mr->flags & MEAS_REP_F_DL_VALID))
1008 DEBUGPC(DMEAS, "NOT VALID ");
1009 else
1010 print_meas_rep_uni(&mr->dl, "dl");
1011
1012 DEBUGPC(DMEAS, "NUM_NEIGH=%u\n", mr->num_cell);
Harald Welte0b833f82009-12-19 18:33:05 +01001013 if (mr->num_cell == 7)
1014 return;
Harald Welte0e4fa782009-12-16 16:52:07 +01001015 for (i = 0; i < mr->num_cell; i++) {
1016 struct gsm_meas_rep_cell *mrc = &mr->cell[i];
Harald Welte350c2d32009-12-25 23:02:22 +01001017 DEBUGP(DMEAS, "IDX=%u ARFCN=%u BSIC=%u => %d dBm\n",
1018 mrc->neigh_idx, mrc->arfcn, mrc->bsic, rxlev2dbm(mrc->rxlev));
Harald Welte0e4fa782009-12-16 16:52:07 +01001019 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001020}
1021
Harald Welte59b04682009-06-10 05:40:52 +08001022static int rsl_rx_meas_res(struct msgb *msg)
1023{
1024 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1025 struct tlv_parsed tp;
Harald Weltef9476812009-12-15 21:36:05 +01001026 struct gsm_meas_rep *mr = lchan_next_meas_rep(msg->lchan);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001027 u_int8_t len;
1028 const u_int8_t *val;
1029 int rc;
Harald Welte59b04682009-06-10 05:40:52 +08001030
Harald Welte4baa9c52009-12-21 13:27:11 +01001031 /* check if this channel is actually active */
1032 /* FIXME: maybe this check should be way more generic/centralized */
1033 if (msg->lchan->state != LCHAN_S_ACTIVE)
1034 return 0;
1035
Harald Weltef9476812009-12-15 21:36:05 +01001036 memset(mr, 0, sizeof(*mr));
Harald Welteaa0efa12009-12-16 23:29:34 +01001037 mr->lchan = msg->lchan;
Harald Welte4efcc542009-11-30 19:16:47 +01001038
Harald Welte59b04682009-06-10 05:40:52 +08001039 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1040
Harald Weltec20bd1d2009-11-29 19:07:28 +01001041 if (!TLVP_PRESENT(&tp, RSL_IE_MEAS_RES_NR) ||
1042 !TLVP_PRESENT(&tp, RSL_IE_UPLINK_MEAS) ||
1043 !TLVP_PRESENT(&tp, RSL_IE_BS_POWER))
1044 return -EIO;
1045
1046 /* Mandatory Parts */
Harald Weltef9476812009-12-15 21:36:05 +01001047 mr->nr = *TLVP_VAL(&tp, RSL_IE_MEAS_RES_NR);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001048
1049 len = TLVP_LEN(&tp, RSL_IE_UPLINK_MEAS);
1050 val = TLVP_VAL(&tp, RSL_IE_UPLINK_MEAS);
1051 if (len >= 3) {
1052 if (val[0] & 0x40)
Harald Weltef9476812009-12-15 21:36:05 +01001053 mr->flags |= MEAS_REP_F_DL_DTX;
1054 mr->ul.full.rx_lev = val[0] & 0x3f;
1055 mr->ul.sub.rx_lev = val[1] & 0x3f;
1056 mr->ul.full.rx_qual = val[2]>>3 & 0x7;
1057 mr->ul.sub.rx_qual = val[2] & 0x7;
Harald Welte59b04682009-06-10 05:40:52 +08001058 }
Harald Weltec20bd1d2009-11-29 19:07:28 +01001059
Harald Weltef9476812009-12-15 21:36:05 +01001060 mr->bs_power = *TLVP_VAL(&tp, RSL_IE_BS_POWER);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001061
1062 /* Optional Parts */
Harald Welte59b04682009-06-10 05:40:52 +08001063 if (TLVP_PRESENT(&tp, RSL_IE_MS_TIMING_OFFSET))
Harald Weltef9476812009-12-15 21:36:05 +01001064 mr->ms_timing_offset =
Harald Weltec20bd1d2009-11-29 19:07:28 +01001065 *TLVP_VAL(&tp, RSL_IE_MS_TIMING_OFFSET);
1066
Harald Weltea1467eb2009-06-20 18:44:35 +02001067 if (TLVP_PRESENT(&tp, RSL_IE_L1_INFO)) {
Harald Weltec20bd1d2009-11-29 19:07:28 +01001068 val = TLVP_VAL(&tp, RSL_IE_L1_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001069 mr->flags |= MEAS_REP_F_MS_L1;
1070 mr->ms_l1.pwr = ms_pwr_dbm(msg->trx->bts->band, val[0] >> 3);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001071 if (val[0] & 0x04)
Harald Weltef9476812009-12-15 21:36:05 +01001072 mr->flags |= MEAS_REP_F_FPC;
1073 mr->ms_l1.ta = val[1];
Harald Weltea1467eb2009-06-20 18:44:35 +02001074 }
Harald Welte59b04682009-06-10 05:40:52 +08001075 if (TLVP_PRESENT(&tp, RSL_IE_L3_INFO)) {
Holger Hans Peter Freyther6d0c8b42009-10-22 15:43:55 +02001076 msg->l3h = (u_int8_t *) TLVP_VAL(&tp, RSL_IE_L3_INFO);
Harald Weltef9476812009-12-15 21:36:05 +01001077 rc = gsm48_parse_meas_rep(mr, msg);
Harald Weltec20bd1d2009-11-29 19:07:28 +01001078 if (rc < 0)
1079 return rc;
1080 }
1081
Harald Weltef9476812009-12-15 21:36:05 +01001082 print_meas_rep(mr);
Harald Welte59b04682009-06-10 05:40:52 +08001083
Harald Weltef9476812009-12-15 21:36:05 +01001084 dispatch_signal(SS_LCHAN, S_LCHAN_MEAS_REP, mr);
Harald Welte4efcc542009-11-30 19:16:47 +01001085
Harald Welte59b04682009-06-10 05:40:52 +08001086 return 0;
1087}
1088
Harald Welte6720a432009-11-29 22:45:52 +01001089/* Chapter 8.4.7 */
1090static int rsl_rx_hando_det(struct msgb *msg)
1091{
1092 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1093 struct tlv_parsed tp;
1094
Harald Welte (local)4bd76642009-12-26 22:33:09 +01001095 DEBUGP(DRSL, "%s HANDOVER DETECT ", gsm_ts_name(msg->lchan->ts));
Harald Welte6720a432009-11-29 22:45:52 +01001096
1097 rsl_tlv_parse(&tp, dh->data, msgb_l2len(msg)-sizeof(*dh));
1098
1099 if (TLVP_PRESENT(&tp, RSL_IE_ACCESS_DELAY))
1100 DEBUGPC(DRSL, "access delay = %u\n",
1101 *TLVP_VAL(&tp, RSL_IE_ACCESS_DELAY));
1102 else
1103 DEBUGPC(DRSL, "\n");
1104
1105 dispatch_signal(SS_LCHAN, S_LCHAN_HANDOVER_DETECT, msg->lchan);
1106
1107 return 0;
1108}
1109
Harald Welte59b04682009-06-10 05:40:52 +08001110static int abis_rsl_rx_dchan(struct msgb *msg)
1111{
1112 struct abis_rsl_dchan_hdr *rslh = msgb_l2(msg);
1113 int rc = 0;
1114 char *ts_name;
1115
1116 msg->lchan = lchan_lookup(msg->trx, rslh->chan_nr);
1117 ts_name = gsm_ts_name(msg->lchan->ts);
1118
Harald Welte59b04682009-06-10 05:40:52 +08001119 switch (rslh->c.msg_type) {
1120 case RSL_MT_CHAN_ACTIV_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001121 DEBUGP(DRSL, "%s CHANNEL ACTIVATE ACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001122 rc = rsl_rx_chan_act_ack(msg);
1123 break;
1124 case RSL_MT_CHAN_ACTIV_NACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001125 DEBUGP(DRSL, "%s CHANNEL ACTIVATE NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001126 rc = rsl_rx_chan_act_nack(msg);
1127 break;
1128 case RSL_MT_CONN_FAIL:
1129 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:
1135 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 Welte (local)664b2222009-12-27 16:54:47 +01001213 LOGP(DRSL, LOGL_ERROR, "(bts=%u, trx=%u) CCCH/ACCH/CPU Overload\n",
1214 msg->trx->bts->nr, msg->trx->nr);
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 Welte (local)e16fdb02009-12-26 22:40:22 +01001384 LOGP(DRLL, LOGL_ERROR, "%s ERROR INDICATION cause=0x%02x\n",
1385 gsm_ts_name(msg->lchan->ts), rlm_cause[1]);
Harald Welteed9a5ab2009-08-09 13:47:35 +02001386
1387 rll_indication(msg->lchan, rllh->link_id, BSC_RLLR_IND_ERR_IND);
Harald Welte59b04682009-06-10 05:40:52 +08001388
Harald Welte692f5852009-07-04 09:40:05 +02001389 if (rlm_cause[1] == RLL_CAUSE_T200_EXPIRED)
Harald Welte85a163c2009-08-10 11:43:22 +02001390 return rsl_rf_chan_release(msg->lchan);
Harald Welte692f5852009-07-04 09:40:05 +02001391
Harald Welte59b04682009-06-10 05:40:52 +08001392 return 0;
1393}
1394
1395/* ESTABLISH INDICATION, LOCATION AREA UPDATE REQUEST
1396 0x02, 0x06,
1397 0x01, 0x20,
1398 0x02, 0x00,
1399 0x0b, 0x00, 0x0f, 0x05, 0x08, ... */
1400
1401static int abis_rsl_rx_rll(struct msgb *msg)
1402{
1403 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
1404 int rc = 0;
1405 char *ts_name;
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001406 u_int8_t sapi = rllh->link_id & 7;
Harald Welte59b04682009-06-10 05:40:52 +08001407
1408 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
1409 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Weltede4477a2009-12-24 12:20:20 +01001410 DEBUGP(DRLL, "%s SAPI=%u ", ts_name, sapi);
Harald Welte59b04682009-06-10 05:40:52 +08001411
1412 switch (rllh->c.msg_type) {
1413 case RSL_MT_DATA_IND:
1414 DEBUGPC(DRLL, "DATA INDICATION\n");
1415 if (msgb_l2len(msg) >
1416 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1417 rllh->data[0] == RSL_IE_L3_INFO) {
1418 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001419 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001420 }
1421 break;
1422 case RSL_MT_EST_IND:
1423 DEBUGPC(DRLL, "ESTABLISH INDICATION\n");
Harald Welte427dbc42009-08-10 00:26:10 +02001424 /* lchan is established, stop T3101 */
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001425 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_MS;
Harald Welte427dbc42009-08-10 00:26:10 +02001426 bsc_del_timer(&msg->lchan->T3101);
Harald Welte59b04682009-06-10 05:40:52 +08001427 if (msgb_l2len(msg) >
1428 sizeof(struct abis_rsl_common_hdr) + sizeof(*rllh) &&
1429 rllh->data[0] == RSL_IE_L3_INFO) {
1430 msg->l3h = &rllh->data[3];
Harald Welte (local)64994ce2009-08-14 11:41:12 +02001431 return gsm0408_rcvmsg(msg, rllh->link_id);
Harald Welte59b04682009-06-10 05:40:52 +08001432 }
1433 break;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001434 case RSL_MT_EST_CONF:
Harald Welte61402172009-08-09 14:13:58 +02001435 DEBUGPC(DRLL, "ESTABLISH CONFIRM\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001436 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_NET;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001437 rll_indication(msg->lchan, rllh->link_id,
1438 BSC_RLLR_IND_EST_CONF);
1439 break;
Harald Welte59b04682009-06-10 05:40:52 +08001440 case RSL_MT_REL_IND:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001441 /* BTS informs us of having received DISC from MS */
Harald Welteb6601442009-08-04 02:50:21 +02001442 DEBUGPC(DRLL, "RELEASE INDICATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001443 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welteed9a5ab2009-08-09 13:47:35 +02001444 rll_indication(msg->lchan, rllh->link_id,
1445 BSC_RLLR_IND_REL_IND);
Harald Welte0f2e3c12009-08-08 13:15:07 +02001446 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001447 /* FIXME: officially we need to start T3111 and wait for
1448 * some grace period */
1449 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001450 break;
1451 case RSL_MT_REL_CONF:
Harald Welte0f2e3c12009-08-08 13:15:07 +02001452 /* BTS informs us of having received UA from MS,
1453 * in response to DISC that we've sent earlier */
Harald Welteb6601442009-08-04 02:50:21 +02001454 DEBUGPC(DRLL, "RELEASE CONFIRMATION\n");
Holger Hans Peter Freytherd8318052009-10-28 14:23:39 +01001455 msg->lchan->sapis[rllh->link_id & 0x7] = LCHAN_SAPI_UNUSED;
Harald Welte0f2e3c12009-08-08 13:15:07 +02001456 /* we can now releae the channel on the BTS/Abis side */
Harald Welte85a163c2009-08-10 11:43:22 +02001457 /* FIXME: officially we need to start T3111 and wait for
1458 * some grace period */
1459 rsl_rf_chan_release(msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001460 break;
1461 case RSL_MT_ERROR_IND:
Harald Welte59b04682009-06-10 05:40:52 +08001462 rc = rsl_rx_rll_err_ind(msg);
1463 break;
1464 case RSL_MT_UNIT_DATA_IND:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001465 LOGP(DRLL, LOGL_NOTICE, "unimplemented Abis RLL message "
1466 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001467 break;
1468 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001469 LOGP(DRLL, LOGL_NOTICE, "unknown Abis RLL message "
1470 "type 0x%02x\n", rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001471 }
Harald Welte59b04682009-06-10 05:40:52 +08001472 return rc;
1473}
1474
Harald Welteb284b472009-12-02 01:58:23 +05301475static u_int8_t ipa_smod_s_for_lchan(struct gsm_lchan *lchan)
Harald Welte98d79f92009-07-28 18:11:56 +02001476{
Harald Welteb284b472009-12-02 01:58:23 +05301477 switch (lchan->tch_mode) {
Harald Welte98d79f92009-07-28 18:11:56 +02001478 case GSM48_CMODE_SPEECH_V1:
Harald Welteb284b472009-12-02 01:58:23 +05301479 switch (lchan->type) {
1480 case GSM_LCHAN_TCH_F:
1481 return 0x00;
1482 case GSM_LCHAN_TCH_H:
1483 return 0x03;
1484 default:
1485 break;
1486 }
Harald Welte98d79f92009-07-28 18:11:56 +02001487 case GSM48_CMODE_SPEECH_EFR:
Harald Welteb284b472009-12-02 01:58:23 +05301488 switch (lchan->type) {
1489 case GSM_LCHAN_TCH_F:
1490 return 0x01;
1491 /* there's no half-rate EFR */
1492 default:
1493 break;
1494 }
Harald Welte98d79f92009-07-28 18:11:56 +02001495 case GSM48_CMODE_SPEECH_AMR:
Harald Welteb284b472009-12-02 01:58:23 +05301496 switch (lchan->type) {
1497 case GSM_LCHAN_TCH_F:
1498 return 0x02;
1499 case GSM_LCHAN_TCH_H:
1500 return 0x05;
1501 default:
1502 break;
1503 }
1504 default:
1505 break;
Harald Welte98d79f92009-07-28 18:11:56 +02001506 }
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001507 LOGP(DRSL, LOGL_ERROR, "Cannot determine ip.access speech mode for "
Harald Welteb284b472009-12-02 01:58:23 +05301508 "tch_mode == 0x%02x\n", lchan->tch_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001509 return 0;
Harald Welte98d79f92009-07-28 18:11:56 +02001510}
1511
Harald Welte59b04682009-06-10 05:40:52 +08001512/* ip.access specific RSL extensions */
Harald Weltebffa4992009-12-19 16:42:06 +01001513static void ipac_parse_rtp(struct gsm_lchan *lchan, struct tlv_parsed *tv)
1514{
1515 struct in_addr ip;
1516 u_int16_t port, conn_id;
1517
1518 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_IP)) {
1519 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_IP));
1520 DEBUGPC(DRSL, "LOCAL_IP=%s ", inet_ntoa(ip));
1521 lchan->abis_ip.bound_ip = ntohl(ip.s_addr);
1522 }
1523
1524 if (TLVP_PRESENT(tv, RSL_IE_IPAC_LOCAL_PORT)) {
1525 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_LOCAL_PORT));
1526 port = ntohs(port);
1527 DEBUGPC(DRSL, "LOCAL_PORT=%u ", port);
1528 lchan->abis_ip.bound_port = port;
1529 }
1530
1531 if (TLVP_PRESENT(tv, RSL_IE_IPAC_CONN_ID)) {
1532 conn_id = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_CONN_ID));
1533 conn_id = ntohs(conn_id);
1534 DEBUGPC(DRSL, "CON_ID=%u ", conn_id);
1535 lchan->abis_ip.conn_id = conn_id;
1536 }
1537
1538 if (TLVP_PRESENT(tv, RSL_IE_IPAC_RTP_PAYLOAD2)) {
1539 lchan->abis_ip.rtp_payload2 =
1540 *TLVP_VAL(tv, RSL_IE_IPAC_RTP_PAYLOAD2);
1541 DEBUGPC(DRSL, "RTP_PAYLOAD2=0x%02x ",
1542 lchan->abis_ip.rtp_payload2);
1543 }
1544
1545 if (TLVP_PRESENT(tv, RSL_IE_IPAC_SPEECH_MODE)) {
1546 lchan->abis_ip.speech_mode =
1547 *TLVP_VAL(tv, RSL_IE_IPAC_SPEECH_MODE);
1548 DEBUGPC(DRSL, "speech_mode=0x%02x ",
1549 lchan->abis_ip.speech_mode);
1550 }
1551
1552 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_IP)) {
1553 ip.s_addr = *((u_int32_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_IP));
1554 DEBUGPC(DRSL, "REMOTE_IP=%s ", inet_ntoa(ip));
1555 lchan->abis_ip.connect_ip = ntohl(ip.s_addr);
1556 }
1557
1558 if (TLVP_PRESENT(tv, RSL_IE_IPAC_REMOTE_PORT)) {
1559 port = *((u_int16_t *) TLVP_VAL(tv, RSL_IE_IPAC_REMOTE_PORT));
1560 port = ntohs(port);
1561 DEBUGPC(DRSL, "REMOTE_PORT=%u ", port);
1562 lchan->abis_ip.connect_port = port;
1563 }
1564}
1565
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001566int rsl_ipacc_crcx(struct gsm_lchan *lchan)
Harald Welte59b04682009-06-10 05:40:52 +08001567{
1568 struct msgb *msg = rsl_msgb_alloc();
1569 struct abis_rsl_dchan_hdr *dh;
1570
1571 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001572 init_dchan_hdr(dh, RSL_MT_IPAC_CRCX);
Harald Welte59b04682009-06-10 05:40:52 +08001573 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1574 dh->chan_nr = lchan2chan_nr(lchan);
1575
Harald Welte98d79f92009-07-28 18:11:56 +02001576 /* 0x1- == receive-only, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001577 lchan->abis_ip.speech_mode = 0x10 | ipa_smod_s_for_lchan(lchan);
1578 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001579
Harald Weltede4477a2009-12-24 12:20:20 +01001580 DEBUGP(DRSL, "%s IPAC_BIND speech_mode=0x%02x\n",
1581 gsm_ts_name(lchan->ts), lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001582
Harald Welte59b04682009-06-10 05:40:52 +08001583 msg->trx = lchan->ts->trx;
1584
1585 return abis_rsl_sendmsg(msg);
1586}
1587
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001588int rsl_ipacc_mdcx(struct gsm_lchan *lchan, u_int32_t ip, u_int16_t port,
Harald Weltebffa4992009-12-19 16:42:06 +01001589 u_int8_t rtp_payload2)
Harald Welte59b04682009-06-10 05:40:52 +08001590{
1591 struct msgb *msg = rsl_msgb_alloc();
1592 struct abis_rsl_dchan_hdr *dh;
Harald Weltebffa4992009-12-19 16:42:06 +01001593 u_int32_t *att_ip;
Harald Welte98d79f92009-07-28 18:11:56 +02001594 struct in_addr ia;
Harald Welte59b04682009-06-10 05:40:52 +08001595
1596 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001597 init_dchan_hdr(dh, RSL_MT_IPAC_MDCX);
Harald Welte59b04682009-06-10 05:40:52 +08001598 dh->c.msg_discr = ABIS_RSL_MDISC_IPACCESS;
1599 dh->chan_nr = lchan2chan_nr(lchan);
1600
Harald Weltebffa4992009-12-19 16:42:06 +01001601 /* we need to store these now as MDCX_ACK does not return them :( */
1602 lchan->abis_ip.rtp_payload2 = rtp_payload2;
1603 lchan->abis_ip.connect_port = port;
1604 lchan->abis_ip.connect_ip = ip;
1605
Harald Weltefb4a9e92009-07-29 12:12:18 +02001606 /* 0x0- == both directions, 0x-1 == EFR codec */
Harald Weltebffa4992009-12-19 16:42:06 +01001607 lchan->abis_ip.speech_mode = 0x00 | ipa_smod_s_for_lchan(lchan);
Harald Weltefb4a9e92009-07-29 12:12:18 +02001608
Harald Welte98d79f92009-07-28 18:11:56 +02001609 ia.s_addr = htonl(ip);
Harald Weltede4477a2009-12-24 12:20:20 +01001610 DEBUGP(DRSL, "%s IPAC_MDCX IP=%s PORT=%d RTP_PAYLOAD2=%d CONN_ID=%d "
1611 "speech_mode=0x%02x\n", gsm_ts_name(lchan->ts), inet_ntoa(ia), port,
Harald Weltebffa4992009-12-19 16:42:06 +01001612 rtp_payload2, lchan->abis_ip.conn_id, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001613
Harald Weltebffa4992009-12-19 16:42:06 +01001614 msgb_tv16_put(msg, RSL_IE_IPAC_CONN_ID, lchan->abis_ip.conn_id);
1615 msgb_v_put(msg, RSL_IE_IPAC_REMOTE_IP);
1616 att_ip = (u_int32_t *) msgb_put(msg, sizeof(ip));
1617 *att_ip = ia.s_addr;
1618 msgb_tv16_put(msg, RSL_IE_IPAC_REMOTE_PORT, port);
1619 msgb_tv_put(msg, RSL_IE_IPAC_SPEECH_MODE, lchan->abis_ip.speech_mode);
Harald Welte98d79f92009-07-28 18:11:56 +02001620 if (rtp_payload2)
1621 msgb_tv_put(msg, RSL_IE_IPAC_RTP_PAYLOAD2, rtp_payload2);
1622
Harald Welte59b04682009-06-10 05:40:52 +08001623 msg->trx = lchan->ts->trx;
1624
1625 return abis_rsl_sendmsg(msg);
1626}
1627
Harald Welte9947d9f2009-12-20 16:51:09 +01001628/* tell BTS to connect RTP stream to our local RTP socket */
1629int rsl_ipacc_mdcx_to_rtpsock(struct gsm_lchan *lchan)
1630{
1631 struct rtp_socket *rs = lchan->abis_ip.rtp_socket;
1632 int rc;
1633
1634 rc = rsl_ipacc_mdcx(lchan, ntohl(rs->rtp.sin_local.sin_addr.s_addr),
1635 ntohs(rs->rtp.sin_local.sin_port),
1636 /* FIXME: use RTP payload of bound socket, not BTS*/
1637 lchan->abis_ip.rtp_payload2);
1638
1639 return rc;
1640}
1641
Harald Welteaed946e2009-10-24 10:29:22 +02001642int rsl_ipacc_pdch_activate(struct gsm_lchan *lchan)
1643{
1644 struct msgb *msg = rsl_msgb_alloc();
1645 struct abis_rsl_dchan_hdr *dh;
1646
1647 dh = (struct abis_rsl_dchan_hdr *) msgb_put(msg, sizeof(*dh));
1648 init_dchan_hdr(dh, RSL_MT_IPAC_PDCH_ACT);
1649 dh->c.msg_discr = ABIS_RSL_MDISC_DED_CHAN;
1650 dh->chan_nr = lchan2chan_nr(lchan);
1651
Harald Weltede4477a2009-12-24 12:20:20 +01001652 DEBUGP(DRSL, "%s IPAC_PDCH_ACT\n", gsm_ts_name(lchan->ts));
Harald Welteaed946e2009-10-24 10:29:22 +02001653
1654 msg->trx = lchan->ts->trx;
1655
1656 return abis_rsl_sendmsg(msg);
1657}
1658
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001659static int abis_rsl_rx_ipacc_crcx_ack(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001660{
1661 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1662 struct tlv_parsed tv;
Harald Welte87504212009-12-02 01:56:49 +05301663 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001664
1665 /* the BTS has acknowledged a local bind, it now tells us the IP
1666 * address and port number to which it has bound the given logical
1667 * channel */
1668
1669 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1670 if (!TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_PORT) ||
1671 !TLVP_PRESENT(&tv, RSL_IE_IPAC_LOCAL_IP) ||
Harald Welteb9498952009-07-12 09:45:05 +02001672 !TLVP_PRESENT(&tv, RSL_IE_IPAC_CONN_ID)) {
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001673 LOGP(DRSL, LOGL_NOTICE, "mandatory IE missing");
Harald Welte59b04682009-06-10 05:40:52 +08001674 return -EINVAL;
1675 }
Harald Welte50517742009-12-20 15:42:44 +01001676
Harald Weltebffa4992009-12-19 16:42:06 +01001677 ipac_parse_rtp(lchan, &tv);
Harald Welte50517742009-12-20 15:42:44 +01001678
1679 /* in case we don't use direct BTS-to-BTS RTP */
1680 if (!ipacc_rtp_direct) {
1681 int rc;
1682 /* the BTS has successfully bound a TCH to a local ip/port,
1683 * which means we can connect our UDP socket to it */
1684 if (lchan->abis_ip.rtp_socket) {
1685 rtp_socket_free(lchan->abis_ip.rtp_socket);
1686 lchan->abis_ip.rtp_socket = NULL;
1687 }
1688
1689 lchan->abis_ip.rtp_socket = rtp_socket_create();
1690 if (!lchan->abis_ip.rtp_socket)
1691 goto out_err;
1692
1693 rc = rtp_socket_connect(lchan->abis_ip.rtp_socket,
1694 lchan->abis_ip.bound_ip,
1695 lchan->abis_ip.bound_port);
1696 if (rc < 0)
1697 goto out_err;
1698 }
1699
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001700 dispatch_signal(SS_ABISIP, S_ABISIP_CRCX_ACK, msg->lchan);
Harald Welte59b04682009-06-10 05:40:52 +08001701
1702 return 0;
Harald Welte50517742009-12-20 15:42:44 +01001703out_err:
1704 return -EIO;
Harald Welte59b04682009-06-10 05:40:52 +08001705}
1706
Harald Weltebffa4992009-12-19 16:42:06 +01001707static int abis_rsl_rx_ipacc_mdcx_ack(struct msgb *msg)
1708{
1709 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1710 struct tlv_parsed tv;
1711 struct gsm_lchan *lchan = msg->lchan;
1712
1713 /* the BTS has acknowledged a remote connect request and
1714 * it now tells us the IP address and port number to which it has
1715 * connected the given logical channel */
1716
1717 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
1718 ipac_parse_rtp(lchan, &tv);
1719 dispatch_signal(SS_ABISIP, S_ABISIP_MDCX_ACK, msg->lchan);
1720
1721 return 0;
1722}
1723
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001724static int abis_rsl_rx_ipacc_dlcx_ind(struct msgb *msg)
Harald Welte59b04682009-06-10 05:40:52 +08001725{
1726 struct abis_rsl_dchan_hdr *dh = msgb_l2(msg);
1727 struct tlv_parsed tv;
Harald Welte50517742009-12-20 15:42:44 +01001728 struct gsm_lchan *lchan = msg->lchan;
Harald Welte59b04682009-06-10 05:40:52 +08001729
1730 rsl_tlv_parse(&tv, dh->data, msgb_l2len(msg)-sizeof(*dh));
Harald Welte59b04682009-06-10 05:40:52 +08001731
Harald Weltef1a168d2009-07-28 17:58:09 +02001732 if (TLVP_PRESENT(&tv, RSL_IE_CAUSE))
Harald Weltede4477a2009-12-24 12:20:20 +01001733 print_rsl_cause(LOGL_DEBUG, TLVP_VAL(&tv, RSL_IE_CAUSE),
Harald Weltef1a168d2009-07-28 17:58:09 +02001734 TLVP_LEN(&tv, RSL_IE_CAUSE));
Harald Welte59b04682009-06-10 05:40:52 +08001735
Harald Welte50517742009-12-20 15:42:44 +01001736 /* the BTS tells us a RTP stream has been disconnected */
1737 if (lchan->abis_ip.rtp_socket) {
1738 rtp_socket_free(lchan->abis_ip.rtp_socket);
1739 lchan->abis_ip.rtp_socket = NULL;
1740 }
1741
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001742 dispatch_signal(SS_ABISIP, S_ABISIP_DLCX_IND, msg->lchan);
Harald Welteba4e58d2009-07-28 18:02:05 +02001743
Harald Welte59b04682009-06-10 05:40:52 +08001744 return 0;
1745}
1746
1747static int abis_rsl_rx_ipacc(struct msgb *msg)
1748{
1749 struct abis_rsl_rll_hdr *rllh = msgb_l2(msg);
Harald Weltede4477a2009-12-24 12:20:20 +01001750 char *ts_name;
Harald Welte59b04682009-06-10 05:40:52 +08001751 int rc = 0;
1752
1753 msg->lchan = lchan_lookup(msg->trx, rllh->chan_nr);
Harald Weltede4477a2009-12-24 12:20:20 +01001754 ts_name = gsm_ts_name(msg->lchan->ts);
Harald Welte59b04682009-06-10 05:40:52 +08001755
1756 switch (rllh->c.msg_type) {
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001757 case RSL_MT_IPAC_CRCX_ACK:
Harald Weltede4477a2009-12-24 12:20:20 +01001758 DEBUGP(DRSL, "%s IPAC_CRCX_ACK ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001759 rc = abis_rsl_rx_ipacc_crcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001760 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001761 case RSL_MT_IPAC_CRCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001762 /* somehow the BTS was unable to bind the lchan to its local
1763 * port?!? */
Harald Weltede4477a2009-12-24 12:20:20 +01001764 LOGP(DRSL, LOGL_ERROR, "%s IPAC_CRCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001765 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001766 case RSL_MT_IPAC_MDCX_ACK:
Harald Welte59b04682009-06-10 05:40:52 +08001767 /* the BTS tells us that a connect operation was successful */
Harald Weltede4477a2009-12-24 12:20:20 +01001768 DEBUGP(DRSL, "%s IPAC_MDCX_ACK ", ts_name);
Harald Weltebffa4992009-12-19 16:42:06 +01001769 rc = abis_rsl_rx_ipacc_mdcx_ack(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001770 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001771 case RSL_MT_IPAC_MDCX_NACK:
Harald Welte59b04682009-06-10 05:40:52 +08001772 /* somehow the BTS was unable to connect the lchan to a remote
1773 * port */
Harald Weltede4477a2009-12-24 12:20:20 +01001774 LOGP(DRSL, LOGL_ERROR, "%s IPAC_MDCX_NACK\n", ts_name);
Harald Welte59b04682009-06-10 05:40:52 +08001775 break;
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001776 case RSL_MT_IPAC_DLCX_IND:
Harald Weltede4477a2009-12-24 12:20:20 +01001777 DEBUGP(DRSL, "%s IPAC_DLCX_IND ", ts_name);
Holger Hans Peter Freyther5ea7ea62009-11-18 21:06:12 +01001778 rc = abis_rsl_rx_ipacc_dlcx_ind(msg);
Harald Welte59b04682009-06-10 05:40:52 +08001779 break;
1780 default:
Harald Weltede4477a2009-12-24 12:20:20 +01001781 LOGP(DRSL, LOGL_NOTICE, "Unknown ip.access msg_type 0x%02x\n",
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001782 rllh->c.msg_type);
Harald Welte59b04682009-06-10 05:40:52 +08001783 break;
1784 }
1785 DEBUGPC(DRSL, "\n");
1786
1787 return rc;
1788}
1789
1790
1791/* Entry-point where L2 RSL from BTS enters */
1792int abis_rsl_rcvmsg(struct msgb *msg)
1793{
1794 struct abis_rsl_common_hdr *rslh = msgb_l2(msg) ;
1795 int rc = 0;
1796
1797 switch (rslh->msg_discr & 0xfe) {
1798 case ABIS_RSL_MDISC_RLL:
1799 rc = abis_rsl_rx_rll(msg);
1800 break;
1801 case ABIS_RSL_MDISC_DED_CHAN:
1802 rc = abis_rsl_rx_dchan(msg);
1803 break;
1804 case ABIS_RSL_MDISC_COM_CHAN:
1805 rc = abis_rsl_rx_cchan(msg);
1806 break;
1807 case ABIS_RSL_MDISC_TRX:
1808 rc = abis_rsl_rx_trx(msg);
1809 break;
1810 case ABIS_RSL_MDISC_LOC:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001811 LOGP(DRSL, LOGL_NOTICE, "unimplemented RSL msg disc 0x%02x\n",
Harald Welte59b04682009-06-10 05:40:52 +08001812 rslh->msg_discr);
1813 break;
1814 case ABIS_RSL_MDISC_IPACCESS:
1815 rc = abis_rsl_rx_ipacc(msg);
1816 break;
1817 default:
Harald Weltecf2ec4a2009-12-17 23:10:46 +01001818 LOGP(DRSL, LOGL_NOTICE, "unknown RSL message discriminator "
1819 "0x%02x\n", rslh->msg_discr);
Harald Welte59b04682009-06-10 05:40:52 +08001820 return -EINVAL;
1821 }
1822 msgb_free(msg);
1823 return rc;
1824}
1825
1826
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001827/* Section 3.3.2.3 TS 05.02. I think this looks like a table */
Harald Welte59b04682009-06-10 05:40:52 +08001828int rsl_ccch_conf_to_bs_cc_chans(int ccch_conf)
1829{
1830 switch (ccch_conf) {
1831 case RSL_BCCH_CCCH_CONF_1_NC:
1832 return 1;
1833 case RSL_BCCH_CCCH_CONF_1_C:
1834 return 1;
1835 case RSL_BCCH_CCCH_CONF_2_NC:
1836 return 2;
1837 case RSL_BCCH_CCCH_CONF_3_NC:
1838 return 3;
1839 case RSL_BCCH_CCCH_CONF_4_NC:
1840 return 4;
1841 default:
1842 return -1;
1843 }
1844}
1845
Holger Hans Peter Freyther4e0fdfd2009-07-09 20:43:16 +02001846/* Section 3.3.2.3 TS 05.02 */
Harald Welte59b04682009-06-10 05:40:52 +08001847int rsl_ccch_conf_to_bs_ccch_sdcch_comb(int ccch_conf)
1848{
1849 switch (ccch_conf) {
1850 case RSL_BCCH_CCCH_CONF_1_NC:
1851 return 0;
1852 case RSL_BCCH_CCCH_CONF_1_C:
1853 return 1;
1854 case RSL_BCCH_CCCH_CONF_2_NC:
1855 return 0;
1856 case RSL_BCCH_CCCH_CONF_3_NC:
1857 return 0;
1858 case RSL_BCCH_CCCH_CONF_4_NC:
1859 return 0;
1860 default:
1861 return -1;
1862 }
1863}
1864
1865/* From Table 10.5.33 of GSM 04.08 */
1866int rsl_number_of_paging_subchannels(struct gsm_bts *bts)
1867{
Harald Weltea54a2bb2009-12-01 18:04:30 +05301868 if (bts->si_common.chan_desc.ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
1869 return MAX(1, (3 - bts->si_common.chan_desc.bs_ag_blks_res))
1870 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001871 } else {
Harald Weltea54a2bb2009-12-01 18:04:30 +05301872 return (9 - bts->si_common.chan_desc.bs_ag_blks_res)
1873 * (bts->si_common.chan_desc.bs_pa_mfrms + 2);
Harald Welte59b04682009-06-10 05:40:52 +08001874 }
1875}