blob: 05fc0d36ea0cf88b1907c3946f5944c29fc98837 [file] [log] [blame]
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +04001/* gprs_bssgp_pcu.cpp
2 *
3 * Copyright (C) 2012 Ivan Klyuchnikov
Holger Hans Peter Freyther416ce692013-08-22 08:44:04 +02004 * Copyright (C) 2013 by Holger Hans Peter Freyther
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +04005 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21#include <gprs_rlcmac.h>
22#include <gprs_bssgp_pcu.h>
23#include <pcu_l1_if.h>
Max1187a772018-01-26 13:31:42 +010024#include <gprs_debug.h>
Holger Hans Peter Freyther67ed34e2013-10-17 17:01:54 +020025#include <bts.h>
Holger Hans Peter Freyther17c31ce2013-08-24 18:31:27 +020026#include <tbf.h>
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +020027#include <coding_scheme.h>
Max6dc90b82018-02-19 17:17:28 +010028#include <pdch.h>
Pau Espin Pedrolde7bb752020-01-23 12:37:15 +010029#include <decoding.h>
Max136ebcc2019-03-05 14:59:03 +010030
31extern "C" {
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +070032 #include <osmocom/gsm/protocol/gsm_23_003.h>
Alexander Couzens290d9032020-09-16 21:52:02 +020033 #include <osmocom/gprs/protocol/gsm_08_16.h>
Max136ebcc2019-03-05 14:59:03 +010034 #include <osmocom/core/utils.h>
Vadim Yanitskiycb988942020-11-08 13:27:35 +070035 #include <osmocom/gsm/gsm48.h>
Max136ebcc2019-03-05 14:59:03 +010036 #include "coding_scheme.h"
37}
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040038
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +020039/* Tuning parameters for BSSGP flow control */
40#define FC_DEFAULT_LIFE_TIME_SECS 10 /* experimental value, 10s */
41#define FC_MS_BUCKET_SIZE_BY_BMAX(bmax) ((bmax) / 2 + 500) /* experimental */
42#define FC_FALLBACK_BVC_BUCKET_SIZE 2000 /* e.g. on R = 0, value taken from PCAP files */
43#define FC_MS_MAX_RX_SLOTS 4 /* limit MS default R to 4 TS per MS */
44
45/* Constants for BSSGP flow control */
46#define FC_MAX_BUCKET_LEAK_RATE (6553500 / 8) /* Byte/s */
47#define FC_MAX_BUCKET_SIZE 6553500 /* Octets */
48
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +020049static struct gprs_bssgp_pcu the_pcu = { 0, };
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +020050
Andreas Eversberg71cce912013-01-16 13:49:00 +010051extern void *tall_pcu_ctx;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +020052extern uint16_t spoof_mcc, spoof_mnc;
Neels Hofmeyrbdc55fa2018-02-21 00:39:07 +010053extern bool spoof_mnc_3_digits;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040054
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +020055static void bvc_timeout(void *_priv);
56
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010057static int parse_ra_cap(struct tlv_parsed *tp, MS_Radio_Access_capability_t *rac)
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020058{
59 bitvec *block;
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020060 uint8_t cap_len;
61 uint8_t *cap;
62
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010063 memset(rac, 0, sizeof(*rac));
64
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020065 if (!TLVP_PRESENT(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP))
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010066 return -EINVAL;
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020067
68 cap_len = TLVP_LEN(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP);
69 cap = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_MS_RADIO_ACCESS_CAP);
70
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010071 LOGP(DBSSGP, LOGL_DEBUG, "Got BSSGP RA Capability of size %d\n", cap_len);
72
Alexander Couzensccde5c92017-02-04 03:10:08 +010073 block = bitvec_alloc(cap_len, tall_pcu_ctx);
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020074 bitvec_unpack(block, cap);
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010075
76 /* TS 24.008, 10.5.5.12a */
77 decode_gsm_ra_cap(block, rac);
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020078
79 bitvec_free(block);
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010080 return 0;
Holger Hans Peter Freyther98fe9452013-07-13 15:23:58 +020081}
82
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +020083static int gprs_bssgp_pcu_rx_dl_ud(struct msgb *msg, struct tlv_parsed *tp)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040084{
85 struct bssgp_ud_hdr *budh;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +040086
Andreas Eversberge6228b32012-07-03 13:36:03 +020087 uint32_t tlli;
Vadim Yanitskiycb988942020-11-08 13:27:35 +070088 uint32_t tlli_old = GSM_RESERVED_TMSI;
Andreas Eversberge6228b32012-07-03 13:36:03 +020089 uint8_t *data;
90 uint16_t len;
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010091 uint8_t ms_class = 0;
92 uint8_t egprs_ms_class = 0;
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +070093 int rc;
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +010094 MS_Radio_Access_capability_t rac;
Neels Hofmeyr00520512020-08-21 15:44:58 +020095 /* TODO: is it really necessary to initialize this as a "000" IMSI? It seems, the function should just return an
96 * error if no IMSI IE was found. */
97 struct osmo_mobile_identity mi_imsi = {
98 .type = GSM_MI_TYPE_TMSI,
99 };
100 OSMO_STRLCPY_ARRAY(mi_imsi.imsi, "000");
Andreas Eversberg7d7cf542012-06-25 09:26:15 +0200101
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400102 budh = (struct bssgp_ud_hdr *)msgb_bssgph(msg);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200103 tlli = ntohl(budh->tlli);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400104
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400105 /* LLC_PDU is mandatory IE */
106 if (!TLVP_PRESENT(tp, BSSGP_IE_LLC_PDU))
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400107 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200108 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD missing mandatory IE\n", tlli);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400109 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
110 }
Ivan Kluchnikovb172b1b2012-06-07 01:51:49 +0400111
Andreas Eversberge6228b32012-07-03 13:36:03 +0200112 data = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_LLC_PDU);
113 len = TLVP_LEN(tp, BSSGP_IE_LLC_PDU);
Vadim Yanitskiy3568fcf2020-02-03 16:38:51 +0700114 if (len > LLC_MAX_LEN)
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400115 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200116 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD IE_LLC_PDU too large\n", tlli);
Andreas Eversberge6228b32012-07-03 13:36:03 +0200117 return bssgp_tx_status(BSSGP_CAUSE_COND_IE_ERR, NULL, msg);
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400118 }
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400119
Andreas Eversberge13fa2d2012-07-09 17:10:44 +0200120 /* read IMSI. if no IMSI exists, use first paging block (any paging),
121 * because during attachment the IMSI might not be known, so the MS
122 * will listen to all paging blocks. */
Vadim Yanitskiyaad87b62019-07-24 16:36:45 +0700123 if (TLVP_PRESENT(tp, BSSGP_IE_IMSI))
124 {
Neels Hofmeyr00520512020-08-21 15:44:58 +0200125 rc = osmo_mobile_identity_decode(&mi_imsi, TLVP_VAL(tp, BSSGP_IE_IMSI), TLVP_LEN(tp, BSSGP_IE_IMSI),
126 true);
Pau Espin Pedrol1d68cdf2020-08-26 13:41:45 +0200127 if (rc < 0 || mi_imsi.type != GSM_MI_TYPE_IMSI) {
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +0700128 LOGP(DBSSGP, LOGL_NOTICE, "Failed to parse IMSI IE (rc=%d)\n", rc);
129 return bssgp_tx_status(BSSGP_CAUSE_COND_IE_ERR, NULL, msg);
130 }
Vadim Yanitskiyaad87b62019-07-24 16:36:45 +0700131 }
Andreas Eversberg51ab1342012-07-13 14:52:50 +0200132
133 /* parse ms radio access capability */
Jacob Erlbeck4a07a3b2016-01-20 12:22:07 +0100134 if (parse_ra_cap(tp, &rac) >= 0) {
135 /* Get the EGPRS class from the RA capability */
136 ms_class = Decoding::get_ms_class_by_capability(&rac);
137 egprs_ms_class =
138 Decoding::get_egprs_ms_class_by_capability(&rac);
139 LOGP(DBSSGP, LOGL_DEBUG, "Got downlink MS class %d/%d\n",
140 ms_class, egprs_ms_class);
141 }
Andreas Eversberg51ab1342012-07-13 14:52:50 +0200142
Andreas Eversberg24131bf2012-07-21 11:09:58 +0200143 /* get lifetime */
144 uint16_t delay_csec = 0xffff;
145 if (TLVP_PRESENT(tp, BSSGP_IE_PDU_LIFETIME))
146 {
147 uint8_t lt_len = TLVP_LEN(tp, BSSGP_IE_PDU_LIFETIME);
Andreas Eversberg24131bf2012-07-21 11:09:58 +0200148 if (lt_len == 2)
Harald Welte49b78222017-06-11 11:27:59 +0200149 delay_csec = tlvp_val16be(tp, BSSGP_IE_PDU_LIFETIME);
Andreas Eversberg24131bf2012-07-21 11:09:58 +0200150 else
151 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP invalid length of "
152 "PDU_LIFETIME IE\n");
153 } else
154 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP missing mandatory "
155 "PDU_LIFETIME IE\n");
156
Jacob Erlbeck93990462015-05-15 15:50:43 +0200157 /* get optional TLLI old */
158 if (TLVP_PRESENT(tp, BSSGP_IE_TLLI))
159 {
160 uint8_t tlli_len = TLVP_LEN(tp, BSSGP_IE_PDU_LIFETIME);
Jacob Erlbeck93990462015-05-15 15:50:43 +0200161 if (tlli_len == 2)
Harald Welte49b78222017-06-11 11:27:59 +0200162 tlli_old = tlvp_val16be(tp, BSSGP_IE_TLLI);
Jacob Erlbeck93990462015-05-15 15:50:43 +0200163 else
164 LOGP(DBSSGP, LOGL_NOTICE, "BSSGP invalid length of "
165 "TLLI (old) IE\n");
166 }
167
Neels Hofmeyr00520512020-08-21 15:44:58 +0200168 LOGP(DBSSGP, LOGL_INFO, "LLC [SGSN -> PCU] = TLLI: 0x%08x IMSI: %s len: %d\n", tlli, mi_imsi.imsi, len);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400169
Neels Hofmeyr00520512020-08-21 15:44:58 +0200170 return gprs_rlcmac_dl_tbf::handle(the_pcu.bts, tlli, tlli_old, mi_imsi.imsi,
Jacob Erlbeck14e00f82015-11-27 18:10:39 +0100171 ms_class, egprs_ms_class, delay_csec, data, len);
Ivan Kluchnikovc7e7f682012-06-29 22:53:15 +0400172}
Ivan Kluchnikova9e6dc52012-06-17 08:30:06 +0400173
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700174/* Returns 0 on success, suggested BSSGP cause otherwise */
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200175static unsigned int get_paging_mi(struct osmo_mobile_identity *mi, const struct tlv_parsed *tp)
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700176{
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700177 /* Use TMSI (if present) or IMSI */
178 if (TLVP_PRESENT(tp, BSSGP_IE_TMSI)) {
179 /* Be safe against an evil SGSN - check the length */
180 if (TLVP_LEN(tp, BSSGP_IE_TMSI) != GSM23003_TMSI_NUM_BYTES) {
181 LOGP(DBSSGP, LOGL_NOTICE, "TMSI IE has odd length (!= 4)\n");
182 return BSSGP_CAUSE_COND_IE_ERR;
183 }
184
185 /* NOTE: TMSI (unlike IMSI) IE comes without MI type header */
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200186 *mi = (struct osmo_mobile_identity){
187 .type = GSM_MI_TYPE_TMSI,
188 };
189 mi->tmsi = osmo_load32be(TLVP_VAL(tp, BSSGP_IE_TMSI));
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700190 } else if (TLVP_PRESENT(tp, BSSGP_IE_IMSI)) {
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200191 int rc = osmo_mobile_identity_decode(mi, TLVP_VAL(tp, BSSGP_IE_IMSI), TLVP_LEN(tp, BSSGP_IE_IMSI),
192 true);
193 if (rc < 0 || mi->type != GSM_MI_TYPE_IMSI) {
194 LOGP(DBSSGP, LOGL_ERROR, "Invalid IMSI Mobile Identity\n");
195 return BSSGP_CAUSE_COND_IE_ERR;
196 }
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700197 } else {
198 LOGP(DBSSGP, LOGL_ERROR, "Neither TMSI IE nor IMSI IE is present\n");
199 return BSSGP_CAUSE_MISSING_COND_IE;
200 }
201
202 return 0;
203}
204
Vadim Yanitskiy2c1fed22020-10-31 02:00:21 +0700205static int gprs_bssgp_pcu_rx_paging_cs(struct msgb *msg, const struct tlv_parsed *tp)
Pau Espin Pedrol65a0d1d2019-12-10 19:29:22 +0100206{
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200207 struct osmo_mobile_identity mi;
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700208 int rc;
Pau Espin Pedrol65a0d1d2019-12-10 19:29:22 +0100209
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200210 if ((rc = get_paging_mi(&mi, tp)) > 0)
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700211 return bssgp_tx_status((enum gprs_bssgp_cause) rc, NULL, msg);
Pau Espin Pedrol65a0d1d2019-12-10 19:29:22 +0100212
Vadim Yanitskiye9bddab2020-10-31 01:54:45 +0700213 return BTS::main_bts()->add_paging(tlvp_val8(tp, BSSGP_IE_CHAN_NEEDED, 0), &mi);
Pau Espin Pedrol65a0d1d2019-12-10 19:29:22 +0100214}
215
Vadim Yanitskiy2c1fed22020-10-31 02:00:21 +0700216static int gprs_bssgp_pcu_rx_paging_ps(struct msgb *msg, const struct tlv_parsed *tp)
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200217{
Neels Hofmeyr00520512020-08-21 15:44:58 +0200218 struct osmo_mobile_identity mi_imsi;
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200219 struct osmo_mobile_identity paging_mi;
Pau Espin Pedrold7c32652019-12-23 12:41:34 +0100220 uint16_t pgroup;
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +0700221 int rc;
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200222
Maxf3038e72019-03-19 15:39:05 +0100223 if (!TLVP_PRESENT(tp, BSSGP_IE_IMSI)) {
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200224 LOGP(DBSSGP, LOGL_ERROR, "No IMSI\n");
Pau Espin Pedrol5530f122019-12-10 19:26:27 +0100225 return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg);
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200226 }
227
Neels Hofmeyr00520512020-08-21 15:44:58 +0200228 rc = osmo_mobile_identity_decode(&mi_imsi, TLVP_VAL(tp, BSSGP_IE_IMSI), TLVP_LEN(tp, BSSGP_IE_IMSI), true);
229 if (rc < 0 || mi_imsi.type != GSM_MI_TYPE_IMSI) {
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +0700230 LOGP(DBSSGP, LOGL_NOTICE, "Failed to parse IMSI IE (rc=%d)\n", rc);
Pau Espin Pedrold7c32652019-12-23 12:41:34 +0100231 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
232 }
Neels Hofmeyr00520512020-08-21 15:44:58 +0200233 pgroup = imsi2paging_group(mi_imsi.imsi);
Pau Espin Pedrold7c32652019-12-23 12:41:34 +0100234 if (pgroup > 999) {
Neels Hofmeyr00520512020-08-21 15:44:58 +0200235 LOGP(DBSSGP, LOGL_NOTICE, "Failed to compute IMSI %s paging group\n", mi_imsi.imsi);
Pau Espin Pedrold7c32652019-12-23 12:41:34 +0100236 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
Vadim Yanitskiy6170ac02019-07-24 16:44:13 +0700237 }
Maxf3038e72019-03-19 15:39:05 +0100238
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200239 if ((rc = get_paging_mi(&paging_mi, tp)) > 0)
Vadim Yanitskiy0b25f692020-03-26 03:38:05 +0700240 return bssgp_tx_status((enum gprs_bssgp_cause) rc, NULL, msg);
Pau Espin Pedrol5530f122019-12-10 19:26:27 +0100241
Neels Hofmeyr59fc0bd2020-08-21 16:21:23 +0200242 return gprs_rlcmac_paging_request(&paging_mi, pgroup);
Andreas Eversberg8c3680d2012-10-08 12:30:56 +0200243}
244
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400245/* Receive a BSSGP PDU from a BSS on a PTP BVCI */
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200246static int gprs_bssgp_pcu_rx_ptp(struct msgb *msg, struct tlv_parsed *tp, struct bssgp_bvc_ctx *bctx)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400247{
248 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Maxa49475b2017-05-23 17:53:38 +0200249 enum bssgp_pdu_type pdu_type = (enum bssgp_pdu_type) bgph->pdu_type;
Harald Welte05d7b5d2017-07-29 10:16:44 +0200250 int bvci = bctx ? bctx->bvci : -1;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400251 unsigned rc = 0;
252
Andreas Eversbergba1cd9b2012-07-25 09:14:09 +0200253 if (!bctx)
254 return -EINVAL;
255
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400256 /* If traffic is received on a BVC that is marked as blocked, the
257 * received PDU shall not be accepted and a STATUS PDU (Cause value:
258 * BVC Blocked) shall be sent to the peer entity on the signalling BVC */
259 if (bctx->state & BVC_S_BLOCKED && pdu_type != BSSGP_PDUT_STATUS)
260 {
261 uint16_t bvci = msgb_bvci(msg);
262 LOGP(DBSSGP, LOGL_NOTICE, "rx BVC_S_BLOCKED\n");
263 return bssgp_tx_status(BSSGP_CAUSE_BVCI_BLOCKED, &bvci, msg);
264 }
265
266 switch (pdu_type) {
Harald Welte05d7b5d2017-07-29 10:16:44 +0200267 case BSSGP_PDUT_STATUS:
268 /* already handled in libosmogb */
269 OSMO_ASSERT(0);
270 break;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400271 case BSSGP_PDUT_DL_UNITDATA:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200272 LOGP(DBSSGP, LOGL_DEBUG, "Rx BSSGP BVCI=%d (PTP) DL_UNITDATA\n", bvci);
Holger Hans Peter Freyther416ce692013-08-22 08:44:04 +0200273 if (the_pcu.on_dl_unit_data)
274 the_pcu.on_dl_unit_data(&the_pcu, msg, tp);
Ivan Kluchnikov5e0df932012-06-12 15:33:52 +0400275 gprs_bssgp_pcu_rx_dl_ud(msg, tp);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400276 break;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400277 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400278 case BSSGP_PDUT_FLOW_CONTROL_MS_ACK:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200279 LOGP(DBSSGP, LOGL_DEBUG, "Rx BSSGP BVCI=%d (PTP) %s\n",
280 bvci, bssgp_pdu_str(pdu_type));
281 break;
Harald Welte05d7b5d2017-07-29 10:16:44 +0200282 case BSSGP_PDUT_PAGING_CS:
Pau Espin Pedrol771de1f2019-12-10 19:31:25 +0100283 gprs_bssgp_pcu_rx_paging_cs(msg, tp);
284 break;
285 case BSSGP_PDUT_PAGING_PS:
286 gprs_bssgp_pcu_rx_paging_ps(msg, tp);
287 break;
Harald Welte05d7b5d2017-07-29 10:16:44 +0200288 case BSSGP_PDUT_RA_CAPABILITY:
289 case BSSGP_PDUT_RA_CAPA_UPDATE_ACK:
290 LOGP(DBSSGP, LOGL_INFO, "Rx BSSGP BVCI=%d (PTP) PDU type %s not implemented\n",
291 bvci, bssgp_pdu_str(pdu_type));
292 break;
293 /* See TS 08.18 5.4.1 */
294 case BSSGP_PDUT_SUSPEND:
295 case BSSGP_PDUT_SUSPEND_ACK:
296 case BSSGP_PDUT_SUSPEND_NACK:
297 case BSSGP_PDUT_RESUME:
298 case BSSGP_PDUT_RESUME_ACK:
299 case BSSGP_PDUT_RESUME_NACK:
300 case BSSGP_PDUT_FLUSH_LL:
301 case BSSGP_PDUT_FLUSH_LL_ACK:
302 case BSSGP_PDUT_LLC_DISCARD:
303 case BSSGP_PDUT_BVC_BLOCK:
304 case BSSGP_PDUT_BVC_BLOCK_ACK:
305 case BSSGP_PDUT_BVC_UNBLOCK:
306 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
307 case BSSGP_PDUT_BVC_RESET:
308 case BSSGP_PDUT_BVC_RESET_ACK:
309 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
310 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%u (PTP) PDU type %s unexpected at PTP\n",
311 bctx->bvci, bssgp_pdu_str(pdu_type));
312 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400313 break;
314 default:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200315 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%u (PTP) PDU type %s unknown\n",
Harald Welte356ac612017-05-25 19:05:32 +0200316 bctx->bvci, bssgp_pdu_str(pdu_type));
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400317 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
318 break;
319 }
320 return rc;
321}
322
323/* Receive a BSSGP PDU from a SGSN on a SIGNALLING BVCI */
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200324static int gprs_bssgp_pcu_rx_sign(struct msgb *msg, struct tlv_parsed *tp, struct bssgp_bvc_ctx *bctx)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400325{
326 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
Maxa49475b2017-05-23 17:53:38 +0200327 enum bssgp_pdu_type pdu_type = (enum bssgp_pdu_type) bgph->pdu_type;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400328 int rc = 0;
Vadim Yanitskiyce27d1e2019-11-08 04:18:46 +0700329 int bvci = bctx ? bctx->bvci : msgb_bvci(msg);
Maxa49475b2017-05-23 17:53:38 +0200330 switch (pdu_type) {
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400331 case BSSGP_PDUT_STATUS:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200332 /* already handled in libosmogb */
333 OSMO_ASSERT(0);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400334 break;
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200335 case BSSGP_PDUT_SUSPEND_ACK:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200336 case BSSGP_PDUT_RESUME_ACK:
337 case BSSGP_PDUT_BVC_BLOCK_ACK:
338 LOGP(DBSSGP, LOGL_DEBUG, "Rx BSSGP BVCI=%d (SIGN) %s\n",
339 bvci, bssgp_pdu_str(pdu_type));
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200340 break;
341 case BSSGP_PDUT_BVC_RESET_ACK:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200342 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%d (SIGN) BVC_RESET_ACK\n", bvci);
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200343 if (!the_pcu.bvc_sig_reset)
344 the_pcu.bvc_sig_reset = 1;
345 else
346 the_pcu.bvc_reset = 1;
347 bvc_timeout(NULL);
348 break;
Pau Espin Pedrol65a0d1d2019-12-10 19:29:22 +0100349 case BSSGP_PDUT_PAGING_CS:
350 gprs_bssgp_pcu_rx_paging_cs(msg, tp);
351 break;
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200352 case BSSGP_PDUT_PAGING_PS:
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200353 gprs_bssgp_pcu_rx_paging_ps(msg, tp);
354 break;
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200355 case BSSGP_PDUT_BVC_UNBLOCK_ACK:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200356 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%d (SIGN) BVC_UNBLOCK_ACK\n", bvci);
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200357 the_pcu.bvc_unblocked = 1;
Holger Hans Peter Freytherc0f16442013-08-22 08:40:33 +0200358 if (the_pcu.on_unblock_ack)
359 the_pcu.on_unblock_ack(&the_pcu);
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200360 bvc_timeout(NULL);
361 break;
Harald Welte05d7b5d2017-07-29 10:16:44 +0200362 case BSSGP_PDUT_SUSPEND_NACK:
363 case BSSGP_PDUT_RESUME_NACK:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200364 case BSSGP_PDUT_FLUSH_LL:
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200365 case BSSGP_PDUT_SGSN_INVOKE_TRACE:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200366 LOGP(DBSSGP, LOGL_INFO, "Rx BSSGP BVCI=%d (SIGN) PDU type %s not implemented\n",
367 bvci, bssgp_pdu_str(pdu_type));
368 break;
369 /* See TS 08.18 5.4.1 */
370 case BSSGP_PDUT_UL_UNITDATA:
371 case BSSGP_PDUT_DL_UNITDATA:
372 case BSSGP_PDUT_RA_CAPABILITY:
373 case BSSGP_PDUT_PTM_UNITDATA:
374 case BSSGP_PDUT_RA_CAPA_UDPATE:
375 case BSSGP_PDUT_RA_CAPA_UPDATE_ACK:
376 case BSSGP_PDUT_RADIO_STATUS:
377 case BSSGP_PDUT_FLOW_CONTROL_BVC:
378 case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK:
379 case BSSGP_PDUT_FLOW_CONTROL_MS:
380 case BSSGP_PDUT_FLOW_CONTROL_MS_ACK:
381 case BSSGP_PDUT_DOWNLOAD_BSS_PFC:
382 case BSSGP_PDUT_CREATE_BSS_PFC:
383 case BSSGP_PDUT_CREATE_BSS_PFC_ACK:
384 case BSSGP_PDUT_CREATE_BSS_PFC_NACK:
385 case BSSGP_PDUT_MODIFY_BSS_PFC:
386 case BSSGP_PDUT_MODIFY_BSS_PFC_ACK:
387 case BSSGP_PDUT_DELETE_BSS_PFC:
388 case BSSGP_PDUT_DELETE_BSS_PFC_ACK:
389 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%d (SIGN) PDU type %s unexpected at SIGN\n",
390 bvci, bssgp_pdu_str(pdu_type));
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200391 break;
392 default:
Harald Welte05d7b5d2017-07-29 10:16:44 +0200393 LOGP(DBSSGP, LOGL_NOTICE, "Rx BSSGP BVCI=%d (SIGN) PDU type %s unknown\n",
Maxa49475b2017-05-23 17:53:38 +0200394 bvci, bssgp_pdu_str(pdu_type));
Holger Hans Peter Freythera9744de2013-07-28 19:01:20 +0200395 rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg);
396 break;
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400397 }
398 return rc;
399}
400
Holger Hans Peter Freyther90d5df42013-07-28 21:14:15 +0200401static int gprs_bssgp_pcu_rcvmsg(struct msgb *msg)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400402{
403 struct bssgp_normal_hdr *bgph = (struct bssgp_normal_hdr *) msgb_bssgph(msg);
404 struct bssgp_ud_hdr *budh = (struct bssgp_ud_hdr *) msgb_bssgph(msg);
405 struct tlv_parsed tp;
Maxa49475b2017-05-23 17:53:38 +0200406 enum bssgp_pdu_type pdu_type = (enum bssgp_pdu_type) bgph->pdu_type;
Max2813f932017-06-27 17:18:40 +0200407 enum gprs_bssgp_cause cause = BSSGP_CAUSE_OML_INTERV;
408 uint16_t ns_bvci = msgb_bvci(msg), nsei = msgb_nsei(msg);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400409 int data_len;
410 int rc = 0;
Andreas Eversberg3e372d52012-07-06 09:28:15 +0200411 struct bssgp_bvc_ctx *bctx;
412
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100413 if (pdu_type == BSSGP_PDUT_STATUS)
414 /* Pass the message to the generic BSSGP parser, which handles
Max2813f932017-06-27 17:18:40 +0200415 * STATUS and RESET messages in either direction. */
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100416 return bssgp_rcvmsg(msg);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400417
418 /* Identifiers from DOWN: NSEI, BVCI (both in msg->cb) */
419
420 /* UNITDATA BSSGP headers have TLLI in front */
421 if (pdu_type != BSSGP_PDUT_UL_UNITDATA && pdu_type != BSSGP_PDUT_DL_UNITDATA)
422 {
423 data_len = msgb_bssgp_len(msg) - sizeof(*bgph);
424 rc = bssgp_tlv_parse(&tp, bgph->data, data_len);
425 }
426 else
427 {
428 data_len = msgb_bssgp_len(msg) - sizeof(*budh);
429 rc = bssgp_tlv_parse(&tp, budh->data, data_len);
430 }
Stefan Sperling3df15322018-06-25 12:17:39 +0200431 if (rc < 0) {
432 LOGP(DBSSGP, LOGL_ERROR, "Failed to parse BSSGP %s message. Invalid message was: %s\n",
433 bssgp_pdu_str(pdu_type), msgb_hexdump(msg));
Harald Welte7b7f2042019-07-21 09:26:20 +0200434 return bssgp_tx_status(BSSGP_CAUSE_INV_MAND_INF, NULL, msg);
Stefan Sperling3df15322018-06-25 12:17:39 +0200435 }
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400436
Max2813f932017-06-27 17:18:40 +0200437 if (pdu_type == BSSGP_PDUT_BVC_RESET) {
438 rc = bssgp_rcvmsg(msg);
439 if (ns_bvci != BVCI_SIGNALLING)
440 return rc;
441
442 if (TLVP_PRES_LEN(&tp, BSSGP_IE_CAUSE, 1))
443 cause = (enum gprs_bssgp_cause)*TLVP_VAL(&tp, BSSGP_IE_CAUSE);
444 else
445 LOGP(DBSSGP, LOGL_ERROR, "NSEI=%u BVC RESET without cause?!\n", nsei);
446
447 rc = bssgp_tx_bvc_ptp_reset(nsei, cause);
448 if (rc < 0)
449 LOGP(DBSSGP, LOGL_ERROR, "NSEI=%u BVC PTP reset procedure failed: %d\n", nsei, rc);
450
451 return rc;
452 }
453
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400454 /* look-up or create the BTS context for this BVC */
455 bctx = btsctx_by_bvci_nsei(ns_bvci, msgb_nsei(msg));
456
Vadim Yanitskiyef444142019-11-08 04:02:31 +0700457 if (!bctx && ns_bvci != BVCI_SIGNALLING)
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400458 {
Max2813f932017-06-27 17:18:40 +0200459 LOGP(DBSSGP, LOGL_NOTICE, "NSEI=%u/BVCI=%u Rejecting PDU type %s for unknown BVCI\n",
460 nsei, ns_bvci, bssgp_pdu_str(pdu_type));
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400461 return bssgp_tx_status(BSSGP_CAUSE_UNKNOWN_BVCI, NULL, msg);
462 }
463
464 if (bctx)
465 {
Neels Hofmeyra01e2ee2017-02-23 18:10:13 +0100466 log_set_context(LOG_CTX_GB_BVC, bctx);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400467 rate_ctr_inc(&bctx->ctrg->ctr[BSSGP_CTR_PKTS_IN]);
468 rate_ctr_add(&bctx->ctrg->ctr[BSSGP_CTR_BYTES_IN], msgb_bssgp_len(msg));
469 }
470
471 if (ns_bvci == BVCI_SIGNALLING)
472 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200473 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_SIGNALLING gprs_bssgp_rx_sign\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400474 rc = gprs_bssgp_pcu_rx_sign(msg, &tp, bctx);
475 }
476 else if (ns_bvci == BVCI_PTM)
477 {
Andreas Eversberg0e403092012-07-06 11:04:57 +0200478 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTM bssgp_tx_status\n");
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400479 rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg);
480 }
481 else
482 {
Pau Espin Pedroldb12f252019-12-23 14:27:54 +0100483 LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTP=%u gprs_bssgp_rx_ptp\n", ns_bvci);
Ivan Kluchnikov8ee60512012-03-05 19:24:57 +0400484 rc = gprs_bssgp_pcu_rx_ptp(msg, &tp, bctx);
485 }
486 return rc;
487}
Harald Welte477e79e2012-06-18 12:21:03 +0800488
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100489static void handle_nm_status(struct osmo_bssgp_prim *bp)
490{
491 enum gprs_bssgp_cause cause;
492
493 LOGP(DPCU, LOGL_DEBUG,
494 "Got NM-STATUS.ind, BVCI=%d, NSEI=%d\n",
495 bp->bvci, bp->nsei);
496
497 if (!TLVP_PRESENT(bp->tp, BSSGP_IE_CAUSE))
498 return;
499
500 cause = (enum gprs_bssgp_cause)*TLVP_VAL(bp->tp, BSSGP_IE_CAUSE);
501
502 if (cause != BSSGP_CAUSE_BVCI_BLOCKED &&
503 cause != BSSGP_CAUSE_UNKNOWN_BVCI)
504 return;
505
506 if (!TLVP_PRESENT(bp->tp, BSSGP_IE_BVCI))
507 return;
508
509 if (gprs_bssgp_pcu_current_bctx()->bvci != bp->bvci) {
510 LOGP(DPCU, LOGL_NOTICE,
511 "Received BSSGP STATUS message for an unknown BVCI (%d), "
512 "ignored\n",
513 bp->bvci);
514 return;
515 }
516
517 switch (cause) {
518 case BSSGP_CAUSE_BVCI_BLOCKED:
519 if (the_pcu.bvc_unblocked) {
520 the_pcu.bvc_unblocked = 0;
521 bvc_timeout(NULL);
522 }
523 break;
524
525 case BSSGP_CAUSE_UNKNOWN_BVCI:
526 if (the_pcu.bvc_reset) {
527 the_pcu.bvc_reset = 0;
528 bvc_timeout(NULL);
529 }
530 break;
531 default:
532 break;
533 }
534}
535
Harald Welte477e79e2012-06-18 12:21:03 +0800536int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
537{
Jacob Erlbeck39645b82015-03-16 12:27:11 +0100538 struct osmo_bssgp_prim *bp;
539 bp = container_of(oph, struct osmo_bssgp_prim, oph);
540
541 switch (oph->sap) {
542 case SAP_BSSGP_NM:
543 if (oph->primitive == PRIM_NM_STATUS)
544 handle_nm_status(bp);
545 break;
546 default:
547 break;
548 }
Harald Welte477e79e2012-06-18 12:21:03 +0800549 return 0;
550}
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200551
Alexander Couzens290d9032020-09-16 21:52:02 +0200552void gprs_ns_prim_status_cb(struct osmo_gprs_ns2_prim *nsp)
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200553{
Alexander Couzens290d9032020-09-16 21:52:02 +0200554 switch (nsp->u.status.cause) {
555 case NS_AFF_CAUSE_SNS_CONFIGURED:
556 LOGP(DPCU, LOGL_NOTICE, "NS-NSE %d SNS configured.\n", nsp->nsei);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200557 break;
Alexander Couzens290d9032020-09-16 21:52:02 +0200558 case NS_AFF_CAUSE_RECOVERY:
559 LOGP(DPCU, LOGL_NOTICE, "NS-NSE %d became available\n", nsp->nsei);
Holger Hans Peter Freyther4b984b12013-07-13 12:57:06 +0200560 if (!the_pcu.nsvc_unblocked) {
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200561 the_pcu.bvc_sig_reset = 0;
562 the_pcu.bvc_reset = 0;
Alexander Couzens290d9032020-09-16 21:52:02 +0200563 the_pcu.nsvc_unblocked = 1;
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200564 bvc_timeout(NULL);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200565 }
566 break;
Alexander Couzens290d9032020-09-16 21:52:02 +0200567 case NS_AFF_CAUSE_FAILURE:
568 LOGP(DPCU, LOGL_NOTICE, "NS-NSE %d became unavailable\n", nsp->nsei);
Holger Hans Peter Freyther4b984b12013-07-13 12:57:06 +0200569 if (the_pcu.nsvc_unblocked) {
570 the_pcu.nsvc_unblocked = 0;
Holger Hans Peter Freythered70cb72013-07-13 12:53:46 +0200571 osmo_timer_del(&the_pcu.bvc_timer);
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200572 the_pcu.bvc_sig_reset = 0;
573 the_pcu.bvc_reset = 0;
574 the_pcu.bvc_unblocked = 0;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200575 }
576 break;
Alexander Couzens290d9032020-09-16 21:52:02 +0200577 default:
578 LOGP(DPCU, LOGL_NOTICE,
579 "NS: %s Unknown prim %d from NS\n",
580 get_value_string(osmo_prim_op_names, nsp->oph.operation),
581 nsp->oph.primitive);
582 break;
583 }
584}
585
586/* called by the ns layer */
587int gprs_ns_prim_cb(struct osmo_prim_hdr *oph, void *ctx)
588{
589 struct osmo_gprs_ns2_prim *nsp;
590 int rc = 0;
591
592 if (oph->sap != SAP_NS)
593 return 0;
594
595 nsp = container_of(oph, struct osmo_gprs_ns2_prim, oph);
596
597 if (oph->operation != PRIM_OP_INDICATION) {
598 LOGP(DPCU, LOGL_NOTICE, "NS: %s Unknown prim %d from NS\n",
599 get_value_string(osmo_prim_op_names, oph->operation),
600 oph->operation);
Alexander Couzensa2848542020-10-26 00:33:31 +0100601 goto out;
Alexander Couzens290d9032020-09-16 21:52:02 +0200602 }
603
604 switch (oph->primitive) {
605 case PRIM_NS_UNIT_DATA:
606 /* hand the message into the BSSGP implementation */
607 /* add required msg fields for Gb layer */
608 msgb_bssgph(oph->msg) = oph->msg->l3h;
609 msgb_bvci(oph->msg) = nsp->bvci;
610 msgb_nsei(oph->msg) = nsp->nsei;
611 rc = gprs_bssgp_pcu_rcvmsg(oph->msg);
612 break;
613 case PRIM_NS_STATUS:
614 gprs_ns_prim_status_cb(nsp);
615 break;
616 default:
617 LOGP(DPCU, LOGL_NOTICE,
618 "NS: %s Unknown prim %d from NS\n",
619 get_value_string(osmo_prim_op_names, oph->operation),
620 oph->primitive);
Jacob Erlbeckebebad12015-08-17 14:43:52 +0200621 break;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200622 }
623
Alexander Couzensa2848542020-10-26 00:33:31 +0100624out:
625 if (oph->msg)
626 msgb_free(oph->msg);
627
Alexander Couzens290d9032020-09-16 21:52:02 +0200628 return rc;
629}
630
631/* called by the bssgp layer to send NS PDUs */
632int gprs_gp_send_cb(void *ctx, struct msgb *msg)
633{
634 struct gprs_ns2_inst *nsi = (struct gprs_ns2_inst *) ctx;
635 struct osmo_gprs_ns2_prim nsp = {};
636 nsp.nsei = msgb_nsei(msg);
637 nsp.bvci = msgb_bvci(msg);
638 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA,
639 PRIM_OP_REQUEST, msg);
640 return gprs_ns2_recv_prim(nsi, &nsp.oph);
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +0200641}
642
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200643static unsigned count_pdch(const struct gprs_rlcmac_bts *bts)
644{
645 size_t trx_no, ts_no;
646 unsigned num_pdch = 0;
647
648 for (trx_no = 0; trx_no < ARRAY_SIZE(bts->trx); ++trx_no) {
649 const struct gprs_rlcmac_trx *trx = &bts->trx[trx_no];
650
651 for (ts_no = 0; ts_no < ARRAY_SIZE(trx->pdch); ++ts_no) {
652 const struct gprs_rlcmac_pdch *pdch = &trx->pdch[ts_no];
653
654 if (pdch->is_enabled())
655 num_pdch += 1;
656 }
657 }
658
659 return num_pdch;
660}
661
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200662static uint32_t gprs_bssgp_max_leak_rate(enum CodingScheme cs, int num_pdch)
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200663{
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200664 int bytes_per_rlc_block = mcs_max_data_block_bytes(cs) * num_data_blocks(mcs_header_type(cs));
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200665
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100666 /* n byte payload per 20ms */
667 return bytes_per_rlc_block * (1000 / 20) * num_pdch;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200668}
669
670static uint32_t compute_bucket_size(struct gprs_rlcmac_bts *bts,
671 uint32_t leak_rate, uint32_t fallback)
672{
673 uint32_t bucket_size = 0;
Jacob Erlbeck0288cdb2015-05-06 10:47:30 +0200674 uint16_t bucket_time = bts->fc_bucket_time;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200675
Jacob Erlbeck0288cdb2015-05-06 10:47:30 +0200676 if (bucket_time == 0)
677 bucket_time = bts->force_llc_lifetime;
678
679 if (bucket_time == 0xffff)
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200680 bucket_size = FC_MAX_BUCKET_SIZE;
681
Jacob Erlbeck0288cdb2015-05-06 10:47:30 +0200682 if (bucket_size == 0 && bucket_time && leak_rate)
683 bucket_size = (uint64_t)leak_rate * bucket_time / 100;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200684
685 if (bucket_size == 0 && leak_rate)
686 bucket_size = leak_rate * FC_DEFAULT_LIFE_TIME_SECS;
687
688 if (bucket_size == 0)
689 bucket_size = fallback;
690
691 if (bucket_size > FC_MAX_BUCKET_SIZE)
692 bucket_size = FC_MAX_BUCKET_SIZE;
693
694 return bucket_size;
695}
696
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200697static uint32_t get_and_reset_avg_queue_delay(void)
698{
Pau Espin Pedrol1de68732020-03-11 14:04:52 +0100699 struct timespec *delay_sum = &the_pcu.queue_delay_sum;
Jacob Erlbeck0ae43132015-06-11 12:03:18 +0200700 uint32_t delay_sum_ms = delay_sum->tv_sec * 1000 +
Pau Espin Pedrol1de68732020-03-11 14:04:52 +0100701 delay_sum->tv_nsec / 1000000000;
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200702 uint32_t avg_delay_ms = 0;
703
704 if (the_pcu.queue_delay_count > 0)
705 avg_delay_ms = delay_sum_ms / the_pcu.queue_delay_count;
706
707 /* Reset accumulator */
Pau Espin Pedrol1de68732020-03-11 14:04:52 +0100708 delay_sum->tv_sec = delay_sum->tv_nsec = 0;
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200709 the_pcu.queue_delay_count = 0;
710
711 return avg_delay_ms;
712}
713
Jacob Erlbeck2db0f082015-09-07 18:49:00 +0200714static int get_and_reset_measured_leak_rate(int *usage_by_1000, unsigned num_pdch)
715{
716 int rate; /* byte per second */
717
718 if (the_pcu.queue_frames_sent == 0)
719 return -1;
720
721 if (the_pcu.queue_frames_recv == 0)
722 return -1;
723
724 *usage_by_1000 = the_pcu.queue_frames_recv * 1000 /
725 the_pcu.queue_frames_sent;
726
727 /* 20ms/num_pdch is the average RLC block duration, so the rate is
728 * calculated as:
729 * rate = bytes_recv / (block_dur * block_count) */
730 rate = the_pcu.queue_bytes_recv * 1000 * num_pdch /
731 (20 * the_pcu.queue_frames_recv);
732
733 the_pcu.queue_frames_sent = 0;
734 the_pcu.queue_bytes_recv = 0;
735 the_pcu.queue_frames_recv = 0;
736
737 return rate;
738}
739
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200740static enum CodingScheme max_coding_scheme_dl(struct gprs_rlcmac_bts *bts)
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100741{
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100742 int num = 0;
743 int i;
Pau Espin Pedrol87eec1f2020-10-30 18:46:24 +0100744 bool mcs_any = false;
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100745
Pau Espin Pedrol87eec1f2020-10-30 18:46:24 +0100746 /* First check if we support any MCS: */
747 for (i = 8; i >= 0; i--) {
748 if (bts->mcs_mask & (1 << i)) {
749 num = i + 1;
750 mcs_any = true;
751 break;
752 }
753 }
754
755 if (mcs_any) {
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100756 if (!bts->cs_adj_enabled) {
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100757 if (bts->initial_mcs_dl) {
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100758 num = bts->initial_mcs_dl;
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100759 } else {
Pau Espin Pedrol87eec1f2020-10-30 18:46:24 +0100760 /* We found "num" for free in the loop above */
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100761 }
Pau Espin Pedrol343ec9b2020-10-30 18:35:54 +0100762 } else if (bts->bts->max_mcs_dl()) {
763 num = bts->bts->max_mcs_dl();
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100764 } else {
765 num = 9;
766 }
767
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100768 if (num)
769 return mcs_get_egprs_by_num(num);
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100770 }
771
772 if (!bts->cs_adj_enabled) {
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100773 if (bts->initial_cs_dl) {
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100774 num = bts->initial_cs_dl;
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100775 } else {
776 for (i = 3; i >= 0; i--) {
777 if (bts->cs_mask & (1 << i)) {
778 num = i + 1;
779 break;
780 }
781 }
782 }
Pau Espin Pedrol343ec9b2020-10-30 18:35:54 +0100783 } else if (bts->bts->max_cs_dl()) {
784 num = bts->bts->max_cs_dl();
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100785 }
786
Pau Espin Pedrold87722d2020-10-30 17:14:26 +0100787 if (!num)
788 num = 4;
789
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200790 return mcs_get_gprs_by_num(num);
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100791}
792
Pau Espin Pedrol3f064f52019-12-10 17:09:51 +0100793static int gprs_bssgp_tx_fc_bvc(void)
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200794{
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200795 struct gprs_rlcmac_bts *bts;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200796 uint32_t bucket_size; /* oct */
797 uint32_t ms_bucket_size; /* oct */
798 uint32_t leak_rate; /* oct/s */
799 uint32_t ms_leak_rate; /* oct/s */
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200800 uint32_t avg_delay_ms;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200801 int num_pdch = -1;
Pau Espin Pedrol2ae83372020-05-18 11:35:35 +0200802 enum CodingScheme max_cs_dl;
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200803
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200804 if (!the_pcu.bctx) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200805 LOGP(DBSSGP, LOGL_ERROR, "No bctx\n");
806 return -EIO;
807 }
Jacob Erlbeck87d73412015-04-21 12:56:48 +0200808 bts = bts_main_data();
809
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100810 max_cs_dl = max_coding_scheme_dl(bts);
Jacob Erlbeck6eed1912015-07-21 18:29:46 +0200811
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200812 bucket_size = bts->fc_bvc_bucket_size;
813 leak_rate = bts->fc_bvc_leak_rate;
814 ms_bucket_size = bts->fc_ms_bucket_size;
815 ms_leak_rate = bts->fc_ms_leak_rate;
816
Pau Espin Pedrol87eec1f2020-10-30 18:46:24 +0100817 /* FIXME: This calculation is mostly wrong. It should be done based on
818 currently established TBF (and whether the related (egprs)_ms_class
819 as per which CS/MCS they support). */
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200820 if (leak_rate == 0) {
Jacob Erlbeck2db0f082015-09-07 18:49:00 +0200821 int meas_rate;
822 int usage; /* in 0..1000 */
823
824 if (num_pdch < 0)
825 num_pdch = count_pdch(bts);
826
827 meas_rate = get_and_reset_measured_leak_rate(&usage, num_pdch);
828 if (meas_rate > 0) {
829 leak_rate = gprs_bssgp_max_leak_rate(max_cs_dl, num_pdch);
830 leak_rate =
831 (meas_rate * usage + leak_rate * (1000 - usage)) /
832 1000;
833 LOGP(DBSSGP, LOGL_DEBUG,
834 "Estimated BVC leak rate = %d "
835 "(measured %d, usage %d%%)\n",
836 leak_rate, meas_rate, usage/10);
837 }
838 }
839
840 if (leak_rate == 0) {
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200841 if (num_pdch < 0)
842 num_pdch = count_pdch(bts);
843
Jacob Erlbeck6eed1912015-07-21 18:29:46 +0200844 leak_rate = gprs_bssgp_max_leak_rate(max_cs_dl, num_pdch);
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200845
846 LOGP(DBSSGP, LOGL_DEBUG,
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100847 "Computed BVC leak rate = %d, num_pdch = %d, cs = %s\n",
Max136ebcc2019-03-05 14:59:03 +0100848 leak_rate, num_pdch, mcs_name(max_cs_dl));
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200849 };
850
851 if (ms_leak_rate == 0) {
852 int ms_num_pdch;
Jacob Erlbeck7f79f0d2015-07-17 11:38:49 +0200853 int max_pdch = gprs_alloc_max_dl_slots_per_ms(bts);
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200854
855 if (num_pdch < 0)
856 num_pdch = count_pdch(bts);
857
858 ms_num_pdch = num_pdch;
Jacob Erlbeck7f79f0d2015-07-17 11:38:49 +0200859 if (max_pdch > FC_MS_MAX_RX_SLOTS)
860 max_pdch = FC_MS_MAX_RX_SLOTS;
861 if (ms_num_pdch > max_pdch)
862 ms_num_pdch = max_pdch;
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200863
Jacob Erlbeck6eed1912015-07-21 18:29:46 +0200864 ms_leak_rate = gprs_bssgp_max_leak_rate(max_cs_dl, ms_num_pdch);
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200865
866 /* TODO: To properly support multiple TRX, the per MS leak rate
867 * should be derived from the max number of PDCH TS per TRX.
868 */
869 LOGP(DBSSGP, LOGL_DEBUG,
Jacob Erlbeck7f28c972016-02-04 17:54:42 +0100870 "Computed MS default leak rate = %d, ms_num_pdch = %d, "
871 "cs = %s\n",
Max136ebcc2019-03-05 14:59:03 +0100872 ms_leak_rate, ms_num_pdch, mcs_name(max_cs_dl));
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200873 };
874
875 /* TODO: Force leak_rate to 0 on buffer bloat */
876
877 if (bucket_size == 0)
878 bucket_size = compute_bucket_size(bts, leak_rate,
879 FC_FALLBACK_BVC_BUCKET_SIZE);
880
881 if (ms_bucket_size == 0)
882 ms_bucket_size = compute_bucket_size(bts, ms_leak_rate,
883 FC_MS_BUCKET_SIZE_BY_BMAX(bucket_size));
884
885 if (leak_rate > FC_MAX_BUCKET_LEAK_RATE)
886 leak_rate = FC_MAX_BUCKET_LEAK_RATE;
887
888 if (ms_leak_rate > FC_MAX_BUCKET_LEAK_RATE)
889 ms_leak_rate = FC_MAX_BUCKET_LEAK_RATE;
890
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200891 /* Avg queue delay monitoring */
892 avg_delay_ms = get_and_reset_avg_queue_delay();
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200893
Jacob Erlbeck6eeb7c72015-05-06 15:26:08 +0200894 /* Update tag */
895 the_pcu.fc_tag += 1;
896
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200897 LOGP(DBSSGP, LOGL_DEBUG,
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200898 "Sending FLOW CONTROL BVC, Bmax = %d, R = %d, Bmax_MS = %d, "
899 "R_MS = %d, avg_dly = %d\n",
900 bucket_size, leak_rate, ms_bucket_size, ms_leak_rate,
901 avg_delay_ms);
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200902
Jacob Erlbeck6eeb7c72015-05-06 15:26:08 +0200903 return bssgp_tx_fc_bvc(the_pcu.bctx, the_pcu.fc_tag,
Jacob Erlbeck3d62fc52015-04-30 15:01:15 +0200904 bucket_size, leak_rate,
905 ms_bucket_size, ms_leak_rate,
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +0200906 NULL, &avg_delay_ms);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200907}
908
909static void bvc_timeout(void *_priv)
910{
Pau Espin Pedrol5211d9d2019-09-05 16:20:22 +0200911 unsigned long secs;
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200912 if (!the_pcu.bvc_sig_reset) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200913 LOGP(DBSSGP, LOGL_INFO, "Sending reset on BVCI 0\n");
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200914 bssgp_tx_bvc_reset(the_pcu.bctx, 0, BSSGP_CAUSE_OML_INTERV);
Pau Espin Pedrol5211d9d2019-09-05 16:20:22 +0200915 secs = osmo_tdef_get(the_pcu.bts->T_defs_pcu, 2, OSMO_TDEF_S, -1);
916 osmo_timer_schedule(&the_pcu.bvc_timer, secs, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200917 return;
918 }
919
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200920 if (!the_pcu.bvc_reset) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200921 LOGP(DBSSGP, LOGL_INFO, "Sending reset on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200922 the_pcu.bctx->bvci);
923 bssgp_tx_bvc_reset(the_pcu.bctx, the_pcu.bctx->bvci, BSSGP_CAUSE_OML_INTERV);
Pau Espin Pedrol5211d9d2019-09-05 16:20:22 +0200924 secs = osmo_tdef_get(the_pcu.bts->T_defs_pcu, 2, OSMO_TDEF_S, -1);
925 osmo_timer_schedule(&the_pcu.bvc_timer, secs, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200926 return;
927 }
928
Holger Hans Peter Freyther90f08ef2013-07-13 12:45:44 +0200929 if (!the_pcu.bvc_unblocked) {
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200930 LOGP(DBSSGP, LOGL_INFO, "Sending unblock on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200931 the_pcu.bctx->bvci);
932 bssgp_tx_bvc_unblock(the_pcu.bctx);
Pau Espin Pedrol5211d9d2019-09-05 16:20:22 +0200933 secs = osmo_tdef_get(the_pcu.bts->T_defs_pcu, 1, OSMO_TDEF_S, -1);
934 osmo_timer_schedule(&the_pcu.bvc_timer, secs, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200935 return;
936 }
937
938 LOGP(DBSSGP, LOGL_DEBUG, "Sending flow control info on BVCI %d\n",
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +0200939 the_pcu.bctx->bvci);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200940 gprs_bssgp_tx_fc_bvc();
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +0200941 osmo_timer_schedule(&the_pcu.bvc_timer, the_pcu.bts->fc_interval, 0);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +0200942}
943
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200944static int ns_create_nsvc(struct gprs_rlcmac_bts *bts,
945 uint16_t nsei,
946 const struct osmo_sockaddr *local,
947 const struct osmo_sockaddr *remote,
948 const uint16_t *nsvci,
949 uint16_t valid)
Jacob Erlbeckebebad12015-08-17 14:43:52 +0200950{
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200951 int i, rc;
952 uint16_t binds = 0;
953 bool nsvcs = false;
Alexander Couzens290d9032020-09-16 21:52:02 +0200954 struct gprs_ns2_vc *nsvc;
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200955 struct gprs_ns2_vc_bind *bind[PCU_IF_NUM_NSVC] = { };
956
957 if (!valid)
958 return -1;
959
960 for (i = 0; i < PCU_IF_NUM_NSVC; i++) {
961 if (!(valid & (1 << i)))
962 continue;
963
964 if (!gprs_ns2_ip_bind_by_sockaddr(bts->nsi, &local[i])) {
965 rc = gprs_ns2_ip_bind(bts->nsi, &local[i], 0, &bind[i]);
966 if (rc < 0) {
967 LOGP(DBSSGP, LOGL_ERROR, "Failed to bind to %s\n", osmo_sockaddr_to_str(&local[i]));
968 continue;
969 }
970 }
971
972 binds |= 1 << i;
973 }
974
975 if (!binds) {
976 LOGP(DBSSGP, LOGL_ERROR, "Failed to bind to any NS-VC\n");
977 return -1;
978 }
Jacob Erlbeckebebad12015-08-17 14:43:52 +0200979
Vadim Yanitskiy974cc7b2020-10-10 06:00:05 +0700980 bts->nse = gprs_ns2_nse_by_nsei(bts->nsi, nsei);
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200981 if (!bts->nse)
982 bts->nse = gprs_ns2_create_nse(bts->nsi, nsei);
Vadim Yanitskiy974cc7b2020-10-10 06:00:05 +0700983
Vadim Yanitskiy974cc7b2020-10-10 06:00:05 +0700984 if (!bts->nse) {
985 LOGP(DBSSGP, LOGL_ERROR, "Failed to create NSE\n");
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200986 gprs_ns2_free_binds(bts->nsi);
Vadim Yanitskiy974cc7b2020-10-10 06:00:05 +0700987 return 1;
988 }
989
Alexander Couzens5bece2a2020-10-12 02:27:22 +0200990 for (i = 0; i < PCU_IF_NUM_NSVC; i++) {
991 if (!(binds & (1 << i)))
992 continue;
993
994 /* FIXME: for SNS we just use the first successful NS-VC instead of all for the initial connect */
995 if (bts->gb_dialect_sns) {
996 rc = gprs_ns2_ip_connect_sns(bind[i], &remote[i], nsei);
997 if (!rc)
998 return rc;
999 else
1000 LOGP(DBSSGP, LOGL_ERROR, "Failed to connect to (SNS) towards SGSN %s!\n", osmo_sockaddr_to_str(&remote[i]));
1001 } else {
1002 nsvc = gprs_ns2_ip_connect(bind[i], &remote[i], bts->nse, nsvci[i]);
1003 if (nsvc)
1004 nsvcs = true;
1005 else
1006 LOGP(DBSSGP, LOGL_ERROR, "Failed to connect to towards SGSN %s!\n", osmo_sockaddr_to_str(&remote[i]));
1007 }
Jacob Erlbeckebebad12015-08-17 14:43:52 +02001008 }
1009
Alexander Couzens5bece2a2020-10-12 02:27:22 +02001010 return nsvcs ? 0 : -1;
1011}
1012
1013struct nsvc_cb {
1014 const struct osmo_sockaddr *local;
1015 const struct osmo_sockaddr *remote;
1016 const uint16_t *nsvci;
1017 /* [in] bitmask of valid nsvc in local/remote */
1018 uint16_t valid;
1019 /* [out] bitmask of found nsvcs */
1020 uint16_t found;
1021};
1022
1023static int ns_conf_vc_cb(struct gprs_ns2_vc *nsvc, void *ctx)
1024{
1025 struct nsvc_cb *data = (struct nsvc_cb *) ctx;
1026
1027 for (unsigned int i = 0; i < PCU_IF_NUM_NSVC; i++) {
1028 if (!(data->valid & (1 << i)))
1029 continue;
1030 if (data->found & (1 << i))
1031 continue;
1032
1033 if (gprs_ns2_ip_vc_equal(nsvc, &data->local[i],
1034 &data->remote[i],
1035 data->nsvci[i])) {
1036 data->found |= 1 << i;
1037 return 0;
1038 }
1039 }
1040
1041 /* Found an extra nsvc */
1042 LOGP(DBSSGP, LOGL_DEBUG, " Removing NSVC %s\n", gprs_ns2_ll_str(nsvc));
1043 gprs_ns2_free_nsvc(nsvc);
1044
1045 return 0;
1046}
1047
1048int gprs_ns_config(struct gprs_rlcmac_bts *bts, uint16_t nsei,
1049 const struct osmo_sockaddr *local,
1050 const struct osmo_sockaddr *remote,
1051 uint16_t *nsvci, uint16_t valid)
1052{
1053 int rc = 0;
1054 if (!bts->nse) {
1055 /* there shouldn't any previous state. */
1056 gprs_ns2_free_nses(bts->nsi);
1057 gprs_ns2_free_binds(bts->nsi);
1058 rc = ns_create_nsvc(bts, nsei, local, remote, nsvci, valid);
1059 } else if (nsei != gprs_ns2_nse_nsei(bts->nse)) {
1060 /* the NSEI has changed */
1061 gprs_ns2_free_nses(bts->nsi);
1062 gprs_ns2_free_binds(bts->nsi);
1063 rc = ns_create_nsvc(bts, nsei, local, remote, nsvci, valid);
1064 } else if (bts->gb_dialect_sns) {
1065 /* SNS: check if the initial nsvc is the same, if not recreate it */
1066 const struct osmo_sockaddr *initial = gprs_ns2_nse_sns_remote(bts->nse);
1067 for (unsigned int i = 0; i < PCU_IF_NUM_NSVC; i++) {
1068 if (!(valid & (1 << i)))
1069 continue;
1070
1071 /* found the initial - everything should be fine */
1072 if (!osmo_sockaddr_cmp(initial, &remote[i]))
1073 return 0;
1074 }
1075
1076 gprs_ns2_free_nses(bts->nsi);
1077 gprs_ns2_free_binds(bts->nsi);
1078 rc = ns_create_nsvc(bts, nsei, local, remote, nsvci, valid);
Alexander Couzens290d9032020-09-16 21:52:02 +02001079 } else {
Alexander Couzens5bece2a2020-10-12 02:27:22 +02001080 /* check if all NSVC are still the same. */
1081 struct nsvc_cb data = {
1082 .local = &local[0],
1083 .remote = &remote[0],
1084 .nsvci = &nsvci[0],
1085 .valid = valid,
1086 .found = 0,
1087 };
1088
1089 /* search the current active nsvcs */
1090 gprs_ns2_nse_foreach_nsvc(bts->nse, &ns_conf_vc_cb, &data);
1091
1092 /* we found all our valid nsvcs and might have removed all other nsvcs */
1093 if (valid == data.found)
1094 return 0;
1095
1096 /* remove all found nsvcs from the valid field */
1097 valid &= ~data.found;
1098 rc = ns_create_nsvc(bts, nsei, local, remote, nsvci, valid);
Alexander Couzens290d9032020-09-16 21:52:02 +02001099 }
1100
1101 if (rc)
1102 LOGP(DBSSGP, LOGL_ERROR, "Failed to connect!\n");
1103
1104 return rc;
Jacob Erlbeckebebad12015-08-17 14:43:52 +02001105}
1106
Alexander Couzens290d9032020-09-16 21:52:02 +02001107struct gprs_bssgp_pcu *gprs_bssgp_init(
1108 struct gprs_rlcmac_bts *bts,
1109 uint16_t nsei, uint16_t bvci,
1110 uint16_t mcc, uint16_t mnc, bool mnc_3_digits,
1111 uint16_t lac, uint16_t rac, uint16_t cell_id)
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001112{
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001113
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +02001114 /* if already created... return the current address */
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +02001115 if (the_pcu.bctx)
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +02001116 return &the_pcu;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001117
Holger Hans Peter Freytherb67a8a32013-07-28 18:55:14 +02001118 the_pcu.bts = bts;
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +02001119 the_pcu.bctx = btsctx_alloc(bvci, nsei);
1120 if (!the_pcu.bctx) {
Andreas Eversberg0e403092012-07-06 11:04:57 +02001121 LOGP(DBSSGP, LOGL_ERROR, "Failed to create BSSGP context\n");
Alexander Couzens290d9032020-09-16 21:52:02 +02001122 the_pcu.bts->nse = NULL;
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +02001123 return NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001124 }
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +02001125 the_pcu.bctx->ra_id.mcc = spoof_mcc ? : mcc;
Neels Hofmeyrbdc55fa2018-02-21 00:39:07 +01001126 if (spoof_mnc) {
1127 the_pcu.bctx->ra_id.mnc = spoof_mnc;
1128 the_pcu.bctx->ra_id.mnc_3_digits = spoof_mnc_3_digits;
1129 } else {
1130 the_pcu.bctx->ra_id.mnc = mnc;
1131 the_pcu.bctx->ra_id.mnc_3_digits = mnc_3_digits;
1132 }
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +02001133 the_pcu.bctx->ra_id.lac = lac;
1134 the_pcu.bctx->ra_id.rac = rac;
1135 the_pcu.bctx->cell_id = cell_id;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001136
Alexander Couzens290d9032020-09-16 21:52:02 +02001137 osmo_timer_setup(&the_pcu.bvc_timer, bvc_timeout, bts);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +02001138
Holger Hans Peter Freythere8d9a5f2013-07-28 19:11:20 +02001139 return &the_pcu;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001140}
1141
Alexander Couzens290d9032020-09-16 21:52:02 +02001142void gprs_bssgp_destroy(struct gprs_rlcmac_bts *bts)
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001143{
Holger Hans Peter Freythered70cb72013-07-13 12:53:46 +02001144 osmo_timer_del(&the_pcu.bvc_timer);
Andreas Eversbergcd8a83a2012-09-23 06:41:21 +02001145
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001146 /* FIXME: blocking... */
Holger Hans Peter Freyther40bd0c42013-07-13 12:58:20 +02001147 the_pcu.nsvc_unblocked = 0;
1148 the_pcu.bvc_sig_reset = 0;
1149 the_pcu.bvc_reset = 0;
Pau Espin Pedrol3f064f52019-12-10 17:09:51 +01001150 the_pcu.bvc_unblocked = 0;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001151
Vadim Yanitskiy0bf622e2019-11-09 01:57:17 +07001152 bssgp_bvc_ctx_free(the_pcu.bctx);
Jacob Erlbeckc362df22016-01-20 22:02:19 +01001153 the_pcu.bctx = NULL;
Alexander Couzens290d9032020-09-16 21:52:02 +02001154
1155 gprs_ns2_free(bts->nsi);
1156 bts->nsi = NULL;
1157 bts->nse = NULL;
Andreas Eversbergbf5a0f62012-07-06 08:58:22 +02001158}
1159
Holger Hans Peter Freyther90692f92013-07-13 12:51:16 +02001160struct bssgp_bvc_ctx *gprs_bssgp_pcu_current_bctx(void)
1161{
1162 return the_pcu.bctx;
1163}
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +02001164
Jacob Erlbeck2db0f082015-09-07 18:49:00 +02001165void gprs_bssgp_update_frames_sent()
1166{
1167 the_pcu.queue_frames_sent += 1;
1168}
1169
1170void gprs_bssgp_update_bytes_received(unsigned bytes_recv, unsigned frames_recv)
1171{
1172 the_pcu.queue_bytes_recv += bytes_recv;
1173 the_pcu.queue_frames_recv += frames_recv;
1174}
1175
Pau Espin Pedrol1de68732020-03-11 14:04:52 +01001176void gprs_bssgp_update_queue_delay(const struct timespec *tv_recv,
1177 const struct timespec *tv_now)
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +02001178{
Pau Espin Pedrol1de68732020-03-11 14:04:52 +01001179 struct timespec *delay_sum = &the_pcu.queue_delay_sum;
1180 struct timespec tv_delay;
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +02001181
Pau Espin Pedrol1de68732020-03-11 14:04:52 +01001182 timespecsub(tv_now, tv_recv, &tv_delay);
1183 timespecadd(delay_sum, &tv_delay, delay_sum);
Jacob Erlbeck6e4ccec2015-05-06 14:24:36 +02001184
1185 the_pcu.queue_delay_count += 1;
1186}