blob: 7c5e0e97a791869eb19e13bf68ebc93e06bde001 [file] [log] [blame]
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +02001/* GSM Mobile Radio Interface Layer 3 messages on the A-bis interface
2 * 3GPP TS 04.08 version 7.21.0 Release 1998 / ETSI TS 100 940 V7.21.0
3 * utility functions
4 */
5
6/* (C) 2008-2009 by Harald Welte <laforge@gnumonks.org>
7 * (C) 2008, 2009 by Holger Hans Peter Freyther <zecke@selfish.org>
8 *
9 * All Rights Reserved
10 *
11 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +010012 * it under the terms of the GNU Affero General Public License as published by
13 * the Free Software Foundation; either version 3 of the License, or
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020014 * (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010019 * GNU Affero General Public License for more details.
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020020 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010021 * You should have received a copy of the GNU Affero General Public License
22 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020023 *
24 */
25#include <stdio.h>
26#include <stdlib.h>
Holger Hans Peter Freytheradc14782009-08-21 04:57:35 +020027#include <errno.h>
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020028#include <netinet/in.h>
29
Pablo Neira Ayuso136f4532011-03-22 16:47:59 +010030#include <osmocom/core/msgb.h>
31#include <osmocom/gsm/gsm48.h>
Holger Hans Peter Freythere2fee352010-12-22 12:32:56 +010032
33#include <openbsc/abis_rsl.h>
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020034#include <openbsc/debug.h>
35#include <openbsc/gsm_04_08.h>
36#include <openbsc/transaction.h>
Holger Hans Peter Freyther3ee5d3e2009-08-21 05:18:21 +020037#include <openbsc/paging.h>
38#include <openbsc/signal.h>
Jacob Erlbeck24d3b912013-10-31 15:36:41 +010039#include <openbsc/bsc_api.h>
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020040
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020041/* should ip.access BTS use direct RTP streams between each other (1),
42 * or should OpenBSC always act as RTP relay/proxy in between (0) ? */
43int ipacc_rtp_direct = 1;
44
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080045static int gsm48_sendmsg(struct msgb *msg)
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020046{
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +080047 if (msg->lchan)
Pablo Neira Ayuso7abecfc2011-08-17 22:43:54 +020048 msg->dst = msg->lchan->ts->trx->rsl_link;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020049
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020050 msg->l3h = msg->data;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020051 return rsl_data_request(msg, 0);
52}
53
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020054/* Section 9.1.8 / Table 9.9 */
55struct chreq {
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +020056 uint8_t val;
57 uint8_t mask;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020058 enum chreq_type type;
59};
60
61/* If SYSTEM INFORMATION TYPE 4 NECI bit == 1 */
62static const struct chreq chreq_type_neci1[] = {
63 { 0xa0, 0xe0, CHREQ_T_EMERG_CALL },
64 { 0xc0, 0xe0, CHREQ_T_CALL_REEST_TCH_F },
65 { 0x68, 0xfc, CHREQ_T_CALL_REEST_TCH_H },
66 { 0x6c, 0xfc, CHREQ_T_CALL_REEST_TCH_H_DBL },
Sylvain Munautcfcf7e82010-12-27 00:59:23 +010067 { 0xe0, 0xe0, CHREQ_T_TCH_F },
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020068 { 0x40, 0xf0, CHREQ_T_VOICE_CALL_TCH_H },
69 { 0x50, 0xf0, CHREQ_T_DATA_CALL_TCH_H },
70 { 0x00, 0xf0, CHREQ_T_LOCATION_UPD },
71 { 0x10, 0xf0, CHREQ_T_SDCCH },
Holger Hans Peter Freyther135a7c62009-11-17 16:46:46 +010072 { 0x80, 0xe0, CHREQ_T_PAG_R_ANY_NECI1 },
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020073 { 0x20, 0xf0, CHREQ_T_PAG_R_TCH_F },
74 { 0x30, 0xf0, CHREQ_T_PAG_R_TCH_FH },
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +010075 { 0x67, 0xff, CHREQ_T_LMU },
76 { 0x60, 0xf9, CHREQ_T_RESERVED_SDCCH },
77 { 0x61, 0xfb, CHREQ_T_RESERVED_SDCCH },
Alexander Couzens11368112016-11-28 23:26:50 +010078 { 0x63, 0xff, CHREQ_T_RESERVED_SDCCH },
79 { 0x70, 0xf8, CHREQ_T_PDCH_TWO_PHASE },
80 { 0x78, 0xfc, CHREQ_T_PDCH_ONE_PHASE },
81 { 0x78, 0xfa, CHREQ_T_PDCH_ONE_PHASE },
82 { 0x78, 0xf9, CHREQ_T_PDCH_ONE_PHASE },
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +010083 { 0x7f, 0xff, CHREQ_T_RESERVED_IGNORE },
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020084};
85
86/* If SYSTEM INFORMATION TYPE 4 NECI bit == 0 */
87static const struct chreq chreq_type_neci0[] = {
88 { 0xa0, 0xe0, CHREQ_T_EMERG_CALL },
89 { 0xc0, 0xe0, CHREQ_T_CALL_REEST_TCH_H },
90 { 0xe0, 0xe0, CHREQ_T_TCH_F },
91 { 0x50, 0xf0, CHREQ_T_DATA_CALL_TCH_H },
92 { 0x00, 0xe0, CHREQ_T_LOCATION_UPD },
Holger Hans Peter Freyther135a7c62009-11-17 16:46:46 +010093 { 0x80, 0xe0, CHREQ_T_PAG_R_ANY_NECI0 },
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +020094 { 0x20, 0xf0, CHREQ_T_PAG_R_TCH_F },
95 { 0x30, 0xf0, CHREQ_T_PAG_R_TCH_FH },
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +010096 { 0x67, 0xff, CHREQ_T_LMU },
97 { 0x60, 0xf9, CHREQ_T_RESERVED_SDCCH },
98 { 0x61, 0xfb, CHREQ_T_RESERVED_SDCCH },
Alexander Couzens11368112016-11-28 23:26:50 +010099 { 0x63, 0xff, CHREQ_T_RESERVED_SDCCH },
100 { 0x70, 0xf8, CHREQ_T_PDCH_TWO_PHASE },
101 { 0x78, 0xfc, CHREQ_T_PDCH_ONE_PHASE },
102 { 0x78, 0xfa, CHREQ_T_PDCH_ONE_PHASE },
103 { 0x78, 0xf9, CHREQ_T_PDCH_ONE_PHASE },
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +0100104 { 0x7f, 0xff, CHREQ_T_RESERVED_IGNORE },
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200105};
106
107static const enum gsm_chan_t ctype_by_chreq[] = {
108 [CHREQ_T_EMERG_CALL] = GSM_LCHAN_TCH_F,
109 [CHREQ_T_CALL_REEST_TCH_F] = GSM_LCHAN_TCH_F,
110 [CHREQ_T_CALL_REEST_TCH_H] = GSM_LCHAN_TCH_H,
111 [CHREQ_T_CALL_REEST_TCH_H_DBL] = GSM_LCHAN_TCH_H,
112 [CHREQ_T_SDCCH] = GSM_LCHAN_SDCCH,
113 [CHREQ_T_TCH_F] = GSM_LCHAN_TCH_F,
114 [CHREQ_T_VOICE_CALL_TCH_H] = GSM_LCHAN_TCH_H,
115 [CHREQ_T_DATA_CALL_TCH_H] = GSM_LCHAN_TCH_H,
116 [CHREQ_T_LOCATION_UPD] = GSM_LCHAN_SDCCH,
Holger Hans Peter Freyther135a7c62009-11-17 16:46:46 +0100117 [CHREQ_T_PAG_R_ANY_NECI1] = GSM_LCHAN_SDCCH,
118 [CHREQ_T_PAG_R_ANY_NECI0] = GSM_LCHAN_SDCCH,
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200119 [CHREQ_T_PAG_R_TCH_F] = GSM_LCHAN_TCH_F,
120 [CHREQ_T_PAG_R_TCH_FH] = GSM_LCHAN_TCH_F,
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +0100121 [CHREQ_T_LMU] = GSM_LCHAN_SDCCH,
122 [CHREQ_T_RESERVED_SDCCH] = GSM_LCHAN_SDCCH,
Alexander Couzens11368112016-11-28 23:26:50 +0100123 [CHREQ_T_PDCH_ONE_PHASE] = GSM_LCHAN_PDTCH,
124 [CHREQ_T_PDCH_TWO_PHASE] = GSM_LCHAN_PDTCH,
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +0100125 [CHREQ_T_RESERVED_IGNORE] = GSM_LCHAN_UNKNOWN,
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200126};
127
128static const enum gsm_chreq_reason_t reason_by_chreq[] = {
129 [CHREQ_T_EMERG_CALL] = GSM_CHREQ_REASON_EMERG,
130 [CHREQ_T_CALL_REEST_TCH_F] = GSM_CHREQ_REASON_CALL,
131 [CHREQ_T_CALL_REEST_TCH_H] = GSM_CHREQ_REASON_CALL,
132 [CHREQ_T_CALL_REEST_TCH_H_DBL] = GSM_CHREQ_REASON_CALL,
133 [CHREQ_T_SDCCH] = GSM_CHREQ_REASON_OTHER,
134 [CHREQ_T_TCH_F] = GSM_CHREQ_REASON_OTHER,
Harald Welte9385c112009-12-12 20:57:52 +0100135 [CHREQ_T_VOICE_CALL_TCH_H] = GSM_CHREQ_REASON_CALL,
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200136 [CHREQ_T_DATA_CALL_TCH_H] = GSM_CHREQ_REASON_OTHER,
137 [CHREQ_T_LOCATION_UPD] = GSM_CHREQ_REASON_LOCATION_UPD,
Holger Hans Peter Freyther135a7c62009-11-17 16:46:46 +0100138 [CHREQ_T_PAG_R_ANY_NECI1] = GSM_CHREQ_REASON_PAG,
139 [CHREQ_T_PAG_R_ANY_NECI0] = GSM_CHREQ_REASON_PAG,
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200140 [CHREQ_T_PAG_R_TCH_F] = GSM_CHREQ_REASON_PAG,
141 [CHREQ_T_PAG_R_TCH_FH] = GSM_CHREQ_REASON_PAG,
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +0100142 [CHREQ_T_LMU] = GSM_CHREQ_REASON_OTHER,
Alexander Couzens11368112016-11-28 23:26:50 +0100143 [CHREQ_T_PDCH_ONE_PHASE] = GSM_CHREQ_REASON_PDCH,
144 [CHREQ_T_PDCH_TWO_PHASE] = GSM_CHREQ_REASON_PDCH,
Holger Hans Peter Freytherd61654c2009-11-21 20:20:43 +0100145 [CHREQ_T_RESERVED_SDCCH] = GSM_CHREQ_REASON_OTHER,
146 [CHREQ_T_RESERVED_IGNORE] = GSM_CHREQ_REASON_OTHER,
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200147};
148
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +0800149/* verify that the two tables match */
Pablo Neira Ayusoc0d17f22011-05-07 12:12:48 +0200150osmo_static_assert(sizeof(ctype_by_chreq) ==
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +0800151 sizeof(((struct gsm_network *) NULL)->ctype_by_chreq), assert_size);
152
153/*
154 * Update channel types for request based on policy. E.g. in the
155 * case of a TCH/H network/bsc use TCH/H for the emergency calls,
156 * for early assignment assign a SDCCH and some other options.
157 */
158void gsm_net_update_ctype(struct gsm_network *network)
159{
160 /* copy over the data */
161 memcpy(network->ctype_by_chreq, ctype_by_chreq, sizeof(ctype_by_chreq));
162
163 /*
164 * Use TCH/H for emergency calls when this cell allows TCH/H. Maybe it
165 * is better to iterate over the BTS/TRX and check if no TCH/F is available
166 * and then set it to TCH/H.
167 */
168 if (network->neci)
169 network->ctype_by_chreq[CHREQ_T_EMERG_CALL] = GSM_LCHAN_TCH_H;
Holger Hans Peter Freyther76fc4a32010-09-06 09:41:50 +0800170
171 if (network->pag_any_tch) {
172 if (network->neci) {
173 network->ctype_by_chreq[CHREQ_T_PAG_R_ANY_NECI0] = GSM_LCHAN_TCH_H;
174 network->ctype_by_chreq[CHREQ_T_PAG_R_ANY_NECI1] = GSM_LCHAN_TCH_H;
175 } else {
176 network->ctype_by_chreq[CHREQ_T_PAG_R_ANY_NECI0] = GSM_LCHAN_TCH_F;
177 network->ctype_by_chreq[CHREQ_T_PAG_R_ANY_NECI1] = GSM_LCHAN_TCH_F;
178 }
179 }
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +0800180}
181
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200182enum gsm_chan_t get_ctype_by_chreq(struct gsm_network *network, uint8_t ra)
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200183{
184 int i;
Holger Hans Peter Freyther843b44d2009-11-17 16:38:25 +0100185 int length;
186 const struct chreq *chreq;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200187
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +0800188 if (network->neci) {
Holger Hans Peter Freyther843b44d2009-11-17 16:38:25 +0100189 chreq = chreq_type_neci1;
190 length = ARRAY_SIZE(chreq_type_neci1);
191 } else {
192 chreq = chreq_type_neci0;
193 length = ARRAY_SIZE(chreq_type_neci0);
194 }
195
196
197 for (i = 0; i < length; i++) {
198 const struct chreq *chr = &chreq[i];
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200199 if ((ra & chr->mask) == chr->val)
Holger Hans Peter Freyther78891072010-09-06 09:36:02 +0800200 return network->ctype_by_chreq[chr->type];
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200201 }
Harald Welte50720e72009-12-24 11:50:20 +0100202 LOGP(DRR, LOGL_ERROR, "Unknown CHANNEL REQUEST RQD 0x%02x\n", ra);
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200203 return GSM_LCHAN_SDCCH;
204}
205
Harald Welteb2268642011-07-23 10:53:30 +0200206int get_reason_by_chreq(uint8_t ra, int neci)
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200207{
208 int i;
Holger Hans Peter Freyther843b44d2009-11-17 16:38:25 +0100209 int length;
210 const struct chreq *chreq;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200211
Holger Hans Peter Freyther843b44d2009-11-17 16:38:25 +0100212 if (neci) {
213 chreq = chreq_type_neci1;
214 length = ARRAY_SIZE(chreq_type_neci1);
215 } else {
216 chreq = chreq_type_neci0;
217 length = ARRAY_SIZE(chreq_type_neci0);
218 }
219
220 for (i = 0; i < length; i++) {
221 const struct chreq *chr = &chreq[i];
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200222 if ((ra & chr->mask) == chr->val)
223 return reason_by_chreq[chr->type];
224 }
Harald Welte50720e72009-12-24 11:50:20 +0100225 LOGP(DRR, LOGL_ERROR, "Unknown CHANNEL REQUEST REASON 0x%02x\n", ra);
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200226 return GSM_CHREQ_REASON_OTHER;
227}
228
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200229static void mr_config_for_ms(struct gsm_lchan *lchan, struct msgb *msg)
230{
231 if (lchan->tch_mode == GSM48_CMODE_SPEECH_AMR)
232 msgb_tlv_put(msg, GSM48_IE_MUL_RATE_CFG, lchan->mr_ms_lv[0],
233 lchan->mr_ms_lv + 1);
234}
235
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200236/* 7.1.7 and 9.1.7: RR CHANnel RELease */
237int gsm48_send_rr_release(struct gsm_lchan *lchan)
238{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100239 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 RR REL");
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200240 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200241 uint8_t *cause;
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200242
243 msg->lchan = lchan;
244 gh->proto_discr = GSM48_PDISC_RR;
245 gh->msg_type = GSM48_MT_RR_CHAN_REL;
246
247 cause = msgb_put(msg, 1);
248 cause[0] = GSM48_RR_CAUSE_NORMAL;
249
250 DEBUGP(DRR, "Sending Channel Release: Chan: Number: %d Type: %d\n",
251 lchan->nr, lchan->type);
252
253 /* Send actual release request to MS */
Holger Hans Peter Freytherb3489392011-12-28 16:21:05 +0100254 return gsm48_sendmsg(msg);
Holger Hans Peter Freyther1494a762009-08-01 07:26:59 +0200255}
256
Holger Hans Peter Freytheradc14782009-08-21 04:57:35 +0200257int send_siemens_mrpci(struct gsm_lchan *lchan,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200258 uint8_t *classmark2_lv)
Holger Hans Peter Freytheradc14782009-08-21 04:57:35 +0200259{
260 struct rsl_mrpci mrpci;
261
262 if (classmark2_lv[0] < 2)
263 return -EINVAL;
264
265 mrpci.power_class = classmark2_lv[1] & 0x7;
266 mrpci.vgcs_capable = classmark2_lv[2] & (1 << 1);
267 mrpci.vbs_capable = classmark2_lv[2] & (1 <<2);
268 mrpci.gsm_phase = (classmark2_lv[1]) >> 5 & 0x3;
269
270 return rsl_siemens_mrpci(lchan, &mrpci);
271}
272
Holger Hans Peter Freytherea4088a2009-10-05 13:25:06 +0200273/* Chapter 9.1.9: Ciphering Mode Command */
Holger Hans Peter Freytherca6bc1d2009-10-05 14:00:14 +0200274int gsm48_send_rr_ciph_mode(struct gsm_lchan *lchan, int want_imeisv)
Holger Hans Peter Freytherea4088a2009-10-05 13:25:06 +0200275{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100276 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CIPH");
Holger Hans Peter Freytherea4088a2009-10-05 13:25:06 +0200277 struct gsm48_hdr *gh;
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200278 uint8_t ciph_mod_set;
Holger Hans Peter Freytherea4088a2009-10-05 13:25:06 +0200279
280 msg->lchan = lchan;
281
282 DEBUGP(DRR, "TX CIPHERING MODE CMD\n");
283
284 if (lchan->encr.alg_id <= RSL_ENC_ALG_A5(0))
285 ciph_mod_set = 0;
286 else
287 ciph_mod_set = (lchan->encr.alg_id-2)<<1 | 1;
288
289 gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh) + 1);
290 gh->proto_discr = GSM48_PDISC_RR;
291 gh->msg_type = GSM48_MT_RR_CIPH_M_CMD;
Holger Hans Peter Freytherca6bc1d2009-10-05 14:00:14 +0200292 gh->data[0] = (want_imeisv & 0x1) << 4 | (ciph_mod_set & 0xf);
Holger Hans Peter Freytherea4088a2009-10-05 13:25:06 +0200293
294 return rsl_encryption_cmd(msg);
295}
296
Harald Welte8c83af62009-11-29 20:02:53 +0100297static void gsm48_cell_desc(struct gsm48_cell_desc *cd,
298 const struct gsm_bts *bts)
299{
300 cd->ncc = (bts->bsic >> 3 & 0x7);
301 cd->bcc = (bts->bsic & 0x7);
302 cd->arfcn_hi = bts->c0->arfcn >> 8;
303 cd->arfcn_lo = bts->c0->arfcn & 0xff;
304}
305
Harald Weltea39b0f22010-06-14 22:26:10 +0200306void gsm48_lchan2chan_desc(struct gsm48_chan_desc *cd,
307 const struct gsm_lchan *lchan)
Harald Welte8c83af62009-11-29 20:02:53 +0100308{
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200309 uint16_t arfcn = lchan->ts->trx->arfcn & 0x3ff;
Harald Welte8c83af62009-11-29 20:02:53 +0100310
Harald Weltef6093a42011-06-25 10:02:33 +0200311 cd->chan_nr = gsm_lchan2chan_nr(lchan);
Harald Weltea39b0f22010-06-14 22:26:10 +0200312 if (!lchan->ts->hopping.enabled) {
Harald Welte1fe24122014-01-19 17:18:21 +0100313 cd->h0.tsc = gsm_ts_tsc(lchan->ts);
Harald Weltea39b0f22010-06-14 22:26:10 +0200314 cd->h0.h = 0;
315 cd->h0.arfcn_high = arfcn >> 8;
316 cd->h0.arfcn_low = arfcn & 0xff;
317 } else {
Harald Welte1fe24122014-01-19 17:18:21 +0100318 cd->h1.tsc = gsm_ts_tsc(lchan->ts);
Harald Weltea39b0f22010-06-14 22:26:10 +0200319 cd->h1.h = 1;
320 cd->h1.maio_high = lchan->ts->hopping.maio >> 2;
321 cd->h1.maio_low = lchan->ts->hopping.maio & 0x03;
322 cd->h1.hsn = lchan->ts->hopping.hsn;
323 }
Harald Welte8c83af62009-11-29 20:02:53 +0100324}
325
Harald Welte0de69a22017-05-27 13:18:50 +0200326/*! \brief Encode a TS 04.08 multirate config LV according to 10.5.2.21aa
327 * \param[out] lv caller-allocated buffer of 7 bytes. First octet is IS length
328 * \param[in] mr multi-rate configuration to encode
329 * \param[in] modes array describing the AMR modes
330 * \returns 0 on success */
331int gsm48_multirate_config(uint8_t *lv, const struct amr_multirate_conf *mr, const struct amr_mode *modes)
Andreas Eversberg73266522014-01-19 11:47:44 +0100332{
333 int num = 0, i;
334
335 for (i = 0; i < 8; i++) {
336 if (((mr->gsm48_ie[1] >> i) & 1))
337 num++;
338 }
339 if (num > 4) {
340 LOGP(DRR, LOGL_ERROR, "BUG: Using multirate codec with too "
341 "many modes in config.\n");
342 num = 4;
343 }
344 if (num < 1) {
345 LOGP(DRR, LOGL_ERROR, "BUG: Using multirate codec with no "
346 "mode in config.\n");
347 num = 1;
348 }
349
350 lv[0] = (num == 1) ? 2 : (num + 2);
351 memcpy(lv + 1, mr->gsm48_ie, 2);
352 if (num == 1)
353 return 0;
Holger Hans Peter Freyther615ed462015-09-24 11:30:58 +0200354
355 lv[3] = modes[0].threshold & 0x3f;
356 lv[4] = modes[0].hysteresis << 4;
357 if (num == 2)
358 return 0;
359 lv[4] |= (modes[1].threshold & 0x3f) >> 2;
360 lv[5] = modes[1].threshold << 6;
361 lv[5] |= (modes[1].hysteresis & 0x0f) << 2;
362 if (num == 3)
363 return 0;
364 lv[5] |= (modes[2].threshold & 0x3f) >> 4;
365 lv[6] = modes[2].threshold << 4;
366 lv[6] |= modes[2].hysteresis & 0x0f;
Andreas Eversberg73266522014-01-19 11:47:44 +0100367
368 return 0;
369}
370
Harald Welte29aca172010-06-15 16:45:51 +0200371#define GSM48_HOCMD_CCHDESC_LEN 16
372
Harald Welte8c83af62009-11-29 20:02:53 +0100373/* Chapter 9.1.15: Handover Command */
Harald Welte7a7a0d52009-12-17 00:25:18 +0100374int gsm48_send_ho_cmd(struct gsm_lchan *old_lchan, struct gsm_lchan *new_lchan,
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200375 uint8_t power_command, uint8_t ho_ref)
Harald Welte8c83af62009-11-29 20:02:53 +0100376{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100377 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 HO CMD");
Harald Welte8c83af62009-11-29 20:02:53 +0100378 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
379 struct gsm48_ho_cmd *ho =
380 (struct gsm48_ho_cmd *) msgb_put(msg, sizeof(*ho));
Harald Welte8c83af62009-11-29 20:02:53 +0100381
382 msg->lchan = old_lchan;
Harald Welte7a7a0d52009-12-17 00:25:18 +0100383 gh->proto_discr = GSM48_PDISC_RR;
384 gh->msg_type = GSM48_MT_RR_HANDO_CMD;
Harald Welte8c83af62009-11-29 20:02:53 +0100385
386 /* mandatory bits */
387 gsm48_cell_desc(&ho->cell_desc, new_lchan->ts->trx->bts);
Harald Weltea39b0f22010-06-14 22:26:10 +0200388 gsm48_lchan2chan_desc(&ho->chan_desc, new_lchan);
Harald Welte7a7a0d52009-12-17 00:25:18 +0100389 ho->ho_ref = ho_ref;
Harald Welte8c83af62009-11-29 20:02:53 +0100390 ho->power_command = power_command;
391
Harald Welte29aca172010-06-15 16:45:51 +0200392 if (new_lchan->ts->hopping.enabled) {
393 struct gsm_bts *bts = new_lchan->ts->trx->bts;
394 struct gsm48_system_information_type_1 *si1;
395 uint8_t *cur;
396
397 si1 = GSM_BTS_SI(bts, SYSINFO_TYPE_1);
398 /* Copy the Cell Chan Desc (ARFCNS in this cell) */
399 msgb_put_u8(msg, GSM48_IE_CELL_CH_DESC);
400 cur = msgb_put(msg, GSM48_HOCMD_CCHDESC_LEN);
401 memcpy(cur, si1->cell_channel_description,
402 GSM48_HOCMD_CCHDESC_LEN);
403 /* Copy the Mobile Allocation */
404 msgb_tlv_put(msg, GSM48_IE_MA_BEFORE,
405 new_lchan->ts->hopping.ma_len,
406 new_lchan->ts->hopping.ma_data);
407 }
Harald Welte8c83af62009-11-29 20:02:53 +0100408 /* FIXME: optional bits for type of synchronization? */
409
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800410 return gsm48_sendmsg(msg);
Harald Welte8c83af62009-11-29 20:02:53 +0100411}
412
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200413/* Chapter 9.1.2: Assignment Command */
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200414int gsm48_send_rr_ass_cmd(struct gsm_lchan *dest_lchan, struct gsm_lchan *lchan, uint8_t power_command)
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200415{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100416 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 ASS CMD");
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200417 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
418 struct gsm48_ass_cmd *ass =
419 (struct gsm48_ass_cmd *) msgb_put(msg, sizeof(*ass));
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200420
421 DEBUGP(DRR, "-> ASSIGNMENT COMMAND tch_mode=0x%02x\n", lchan->tch_mode);
422
Holger Hans Peter Freyther550197f2010-01-28 09:43:49 +0100423 msg->lchan = dest_lchan;
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200424 gh->proto_discr = GSM48_PDISC_RR;
425 gh->msg_type = GSM48_MT_RR_ASS_CMD;
426
427 /*
428 * fill the channel information element, this code
429 * should probably be shared with rsl_rx_chan_rqd(),
Max7a301d32016-04-07 11:38:52 +0200430 * gsm48_lchan_modify(). But beware that 10.5.2.5
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200431 * 10.5.2.5.a have slightly different semantic for
432 * the chan_desc. But as long as multi-slot configurations
433 * are not used we seem to be fine.
434 */
Harald Weltea39b0f22010-06-14 22:26:10 +0200435 gsm48_lchan2chan_desc(&ass->chan_desc, lchan);
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200436 ass->power_command = power_command;
437
Harald Welte29aca172010-06-15 16:45:51 +0200438 /* optional: cell channel description */
439
Holger Hans Peter Freyther1b891fd2010-01-28 11:51:24 +0100440 msgb_tv_put(msg, GSM48_IE_CHANMODE_1, lchan->tch_mode);
441
Harald Welte29aca172010-06-15 16:45:51 +0200442 /* mobile allocation in case of hopping */
443 if (lchan->ts->hopping.enabled) {
444 msgb_tlv_put(msg, GSM48_IE_MA_BEFORE, lchan->ts->hopping.ma_len,
445 lchan->ts->hopping.ma_data);
446 }
447
Holger Hans Peter Freythera6bcc742009-11-16 22:49:24 +0100448 /* in case of multi rate we need to attach a config */
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200449 mr_config_for_ms(lchan, msg);
Holger Hans Peter Freythera6bcc742009-11-16 22:49:24 +0100450
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800451 return gsm48_sendmsg(msg);
Holger Hans Peter Freythere81a6102009-10-22 11:47:45 +0200452}
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200453
454/* 9.1.5 Channel mode modify: Modify the mode on the MS side */
Max7a301d32016-04-07 11:38:52 +0200455int gsm48_lchan_modify(struct gsm_lchan *lchan, uint8_t mode)
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200456{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100457 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 CHN MOD");
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200458 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
459 struct gsm48_chan_mode_modify *cmm =
460 (struct gsm48_chan_mode_modify *) msgb_put(msg, sizeof(*cmm));
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200461
462 DEBUGP(DRR, "-> CHANNEL MODE MODIFY mode=0x%02x\n", mode);
463
464 lchan->tch_mode = mode;
465 msg->lchan = lchan;
466 gh->proto_discr = GSM48_PDISC_RR;
467 gh->msg_type = GSM48_MT_RR_CHAN_MODE_MODIF;
468
469 /* fill the channel information element, this code
470 * should probably be shared with rsl_rx_chan_rqd() */
Harald Weltea39b0f22010-06-14 22:26:10 +0200471 gsm48_lchan2chan_desc(&cmm->chan_desc, lchan);
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200472 cmm->mode = mode;
473
Holger Hans Peter Freythera6bcc742009-11-16 22:49:24 +0100474 /* in case of multi rate we need to attach a config */
Holger Hans Peter Freyther11cb7a92015-08-20 19:32:46 +0200475 mr_config_for_ms(lchan, msg);
Holger Hans Peter Freythera6bcc742009-11-16 22:49:24 +0100476
Holger Hans Peter Freyther9c137a72010-06-15 13:57:40 +0800477 return gsm48_sendmsg(msg);
Holger Hans Peter Freytherff3f2602009-10-22 15:13:00 +0200478}
479
Holger Hans Peter Freytherf520e642009-10-22 15:23:11 +0200480int gsm48_rx_rr_modif_ack(struct msgb *msg)
481{
Holger Hans Peter Freyther25b1e252009-11-18 19:30:24 +0100482 int rc;
Holger Hans Peter Freytherf520e642009-10-22 15:23:11 +0200483 struct gsm48_hdr *gh = msgb_l3(msg);
484 struct gsm48_chan_mode_modify *mod =
485 (struct gsm48_chan_mode_modify *) gh->data;
486
487 DEBUGP(DRR, "CHANNEL MODE MODIFY ACK\n");
488
489 if (mod->mode != msg->lchan->tch_mode) {
Harald Welte50720e72009-12-24 11:50:20 +0100490 LOGP(DRR, LOGL_ERROR, "CHANNEL MODE change failed. Wanted: %d Got: %d\n",
Holger Hans Peter Freytherf520e642009-10-22 15:23:11 +0200491 msg->lchan->tch_mode, mod->mode);
492 return -1;
493 }
494
495 /* update the channel type */
496 switch (mod->mode) {
497 case GSM48_CMODE_SIGN:
498 msg->lchan->rsl_cmode = RSL_CMOD_SPD_SIGN;
499 break;
500 case GSM48_CMODE_SPEECH_V1:
501 case GSM48_CMODE_SPEECH_EFR:
502 case GSM48_CMODE_SPEECH_AMR:
503 msg->lchan->rsl_cmode = RSL_CMOD_SPD_SPEECH;
504 break;
505 case GSM48_CMODE_DATA_14k5:
506 case GSM48_CMODE_DATA_12k0:
507 case GSM48_CMODE_DATA_6k0:
508 case GSM48_CMODE_DATA_3k6:
509 msg->lchan->rsl_cmode = RSL_CMOD_SPD_DATA;
510 break;
511 }
512
513 /* We've successfully modified the MS side of the channel,
514 * now go on to modify the BTS side of the channel */
Holger Hans Peter Freyther25b1e252009-11-18 19:30:24 +0100515 rc = rsl_chan_mode_modify_req(msg->lchan);
516
517 /* FIXME: we not only need to do this after mode modify, but
518 * also after channel activation */
519 if (is_ipaccess_bts(msg->lchan->ts->trx->bts) && mod->mode != GSM48_CMODE_SIGN)
520 rsl_ipacc_crcx(msg->lchan);
521 return rc;
Holger Hans Peter Freytherf520e642009-10-22 15:23:11 +0200522}
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100523
524int gsm48_parse_meas_rep(struct gsm_meas_rep *rep, struct msgb *msg)
525{
526 struct gsm48_hdr *gh = msgb_l3(msg);
Holger Hans Peter Freytherc42ad8b2011-04-18 17:04:00 +0200527 uint8_t *data = gh->data;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100528 struct gsm_bts *bts = msg->lchan->ts->trx->bts;
529 struct bitvec *nbv = &bts->si_common.neigh_list;
Harald Weltea06c35e2009-12-25 22:46:25 +0100530 struct gsm_meas_rep_cell *mrc;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100531
532 if (gh->msg_type != GSM48_MT_RR_MEAS_REP)
533 return -EINVAL;
534
535 if (data[0] & 0x80)
536 rep->flags |= MEAS_REP_F_BA1;
537 if (data[0] & 0x40)
538 rep->flags |= MEAS_REP_F_UL_DTX;
539 if ((data[1] & 0x40) == 0x00)
540 rep->flags |= MEAS_REP_F_DL_VALID;
541
542 rep->dl.full.rx_lev = data[0] & 0x3f;
543 rep->dl.sub.rx_lev = data[1] & 0x3f;
Sylvain Munaut48ea4e82012-12-25 13:06:27 +0100544 rep->dl.full.rx_qual = (data[2] >> 4) & 0x7;
545 rep->dl.sub.rx_qual = (data[2] >> 1) & 0x7;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100546
547 rep->num_cell = ((data[3] >> 6) & 0x3) | ((data[2] & 0x01) << 2);
548 if (rep->num_cell < 1 || rep->num_cell > 6)
549 return 0;
550
551 /* an encoding nightmare in perfection */
Harald Weltea06c35e2009-12-25 22:46:25 +0100552 mrc = &rep->cell[0];
553 mrc->rxlev = data[3] & 0x3f;
Harald Welte950eca92009-12-25 22:49:34 +0100554 mrc->neigh_idx = data[4] >> 3;
Harald Welteeaa95d52009-12-25 23:01:54 +0100555 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Weltea06c35e2009-12-25 22:46:25 +0100556 mrc->bsic = ((data[4] & 0x07) << 3) | (data[5] >> 5);
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100557 if (rep->num_cell < 2)
558 return 0;
559
Harald Weltea06c35e2009-12-25 22:46:25 +0100560 mrc = &rep->cell[1];
561 mrc->rxlev = ((data[5] & 0x1f) << 1) | (data[6] >> 7);
Harald Welte950eca92009-12-25 22:49:34 +0100562 mrc->neigh_idx = (data[6] >> 2) & 0x1f;
Harald Welteeaa95d52009-12-25 23:01:54 +0100563 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Weltea06c35e2009-12-25 22:46:25 +0100564 mrc->bsic = ((data[6] & 0x03) << 4) | (data[7] >> 4);
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100565 if (rep->num_cell < 3)
566 return 0;
567
Harald Weltea06c35e2009-12-25 22:46:25 +0100568 mrc = &rep->cell[2];
569 mrc->rxlev = ((data[7] & 0x0f) << 2) | (data[8] >> 6);
Harald Welte950eca92009-12-25 22:49:34 +0100570 mrc->neigh_idx = (data[8] >> 1) & 0x1f;
Harald Welteeaa95d52009-12-25 23:01:54 +0100571 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Welte (local)65898582009-12-26 14:12:43 +0100572 mrc->bsic = ((data[8] & 0x01) << 5) | (data[9] >> 3);
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100573 if (rep->num_cell < 4)
574 return 0;
575
Harald Weltea06c35e2009-12-25 22:46:25 +0100576 mrc = &rep->cell[3];
577 mrc->rxlev = ((data[9] & 0x07) << 3) | (data[10] >> 5);
Harald Welte950eca92009-12-25 22:49:34 +0100578 mrc->neigh_idx = data[10] & 0x1f;
Harald Welteeaa95d52009-12-25 23:01:54 +0100579 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Weltea06c35e2009-12-25 22:46:25 +0100580 mrc->bsic = data[11] >> 2;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100581 if (rep->num_cell < 5)
582 return 0;
583
Harald Weltea06c35e2009-12-25 22:46:25 +0100584 mrc = &rep->cell[4];
585 mrc->rxlev = ((data[11] & 0x03) << 4) | (data[12] >> 4);
Harald Welte950eca92009-12-25 22:49:34 +0100586 mrc->neigh_idx = ((data[12] & 0xf) << 1) | (data[13] >> 7);
Harald Welteeaa95d52009-12-25 23:01:54 +0100587 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Weltea06c35e2009-12-25 22:46:25 +0100588 mrc->bsic = (data[13] >> 1) & 0x3f;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100589 if (rep->num_cell < 6)
590 return 0;
591
Harald Weltea06c35e2009-12-25 22:46:25 +0100592 mrc = &rep->cell[5];
Harald Welte950eca92009-12-25 22:49:34 +0100593 mrc->rxlev = ((data[13] & 0x01) << 5) | (data[14] >> 3);
594 mrc->neigh_idx = ((data[14] & 0x07) << 2) | (data[15] >> 6);
Harald Welteeaa95d52009-12-25 23:01:54 +0100595 mrc->arfcn = bitvec_get_nth_set_bit(nbv, mrc->neigh_idx + 1);
Harald Weltea06c35e2009-12-25 22:46:25 +0100596 mrc->bsic = data[15] & 0x3f;
Holger Hans Peter Freyther92ffd922009-12-22 07:45:17 +0100597
598 return 0;
599}
Holger Hans Peter Freyther2c0f1662010-06-15 19:39:27 +0800600
Jacob Erlbeck24d3b912013-10-31 15:36:41 +0100601/* 9.2.5 CM service accept */
602int gsm48_tx_mm_serv_ack(struct gsm_subscriber_connection *conn)
603{
Holger Hans Peter Freyther8239e062016-01-25 22:03:25 +0100604 struct msgb *msg = gsm48_msgb_alloc_name("GSM 04.08 SERV ACK");
Jacob Erlbeck24d3b912013-10-31 15:36:41 +0100605 struct gsm48_hdr *gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
606
607 msg->lchan = conn->lchan;
608
609 gh->proto_discr = GSM48_PDISC_MM;
610 gh->msg_type = GSM48_MT_MM_CM_SERV_ACC;
611
612 DEBUGP(DMM, "-> CM SERVICE ACK\n");
613
614 return gsm0808_submit_dtap(conn, msg, 0, 0);
615}
616
617/* 9.2.6 CM service reject */
618int gsm48_tx_mm_serv_rej(struct gsm_subscriber_connection *conn,
619 enum gsm48_reject_value value)
620{
621 struct msgb *msg;
622
623 msg = gsm48_create_mm_serv_rej(value);
624 if (!msg) {
625 LOGP(DMM, LOGL_ERROR, "Failed to allocate CM Service Reject.\n");
626 return -1;
627 }
628
629 DEBUGP(DMM, "-> CM SERVICE Reject cause: %d\n", value);
630
631 return gsm0808_submit_dtap(conn, msg, 0, 0);
632}