blob: a8e646b4bf33a305723b90a4ea30d79b0979827c [file] [log] [blame]
Alexander Couzens6a161492020-07-12 13:45:50 +02001/*! \file gprs_ns2.c
2 * GPRS Networks Service (NS) messages on the Gb interface.
3 * 3GPP TS 08.16 version 8.0.1 Release 1999 / ETSI TS 101 299 V8.0.1 (2002-05)
4 * as well as its successor 3GPP TS 48.016 */
5
6/* (C) 2009-2018 by Harald Welte <laforge@gnumonks.org>
7 * (C) 2016-2017,2020 sysmocom - s.f.m.c. GmbH
8 * Author: Alexander Couzens <lynxis@fe80.eu>
9 *
10 *
11 * All Rights Reserved
12 *
13 * SPDX-License-Identifier: GPL-2.0+
14 *
15 * This program is free software; you can redistribute it and/or modify
16 * it under the terms of the GNU General Public License as published by
17 * the Free Software Foundation; either version 2 of the License, or
18 * (at your option) any later version.
19 *
20 * This program is distributed in the hope that it will be useful,
21 * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * GNU General Public License for more details.
24 *
25 * You should have received a copy of the GNU General Public License
26 * along with this program. If not, see <http://www.gnu.org/licenses/>.
27 *
28 */
29
30/*! \addtogroup libgb
31 * @{
32 *
33 * GPRS Networks Service (NS) messages on the Gb interface
34 * 3GPP TS 08.16 version 8.0.1 Release 1999 / ETSI TS 101 299 V8.0.1 (2002-05)
35 *
36 * Some introduction into NS: NS is used typically on top of frame relay,
37 * but in the ip.access world it is encapsulated in UDP packets. It serves
38 * as an intermediate shim betwen BSSGP and the underlying medium. It doesn't
39 * do much, apart from providing congestion notification and status indication.
40 *
41 * Terms:
42 *
43 * NS Network Service
44 * NSVC NS Virtual Connection
45 * NSEI NS Entity Identifier
46 * NSVL NS Virtual Link
47 * NSVLI NS Virtual Link Identifier
48 * BVC BSSGP Virtual Connection
49 * BVCI BSSGP Virtual Connection Identifier
50 * NSVCG NS Virtual Connection Goup
51 * Blocked NS-VC cannot be used for user traffic
52 * Alive Ability of a NS-VC to provide communication
53 *
54 * There can be multiple BSSGP virtual connections over one (group of) NSVC's. BSSGP will
55 * therefore identify the BSSGP virtual connection by a BVCI passed down to NS.
56 * NS then has to figure out which NSVC's are responsible for this BVCI.
57 * Those mappings are administratively configured.
58 *
59 * This implementation has the following limitations:
Alexander Couzens6a161492020-07-12 13:45:50 +020060 * - NSVCI 65535 and 65534 are reserved for internal use
Alexander Couzens6a161492020-07-12 13:45:50 +020061 * - There are no BLOCK and UNBLOCK timers (yet?)
62 *
63 * \file gprs_ns2.c */
64
65#include <stdlib.h>
66#include <unistd.h>
67#include <errno.h>
68#include <stdint.h>
69
70#include <sys/types.h>
71#include <sys/socket.h>
72#include <arpa/inet.h>
73
74#include <osmocom/core/fsm.h>
Daniel Willmann751977b2020-12-02 18:59:44 +010075#include <osmocom/core/logging.h>
Alexander Couzens6a161492020-07-12 13:45:50 +020076#include <osmocom/core/msgb.h>
77#include <osmocom/core/rate_ctr.h>
78#include <osmocom/core/socket.h>
79#include <osmocom/core/sockaddr_str.h>
80#include <osmocom/core/stats.h>
81#include <osmocom/core/stat_item.h>
82#include <osmocom/core/talloc.h>
83#include <osmocom/gprs/gprs_msgb.h>
84#include <osmocom/gsm/prim.h>
85#include <osmocom/gsm/tlv.h>
86
87#include "gprs_ns2_internal.h"
88
89#define ns_set_state(ns_, st_) ns_set_state_with_log(ns_, st_, false, __FILE__, __LINE__)
90#define ns_set_remote_state(ns_, st_) ns_set_state_with_log(ns_, st_, true, __FILE__, __LINE__)
91#define ns_mark_blocked(ns_) ns_set_state(ns_, (ns_)->state | NSE_S_BLOCKED)
92#define ns_mark_unblocked(ns_) ns_set_state(ns_, (ns_)->state & (~NSE_S_BLOCKED));
93#define ns_mark_alive(ns_) ns_set_state(ns_, (ns_)->state | NSE_S_ALIVE)
94#define ns_mark_dead(ns_) ns_set_state(ns_, (ns_)->state & (~NSE_S_ALIVE));
95
96/* HACK: The NS_IE_IP_ADDR does not follow any known TLV rules.
97 * Since it's a hard ABI break to implement 16 bit tag with fixed length entries to workaround it,
98 * the parser will be called with ns_att_tlvdef1 and if it's failed with ns_att_tlvdef2.
99 * The TLV parser depends on 8bit tag in many places.
100 * The NS_IE_IP_ADDR is only valid for SNS_ACK SNS_ADD and SNS_DELETE.
101 */
102static const struct tlv_definition ns_att_tlvdef1 = {
103 .def = {
104 [NS_IE_CAUSE] = { TLV_TYPE_TvLV, 0 },
105 [NS_IE_VCI] = { TLV_TYPE_TvLV, 0 },
106 [NS_IE_PDU] = { TLV_TYPE_TvLV, 0 },
107 [NS_IE_BVCI] = { TLV_TYPE_TvLV, 0 },
108 [NS_IE_NSEI] = { TLV_TYPE_TvLV, 0 },
109 [NS_IE_IPv4_LIST] = { TLV_TYPE_TvLV, 0 },
110 [NS_IE_IPv6_LIST] = { TLV_TYPE_TvLV, 0 },
111 [NS_IE_MAX_NR_NSVC] = { TLV_TYPE_FIXED, 2 },
112 [NS_IE_IPv4_EP_NR] = { TLV_TYPE_FIXED, 2 },
113 [NS_IE_IPv6_EP_NR] = { TLV_TYPE_FIXED, 2 },
114 [NS_IE_RESET_FLAG] = { TLV_TYPE_TV, 0 },
115 /* NS_IE_IP_ADDR in the IPv4 version */
116 [NS_IE_IP_ADDR] = { TLV_TYPE_FIXED, 5 },
117 },
118};
119
120static const struct tlv_definition ns_att_tlvdef2 = {
121 .def = {
122 [NS_IE_CAUSE] = { TLV_TYPE_TvLV, 0 },
123 [NS_IE_VCI] = { TLV_TYPE_TvLV, 0 },
124 [NS_IE_PDU] = { TLV_TYPE_TvLV, 0 },
125 [NS_IE_BVCI] = { TLV_TYPE_TvLV, 0 },
126 [NS_IE_NSEI] = { TLV_TYPE_TvLV, 0 },
127 [NS_IE_IPv4_LIST] = { TLV_TYPE_TvLV, 0 },
128 [NS_IE_IPv6_LIST] = { TLV_TYPE_TvLV, 0 },
129 [NS_IE_MAX_NR_NSVC] = { TLV_TYPE_FIXED, 2 },
130 [NS_IE_IPv4_EP_NR] = { TLV_TYPE_FIXED, 2 },
131 [NS_IE_IPv6_EP_NR] = { TLV_TYPE_FIXED, 2 },
132 [NS_IE_RESET_FLAG] = { TLV_TYPE_TV, 0 },
133 /* NS_IE_IP_ADDR in the IPv6 version */
134 [NS_IE_IP_ADDR] = { TLV_TYPE_FIXED, 17 },
135 },
136};
137
138
139/* Section 10.3.2, Table 13 */
Alexander Couzensb3b837c2020-10-27 15:12:25 +0100140const struct value_string gprs_ns2_cause_strs[] = {
Alexander Couzens6a161492020-07-12 13:45:50 +0200141 { NS_CAUSE_TRANSIT_FAIL, "Transit network failure" },
142 { NS_CAUSE_OM_INTERVENTION, "O&M intervention" },
143 { NS_CAUSE_EQUIP_FAIL, "Equipment failure" },
144 { NS_CAUSE_NSVC_BLOCKED, "NS-VC blocked" },
145 { NS_CAUSE_NSVC_UNKNOWN, "NS-VC unknown" },
146 { NS_CAUSE_BVCI_UNKNOWN, "BVCI unknown" },
147 { NS_CAUSE_SEM_INCORR_PDU, "Semantically incorrect PDU" },
148 { NS_CAUSE_PDU_INCOMP_PSTATE, "PDU not compatible with protocol state" },
149 { NS_CAUSE_PROTO_ERR_UNSPEC, "Protocol error, unspecified" },
150 { NS_CAUSE_INVAL_ESSENT_IE, "Invalid essential IE" },
151 { NS_CAUSE_MISSING_ESSENT_IE, "Missing essential IE" },
152 { NS_CAUSE_INVAL_NR_IPv4_EP, "Invalid Number of IPv4 Endpoints" },
153 { NS_CAUSE_INVAL_NR_IPv6_EP, "Invalid Number of IPv6 Endpoints" },
154 { NS_CAUSE_INVAL_NR_NS_VC, "Invalid Number of NS-VCs" },
155 { NS_CAUSE_INVAL_WEIGH, "Invalid Weights" },
156 { NS_CAUSE_UNKN_IP_EP, "Unknown IP Endpoint" },
157 { NS_CAUSE_UNKN_IP_ADDR, "Unknown IP Address" },
158 { NS_CAUSE_UNKN_IP_TEST_FAILED, "IP Test Failed" },
159 { 0, NULL }
160};
161
Alexander Couzens6a161492020-07-12 13:45:50 +0200162static const struct rate_ctr_desc nsvc_ctr_description[] = {
Harald Welte3d5eaee2021-01-30 21:33:02 +0100163 [NS_CTR_PKTS_IN] = { "packets:in", "Packets at NS Level ( In)" },
164 [NS_CTR_PKTS_OUT] = { "packets:out", "Packets at NS Level (Out)" },
Harald Weltef22ae5a2021-01-30 22:01:28 +0100165 [NS_CTR_PKTS_OUT_DROP] = { "packets:out:drop", "Dropped Packets (Out)" },
Harald Welte3d5eaee2021-01-30 21:33:02 +0100166 [NS_CTR_BYTES_IN] = { "bytes:in", "Bytes at NS Level ( In)" },
167 [NS_CTR_BYTES_OUT] = { "bytes:out", "Bytes at NS Level (Out)" },
Harald Weltef22ae5a2021-01-30 22:01:28 +0100168 [NS_CTR_BYTES_OUT_DROP] = { "bytes:out:drop", "Dropped Bytes (Out)" },
Harald Welte3d5eaee2021-01-30 21:33:02 +0100169 [NS_CTR_BLOCKED] = { "blocked", "NS-VC Block count " },
Harald Welteb40bf8b2021-01-30 22:43:01 +0100170 [NS_CTR_UNBLOCKED] = { "unblocked", "NS-VC Unblock count " },
Harald Welte3d5eaee2021-01-30 21:33:02 +0100171 [NS_CTR_DEAD] = { "dead", "NS-VC gone dead count " },
172 [NS_CTR_REPLACED] = { "replaced", "NS-VC replaced other count" },
173 [NS_CTR_NSEI_CHG] = { "nsei-chg", "NS-VC changed NSEI count " },
174 [NS_CTR_INV_VCI] = { "inv-nsvci", "NS-VCI was invalid count " },
175 [NS_CTR_INV_NSEI] = { "inv-nsei", "NSEI was invalid count " },
176 [NS_CTR_LOST_ALIVE] = { "lost:alive", "ALIVE ACK missing count " },
177 [NS_CTR_LOST_RESET] = { "lost:reset", "RESET ACK missing count " },
Alexander Couzens6a161492020-07-12 13:45:50 +0200178};
179
180static const struct rate_ctr_group_desc nsvc_ctrg_desc = {
181 .group_name_prefix = "ns:nsvc",
182 .group_description = "NSVC Peer Statistics",
183 .num_ctr = ARRAY_SIZE(nsvc_ctr_description),
184 .ctr_desc = nsvc_ctr_description,
185 .class_id = OSMO_STATS_CLASS_PEER,
186};
187
188
189static const struct osmo_stat_item_desc nsvc_stat_description[] = {
Harald Welte3d5eaee2021-01-30 21:33:02 +0100190 [NS_STAT_ALIVE_DELAY] = { "alive.delay", "ALIVE response time ", "ms", 16, 0 },
Alexander Couzens6a161492020-07-12 13:45:50 +0200191};
192
193static const struct osmo_stat_item_group_desc nsvc_statg_desc = {
194 .group_name_prefix = "ns.nsvc",
195 .group_description = "NSVC Peer Statistics",
196 .num_items = ARRAY_SIZE(nsvc_stat_description),
197 .item_desc = nsvc_stat_description,
198 .class_id = OSMO_STATS_CLASS_PEER,
199};
200
Harald Welte76346072021-01-31 11:54:02 +0100201const struct osmo_stat_item_desc nsbind_stat_description[] = {
202 [NS2_BIND_STAT_BACKLOG_LEN] = { "tx_backlog_length", "Transmit backlog length", "packets", 16, 0 },
203};
204
205static const struct osmo_stat_item_group_desc nsbind_statg_desc = {
206 .group_name_prefix = "ns.bind",
207 .group_description = "NS Bind Statistics",
208 .num_items = ARRAY_SIZE(nsbind_stat_description),
209 .item_desc = nsbind_stat_description,
210 .class_id = OSMO_STATS_CLASS_PEER,
211};
212
Alexander Couzens2498f1d2020-10-27 01:09:01 +0100213const struct value_string gprs_ns2_aff_cause_prim_strs[] = {
Alexander Couzens138b96f2021-01-25 16:23:29 +0100214 { GPRS_NS2_AFF_CAUSE_VC_FAILURE, "NSVC failure" },
215 { GPRS_NS2_AFF_CAUSE_VC_RECOVERY, "NSVC recovery" },
216 { GPRS_NS2_AFF_CAUSE_FAILURE, "NSE failure" },
217 { GPRS_NS2_AFF_CAUSE_RECOVERY, "NSE recovery" },
218 { GPRS_NS2_AFF_CAUSE_SNS_CONFIGURED, "NSE SNS configured" },
219 { GPRS_NS2_AFF_CAUSE_SNS_FAILURE, "NSE SNS failure" },
Alexander Couzensb2de5462021-02-16 16:24:30 +0100220 { GPRS_NS2_AFF_CAUSE_SNS_NO_ENDPOINTS, "NSE SNS no endpoints"},
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100221 { GPRS_NS2_AFF_CAUSE_MTU_CHANGE, "NSE MTU changed" },
Alexander Couzens2498f1d2020-10-27 01:09:01 +0100222 { 0, NULL }
223};
224
Alexander Couzens0ab028c2020-11-04 02:41:44 +0100225const struct value_string gprs_ns2_prim_strs[] = {
Alexander Couzens138b96f2021-01-25 16:23:29 +0100226 { GPRS_NS2_PRIM_UNIT_DATA, "UNIT DATA" },
227 { GPRS_NS2_PRIM_CONGESTION, "CONGESTION" },
228 { GPRS_NS2_PRIM_STATUS, "STATUS" },
Alexander Couzens2498f1d2020-10-27 01:09:01 +0100229 { 0, NULL }
230};
231
Harald Weltea24e7ee2020-11-29 17:38:48 +0100232const struct value_string gprs_ns2_lltype_strs[] = {
233 { GPRS_NS2_LL_UDP, "UDP" },
234 { GPRS_NS2_LL_FR_GRE, "FR_GRE" },
235 { GPRS_NS2_LL_FR, "FR" },
236 { 0, NULL }
237};
238
Harald Welte5bef2cc2020-09-18 22:33:24 +0200239/*! string-format a given NS-VC into a user-supplied buffer.
240 * \param[in] buf user-allocated output buffer
241 * \param[in] buf_len size of user-allocated output buffer in bytes
242 * \param[in] nsvc NS-VC to be string-formatted
243 * \return pointer to buf on success; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200244char *gprs_ns2_ll_str_buf(char *buf, size_t buf_len, struct gprs_ns2_vc *nsvc)
245{
Alexander Couzens9a4cf272020-10-11 20:48:04 +0200246 const struct osmo_sockaddr *local;
247 const struct osmo_sockaddr *remote;
Alexander Couzens6a161492020-07-12 13:45:50 +0200248 struct osmo_sockaddr_str local_str;
249 struct osmo_sockaddr_str remote_str;
250
251 if (!buf_len)
Harald Welte92ad0292020-09-18 22:34:24 +0200252 return NULL;
Alexander Couzens6a161492020-07-12 13:45:50 +0200253
Alexander Couzensaac90162020-11-19 02:44:04 +0100254 switch (nsvc->nse->ll) {
Alexander Couzens24a14ac2020-11-19 02:34:49 +0100255 case GPRS_NS2_LL_UDP:
Alexander Couzens6a161492020-07-12 13:45:50 +0200256 if (!gprs_ns2_is_ip_bind(nsvc->bind)) {
257 buf[0] = '\0';
258 return buf;
259 }
260
261 local = gprs_ns2_ip_bind_sockaddr(nsvc->bind);
Alexander Couzensc4229a42020-10-11 20:58:04 +0200262 remote = gprs_ns2_ip_vc_remote(nsvc);
Alexander Couzens6a161492020-07-12 13:45:50 +0200263 if (osmo_sockaddr_str_from_sockaddr(&local_str, &local->u.sas))
264 strcpy(local_str.ip, "invalid");
265 if (osmo_sockaddr_str_from_sockaddr(&remote_str, &remote->u.sas))
266 strcpy(remote_str.ip, "invalid");
267
268 if (nsvc->nsvci_is_valid)
269 snprintf(buf, buf_len, "udp)[%s]:%u<%u>[%s]:%u",
270 local_str.ip, local_str.port,
271 nsvc->nsvci,
272 remote_str.ip, remote_str.port);
273 else
274 snprintf(buf, buf_len, "udp)[%s]:%u<>[%s]:%u",
275 local_str.ip, local_str.port,
276 remote_str.ip, remote_str.port);
277 break;
Alexander Couzens24a14ac2020-11-19 02:34:49 +0100278 case GPRS_NS2_LL_FR_GRE:
Alexander Couzens6a161492020-07-12 13:45:50 +0200279 snprintf(buf, buf_len, "frgre)");
280 break;
Alexander Couzens24a14ac2020-11-19 02:34:49 +0100281 case GPRS_NS2_LL_FR:
Alexander Couzens841817e2020-11-19 00:41:29 +0100282 snprintf(buf, buf_len, "fr)netif: %s dlci: %u", gprs_ns2_fr_bind_netif(nsvc->bind),
283 gprs_ns2_fr_nsvc_dlci(nsvc));
284 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200285 default:
Harald Welte6188e002020-12-01 17:20:07 +0100286 snprintf(buf, buf_len, "unknown)");
Alexander Couzens6a161492020-07-12 13:45:50 +0200287 break;
288 }
289
290 buf[buf_len - 1] = '\0';
291
292 return buf;
293}
294
295/* udp is the longest: udp)[IP6]:65536<65536>[IP6]:65536 */
296#define NS2_LL_MAX_STR 4+2*(INET6_ADDRSTRLEN+9)+8
297
Harald Welte5bef2cc2020-09-18 22:33:24 +0200298/*! string-format a given NS-VC to a thread-local static buffer.
299 * \param[in] nsvc NS-VC to be string-formatted
300 * \return pointer to the string on success; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200301const char *gprs_ns2_ll_str(struct gprs_ns2_vc *nsvc)
302{
303 static __thread char buf[NS2_LL_MAX_STR];
304 return gprs_ns2_ll_str_buf(buf, sizeof(buf), nsvc);
305}
306
Harald Welte5bef2cc2020-09-18 22:33:24 +0200307/*! string-format a given NS-VC to a dynamically allocated string.
308 * \param[in] ctx talloc context from which to allocate
309 * \param[in] nsvc NS-VC to be string-formatted
310 * \return pointer to the string on success; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200311char *gprs_ns2_ll_str_c(const void *ctx, struct gprs_ns2_vc *nsvc)
312{
313 char *buf = talloc_size(ctx, NS2_LL_MAX_STR);
314 if (!buf)
315 return buf;
316 return gprs_ns2_ll_str_buf(buf, NS2_LL_MAX_STR, nsvc);
317}
318
Daniel Willmannf1286542020-11-03 23:03:33 +0100319/*! Return the current state name of a given NS-VC to a thread-local static buffer.
320 * \param[in] nsvc NS-VC to return the state of
321 * \return pointer to the string on success; NULL on error */
322const char *gprs_ns2_nsvc_state_name(struct gprs_ns2_vc *nsvc)
323{
324 return osmo_fsm_inst_state_name(nsvc->fi);
325}
326
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100327/* select a signalling NSVC and respect sig_counter
328 * param[out] reset_counter - all counter has to be resetted to their signal weight
329 * return the chosen nsvc or NULL
330 */
331static struct gprs_ns2_vc *ns2_load_sharing_signal(struct gprs_ns2_nse *nse)
332{
333 struct gprs_ns2_vc *nsvc = NULL, *last = NULL, *tmp;
334
335 llist_for_each_entry(tmp, &nse->nsvc, list) {
336 if (tmp->sig_weight == 0)
337 continue;
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100338 if (!ns2_vc_is_unblocked(tmp))
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100339 continue;
340 if (tmp->sig_counter == 0) {
341 last = tmp;
342 continue;
343 }
344
345 tmp->sig_counter--;
346 nsvc = tmp;
347 break;
348 }
349
350 /* all counter were zero, but there are valid nsvc */
351 if (!nsvc && last) {
352 llist_for_each_entry(tmp, &nse->nsvc, list) {
353 tmp->sig_counter = tmp->sig_weight;
354 }
355
356 last->sig_counter--;
357 return last;
358 } else {
359 return nsvc;
360 }
361}
362
363/* 4.4.1 Load Sharing function for the Frame Relay Sub-Network */
Alexander Couzens9e81a322021-02-16 17:36:25 +0100364static struct gprs_ns2_vc *ns2_load_sharing_modulo(
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100365 struct gprs_ns2_nse *nse,
366 uint16_t bvci,
367 uint32_t load_selector)
368{
369 struct gprs_ns2_vc *tmp;
Alexander Couzens265a5eb2021-02-02 11:26:17 +0100370 uint32_t mod;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100371 uint32_t i = 0;
372
Alexander Couzens265a5eb2021-02-02 11:26:17 +0100373 if (nse->nsvc_count == 0)
374 return NULL;
375
376 mod = (bvci + load_selector) % nse->nsvc_count;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100377 llist_for_each_entry(tmp, &nse->nsvc, list) {
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100378 if (!ns2_vc_is_unblocked(tmp))
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100379 continue;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100380 if (i == mod)
381 return tmp;
382 i++;
383 }
384
385 return NULL;
386}
387
Alexander Couzensd8a8d982021-02-15 01:07:45 +0100388/* 4.4.2 Load Sharing function for the IP Sub-Network
389 *
390 * Implement a simple approach for UDP load sharing of data weight based on the modulo of the lsp.
391 *
392 * E.g. 3 NSVC: 1st weight 5, 2nd weight 3, 3rd weight 1, lsp = 3.
393 * sum all weights = 9
394 * target_weight = lsp % sum = 3
395 *
396 * 1st NSVC will be the target for 0-4
397 * 2nd NSVC will be the target for 5-7
398 * 3rd NSVC will be the target for 8
399 *
400 * The 1st NSVC will be used.
401 * E.g. lsp = 7. The 2nd NSVC will used.
402 */
403static struct gprs_ns2_vc *ns2_load_sharing_weight_modulo(
404 struct gprs_ns2_nse *nse,
405 uint16_t bvci,
406 uint32_t load_selector)
407{
408 struct gprs_ns2_vc *tmp;
409 uint32_t mod;
410 uint32_t i = 0;
411
412 if (nse->nsvc_count == 0)
413 return NULL;
414
415 mod = (bvci + load_selector) % nse->sum_data_weight;
416 llist_for_each_entry(tmp, &nse->nsvc, list) {
Daniel Willmannc7f547f2021-06-29 13:18:42 +0200417 if (tmp->data_weight == 0)
418 continue;
Alexander Couzensd8a8d982021-02-15 01:07:45 +0100419 if (!ns2_vc_is_unblocked(tmp))
420 continue;
421 if (i == mod || mod < i + tmp->data_weight)
422 return tmp;
423 i += tmp->data_weight;
424 }
425
426 return NULL;
427}
428
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100429/* pick the first available data NSVC - no load sharing */
430struct gprs_ns2_vc *ns2_load_sharing_first(struct gprs_ns2_nse *nse)
431{
432 struct gprs_ns2_vc *nsvc = NULL, *tmp;
433
434 llist_for_each_entry(tmp, &nse->nsvc, list) {
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100435 if (!ns2_vc_is_unblocked(tmp))
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100436 continue;
437 if (tmp->data_weight == 0)
438 continue;
439
440 nsvc = tmp;
441 break;
442 }
443
444 return nsvc;
445}
446
447
448static struct gprs_ns2_vc *ns2_load_sharing(
449 struct gprs_ns2_nse *nse,
450 uint16_t bvci,
451 uint32_t link_selector)
452{
453 struct gprs_ns2_vc *nsvc = NULL;
454
Alexander Couzens8a2a1a42020-12-26 18:00:17 +0100455 switch (nse->ll) {
456 case GPRS_NS2_LL_FR:
Alexander Couzens9e81a322021-02-16 17:36:25 +0100457 nsvc = ns2_load_sharing_modulo(nse, bvci, link_selector);
Alexander Couzens8a2a1a42020-12-26 18:00:17 +0100458 break;
459 case GPRS_NS2_LL_UDP:
460 default:
461 if (bvci == 0) {
462 /* signalling */
463 nsvc = ns2_load_sharing_signal(nse);
464 } else {
465 /* data with load sharing parameter */
Alexander Couzensd8a8d982021-02-15 01:07:45 +0100466 nsvc = ns2_load_sharing_weight_modulo(nse, bvci, link_selector);
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100467 }
Alexander Couzens8a2a1a42020-12-26 18:00:17 +0100468 break;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100469 }
470
471 return nsvc;
472}
473
Harald Welte5bef2cc2020-09-18 22:33:24 +0200474/*! Receive a primitive from the NS User (Gb).
475 * \param[in] nsi NS instance to which the primitive is issued
476 * \param[in] oph The primitive
477 * \return 0 on success; negative on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200478int gprs_ns2_recv_prim(struct gprs_ns2_inst *nsi, struct osmo_prim_hdr *oph)
479{
Alexander Couzens6a161492020-07-12 13:45:50 +0200480 /* TODO: implement resource distribution */
481 /* TODO: check for empty PDUs which can be sent to Request/Confirm
482 * the IP endpoint */
483 struct osmo_gprs_ns2_prim *nsp;
484 struct gprs_ns2_nse *nse = NULL;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100485 struct gprs_ns2_vc *nsvc = NULL;
Alexander Couzens6a161492020-07-12 13:45:50 +0200486 uint16_t bvci, nsei;
487 uint8_t sducontrol = 0;
Alexander Couzens6df11602021-02-14 23:39:40 +0100488 int rc = 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200489
Alexander Couzens6df11602021-02-14 23:39:40 +0100490 if (oph->sap != SAP_NS) {
491 rc = -EINVAL;
492 goto out;
493 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200494
495 nsp = container_of(oph, struct osmo_gprs_ns2_prim, oph);
496
Alexander Couzens6df11602021-02-14 23:39:40 +0100497 if (oph->operation != PRIM_OP_REQUEST || oph->primitive != GPRS_NS2_PRIM_UNIT_DATA) {
498 rc = -EINVAL;
499 goto out;
500 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200501
Alexander Couzens6df11602021-02-14 23:39:40 +0100502 if (!oph->msg) {
503 rc = -EINVAL;
504 goto out;
505 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200506
507 bvci = nsp->bvci;
508 nsei = nsp->nsei;
509
510 nse = gprs_ns2_nse_by_nsei(nsi, nsei);
Alexander Couzens6df11602021-02-14 23:39:40 +0100511 if (!nse) {
512 rc = -EINVAL;
513 goto out;
514 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200515
Alexander Couzens6df11602021-02-14 23:39:40 +0100516 if (!nse->alive) {
517 goto out;
518 }
Alexander Couzens265a5eb2021-02-02 11:26:17 +0100519
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +0100520 nsvc = ns2_load_sharing(nse, bvci, nsp->u.unitdata.link_selector);
Alexander Couzens6a161492020-07-12 13:45:50 +0200521
522 /* TODO: send a status primitive back */
523 if (!nsvc)
Alexander Couzens6df11602021-02-14 23:39:40 +0100524 goto out;
Alexander Couzens6a161492020-07-12 13:45:50 +0200525
Alexander Couzens138b96f2021-01-25 16:23:29 +0100526 if (nsp->u.unitdata.change == GPRS_NS2_ENDPOINT_REQUEST_CHANGE)
Alexander Couzens6a161492020-07-12 13:45:50 +0200527 sducontrol = 1;
Alexander Couzens138b96f2021-01-25 16:23:29 +0100528 else if (nsp->u.unitdata.change == GPRS_NS2_ENDPOINT_CONFIRM_CHANGE)
Alexander Couzens6a161492020-07-12 13:45:50 +0200529 sducontrol = 2;
530
531 return ns2_tx_unit_data(nsvc, bvci, sducontrol, oph->msg);
Alexander Couzens6df11602021-02-14 23:39:40 +0100532
533out:
534 msgb_free(oph->msg);
535 return rc;
Alexander Couzens6a161492020-07-12 13:45:50 +0200536}
537
Harald Welte5bef2cc2020-09-18 22:33:24 +0200538/*! Send a STATUS.ind primitive to the specified NS instance user.
539 * \param[in] nsi NS instance on which we operate
540 * \param[in] nsei NSEI to which the statue relates
541 * \param[in] bvci BVCI to which the status relates
542 * \param[in] cause The cause of the status */
Alexander Couzensbf95f0f2020-10-01 22:56:03 +0200543void ns2_prim_status_ind(struct gprs_ns2_nse *nse,
Daniel Willmann15c09a82020-11-03 23:05:43 +0100544 struct gprs_ns2_vc *nsvc,
Alexander Couzensbf95f0f2020-10-01 22:56:03 +0200545 uint16_t bvci,
Alexander Couzens6a161492020-07-12 13:45:50 +0200546 enum gprs_ns2_affecting_cause cause)
547{
Daniel Willmann15c09a82020-11-03 23:05:43 +0100548 char nsvc_str[NS2_LL_MAX_STR];
Alexander Couzens6a161492020-07-12 13:45:50 +0200549 struct osmo_gprs_ns2_prim nsp = {};
Alexander Couzensbf95f0f2020-10-01 22:56:03 +0200550 nsp.nsei = nse->nsei;
Alexander Couzens6a161492020-07-12 13:45:50 +0200551 nsp.bvci = bvci;
552 nsp.u.status.cause = cause;
Alexander Couzens1c8785d2020-12-17 06:58:53 +0100553 nsp.u.status.transfer = ns2_count_transfer_cap(nse, bvci);
Alexander Couzensda0a2852020-10-01 23:24:07 +0200554 nsp.u.status.first = nse->first;
555 nsp.u.status.persistent = nse->persistent;
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100556 if (nse->mtu < 4)
557 nsp.u.status.mtu = 0;
558 else
559 nsp.u.status.mtu = nse->mtu - 4; /* 1 Byte NS PDU type, 1 Byte NS SDU control, 2 Byte BVCI */
560
Harald Welte86690432021-01-31 16:09:19 +0100561 if (nsvc) {
Daniel Willmann15c09a82020-11-03 23:05:43 +0100562 nsp.u.status.nsvc = gprs_ns2_ll_str_buf(nsvc_str, sizeof(nsvc_str), nsvc);
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100563 LOGNSVC(nsvc, LOGL_NOTICE, "NS-STATUS.ind(bvci=%05u): cause=%s, transfer=%d, first=%d, mtu=%d\n",
Harald Welte86690432021-01-31 16:09:19 +0100564 nsp.bvci, gprs_ns2_aff_cause_prim_str(nsp.u.status.cause),
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100565 nsp.u.status.transfer, nsp.u.status.first, nse->mtu);
Harald Welte86690432021-01-31 16:09:19 +0100566 } else {
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100567 LOGNSE(nse, LOGL_NOTICE, "NS-STATUS.ind(bvci=%05u): cause=%s, transfer=%d, first=%d, mtu=%d\n",
Harald Welte86690432021-01-31 16:09:19 +0100568 nsp.bvci, gprs_ns2_aff_cause_prim_str(nsp.u.status.cause),
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100569 nsp.u.status.transfer, nsp.u.status.first, nse->mtu);
Harald Welte86690432021-01-31 16:09:19 +0100570 }
Daniel Willmann15c09a82020-11-03 23:05:43 +0100571
Harald Welte86690432021-01-31 16:09:19 +0100572 osmo_prim_init(&nsp.oph, SAP_NS, GPRS_NS2_PRIM_STATUS, PRIM_OP_INDICATION, NULL);
Alexander Couzensbf95f0f2020-10-01 22:56:03 +0200573 nse->nsi->cb(&nsp.oph, nse->nsi->cb_data);
Alexander Couzens6a161492020-07-12 13:45:50 +0200574}
575
Harald Welte5bef2cc2020-09-18 22:33:24 +0200576/*! Allocate a NS-VC within the given bind + NSE.
577 * \param[in] bind The 'bind' on which we operate
578 * \param[in] nse The NS Entity on which we operate
579 * \param[in] initiater - if this is an incoming remote (!initiater) or a local outgoing connection (initater)
Harald Welte603f4042020-11-29 17:39:19 +0100580 * \param[in] id - human-readable identifier
Harald Welte5bef2cc2020-09-18 22:33:24 +0200581 * \return newly allocated NS-VC on success; NULL on error */
Alexander Couzensd923cff2020-12-01 01:03:52 +0100582struct gprs_ns2_vc *ns2_vc_alloc(struct gprs_ns2_vc_bind *bind, struct gprs_ns2_nse *nse, bool initiater,
Harald Welte603f4042020-11-29 17:39:19 +0100583 enum gprs_ns2_vc_mode vc_mode, const char *id)
Alexander Couzens6a161492020-07-12 13:45:50 +0200584{
Daniel Willmannbb899052021-01-16 14:02:45 +0100585 /* Sanity check */
586 OSMO_ASSERT(bind->ll == nse->ll);
587
Alexander Couzens6a161492020-07-12 13:45:50 +0200588 struct gprs_ns2_vc *nsvc = talloc_zero(bind, struct gprs_ns2_vc);
589
590 if (!nsvc)
591 return NULL;
592
593 nsvc->bind = bind;
594 nsvc->nse = nse;
Alexander Couzensd923cff2020-12-01 01:03:52 +0100595 nsvc->mode = vc_mode;
Alexander Couzens6a161492020-07-12 13:45:50 +0200596 nsvc->sig_weight = 1;
597 nsvc->data_weight = 1;
598
Harald Welte97ccbf72021-01-31 11:49:19 +0100599 nsvc->ctrg = rate_ctr_group_alloc(nsvc, &nsvc_ctrg_desc, bind->nsi->nsvc_rate_ctr_idx);
Alexander Couzens6a161492020-07-12 13:45:50 +0200600 if (!nsvc->ctrg) {
601 goto err;
602 }
Harald Welte97ccbf72021-01-31 11:49:19 +0100603 nsvc->statg = osmo_stat_item_group_alloc(nsvc, &nsvc_statg_desc, bind->nsi->nsvc_rate_ctr_idx);
Alexander Couzens6a161492020-07-12 13:45:50 +0200604 if (!nsvc->statg)
605 goto err_group;
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100606 if (!ns2_vc_fsm_alloc(nsvc, id, initiater))
Alexander Couzens6a161492020-07-12 13:45:50 +0200607 goto err_statg;
608
Harald Welte97ccbf72021-01-31 11:49:19 +0100609 bind->nsi->nsvc_rate_ctr_idx++;
Alexander Couzens6a161492020-07-12 13:45:50 +0200610
Michael Iedemaa667d852021-06-09 10:04:57 +0000611 rate_ctr_group_set_name(nsvc->ctrg, id);
Pau Espin Pedrol05047b72021-05-31 13:19:13 +0200612 osmo_stat_item_group_set_name(nsvc->statg, id);
613
Alexander Couzensd5cd8c62021-06-15 20:59:03 +0200614 llist_add_tail(&nsvc->list, &nse->nsvc);
615 llist_add_tail(&nsvc->blist, &bind->nsvc);
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100616 ns2_nse_update_mtu(nse);
Alexander Couzens6a161492020-07-12 13:45:50 +0200617
618 return nsvc;
619
620err_statg:
621 osmo_stat_item_group_free(nsvc->statg);
622err_group:
623 rate_ctr_group_free(nsvc->ctrg);
624err:
625 talloc_free(nsvc);
626
627 return NULL;
628}
629
Harald Welte5bef2cc2020-09-18 22:33:24 +0200630/*! Destroy/release given NS-VC.
631 * \param[in] nsvc NS-VC to destroy */
Alexander Couzens6a161492020-07-12 13:45:50 +0200632void gprs_ns2_free_nsvc(struct gprs_ns2_vc *nsvc)
633{
634 if (!nsvc)
635 return;
636
Alexander Couzens138b96f2021-01-25 16:23:29 +0100637 ns2_prim_status_ind(nsvc->nse, nsvc, 0, GPRS_NS2_AFF_CAUSE_VC_FAILURE);
Alexander Couzens6a161492020-07-12 13:45:50 +0200638
639 llist_del(&nsvc->list);
640 llist_del(&nsvc->blist);
641
642 /* notify nse this nsvc is unavailable */
643 ns2_nse_notify_unblocked(nsvc, false);
644
645 /* check if sns is using this VC */
Alexander Couzensbe7cecc2021-02-03 18:25:27 +0100646 ns2_sns_replace_nsvc(nsvc);
Alexander Couzens6a161492020-07-12 13:45:50 +0200647 osmo_fsm_inst_term(nsvc->fi, OSMO_FSM_TERM_REQUEST, NULL);
648
649 /* let the driver/bind clean up it's internal state */
650 if (nsvc->priv && nsvc->bind->free_vc)
651 nsvc->bind->free_vc(nsvc);
652
653 osmo_stat_item_group_free(nsvc->statg);
654 rate_ctr_group_free(nsvc->ctrg);
655
656 talloc_free(nsvc);
657}
658
Alexander Couzens47558792020-12-06 03:16:11 +0100659/*! Destroy/release all NS-VC of given NSE
660 * \param[in] nse NSE
661 */
662void gprs_ns2_free_nsvcs(struct gprs_ns2_nse *nse)
663{
664 struct gprs_ns2_vc *nsvc, *tmp;
665
666 if (!nse)
667 return;
668
669 llist_for_each_entry_safe(nsvc, tmp, &nse->nsvc, list) {
670 gprs_ns2_free_nsvc(nsvc);
671 }
672}
673
Harald Welte5bef2cc2020-09-18 22:33:24 +0200674/*! Allocate a message buffer for use with the NS2 stack. */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100675struct msgb *ns2_msgb_alloc(void)
Alexander Couzens6a161492020-07-12 13:45:50 +0200676{
677 struct msgb *msg = msgb_alloc_headroom(NS_ALLOC_SIZE, NS_ALLOC_HEADROOM,
678 "GPRS/NS");
679 if (!msg) {
680 LOGP(DLNS, LOGL_ERROR, "Failed to allocate NS message of size %d\n",
681 NS_ALLOC_SIZE);
682 }
683 return msg;
684}
685
Harald Welte5bef2cc2020-09-18 22:33:24 +0200686/*! Create a status message to be sent over a new connection.
687 * \param[in] orig_msg the original message
688 * \param[in] tp TLVP parsed of the original message
689 * \param[out] reject callee-allocated message buffer of the generated NS-STATUS
690 * \param[in] cause Cause for the rejection
691 * \return 0 on success */
Alexander Couzens6a161492020-07-12 13:45:50 +0200692static int reject_status_msg(struct msgb *orig_msg, struct tlv_parsed *tp, struct msgb **reject, enum ns_cause cause)
693{
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100694 struct msgb *msg = ns2_msgb_alloc();
Alexander Couzens6a161492020-07-12 13:45:50 +0200695 struct gprs_ns_hdr *nsh;
696 bool have_vci = false;
697 uint8_t _cause = cause;
698 uint16_t nsei = 0;
699
700 if (!msg)
701 return -ENOMEM;
702
Harald Welte798efea2020-12-03 16:01:02 +0100703 if (TLVP_PRES_LEN(tp, NS_IE_NSEI, 2)) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200704 nsei = tlvp_val16be(tp, NS_IE_NSEI);
705
706 LOGP(DLNS, LOGL_NOTICE, "NSEI=%u Rejecting message without NSVCI. Tx NS STATUS (cause=%s)\n",
707 nsei, gprs_ns2_cause_str(cause));
708 }
709
710 msg->l2h = msgb_put(msg, sizeof(*nsh));
711 nsh = (struct gprs_ns_hdr *) msg->l2h;
712 nsh->pdu_type = NS_PDUT_STATUS;
713
714 msgb_tvlv_put(msg, NS_IE_CAUSE, 1, &_cause);
Harald Welte798efea2020-12-03 16:01:02 +0100715 have_vci = TLVP_PRES_LEN(tp, NS_IE_VCI, 2);
Alexander Couzens6a161492020-07-12 13:45:50 +0200716
717 /* Section 9.2.7.1: Static conditions for NS-VCI */
718 if (cause == NS_CAUSE_NSVC_BLOCKED ||
719 cause == NS_CAUSE_NSVC_UNKNOWN) {
720 if (!have_vci) {
721 msgb_free(msg);
722 return -EINVAL;
723 }
724
725 msgb_tvlv_put(msg, NS_IE_VCI, 2, TLVP_VAL(tp, NS_IE_VCI));
726 }
727
728 /* Section 9.2.7.2: Static conditions for NS PDU */
729 switch (cause) {
730 case NS_CAUSE_SEM_INCORR_PDU:
731 case NS_CAUSE_PDU_INCOMP_PSTATE:
732 case NS_CAUSE_PROTO_ERR_UNSPEC:
733 case NS_CAUSE_INVAL_ESSENT_IE:
734 case NS_CAUSE_MISSING_ESSENT_IE:
735 msgb_tvlv_put(msg, NS_IE_PDU, msgb_l2len(orig_msg),
736 orig_msg->l2h);
737 break;
738 default:
739 break;
740 }
741
742 *reject = msg;
743 return 0;
744}
745
Harald Welte5bef2cc2020-09-18 22:33:24 +0200746/*! Resolve a NS Entity based on its NSEI.
747 * \param[in] nsi NS Instance in which we do the look-up
748 * \param[in] nsei NSEI to look up
749 * \return NS Entity in successful case; NULL if none found */
Alexander Couzens6a161492020-07-12 13:45:50 +0200750struct gprs_ns2_nse *gprs_ns2_nse_by_nsei(struct gprs_ns2_inst *nsi, uint16_t nsei)
751{
752 struct gprs_ns2_nse *nse;
753
754 llist_for_each_entry(nse, &nsi->nse, list) {
755 if (nse->nsei == nsei)
756 return nse;
757 }
758
759 return NULL;
760}
761
Harald Welte5bef2cc2020-09-18 22:33:24 +0200762/*! Resolve a NS-VC Entity based on its NS-VCI.
763 * \param[in] nsi NS Instance in which we do the look-up
764 * \param[in] nsvci NS-VCI to look up
765 * \return NS-VC Entity in successful case; NULL if none found */
Alexander Couzens6a161492020-07-12 13:45:50 +0200766struct gprs_ns2_vc *gprs_ns2_nsvc_by_nsvci(struct gprs_ns2_inst *nsi, uint16_t nsvci)
767{
768 struct gprs_ns2_nse *nse;
769 struct gprs_ns2_vc *nsvc;
770
771 llist_for_each_entry(nse, &nsi->nse, list) {
772 llist_for_each_entry(nsvc, &nse->nsvc, list) {
773 if (nsvc->nsvci_is_valid && nsvc->nsvci == nsvci)
774 return nsvc;
775 }
776 }
777
778 return NULL;
779}
780
Harald Welte5bef2cc2020-09-18 22:33:24 +0200781/*! Create a NS Entity within given NS instance.
782 * \param[in] nsi NS instance in which to create NS Entity
783 * \param[in] nsei NS Entity Identifier of to-be-created NSE
Harald Welte5b034fb2021-03-04 14:16:49 +0100784 * \param[in] ip_sns_role_sgsn Does local side implement SGSN role?
Harald Welte5bef2cc2020-09-18 22:33:24 +0200785 * \returns newly-allocated NS-E in successful case; NULL on error */
Harald Welte5b034fb2021-03-04 14:16:49 +0100786struct gprs_ns2_nse *gprs_ns2_create_nse2(struct gprs_ns2_inst *nsi, uint16_t nsei,
787 enum gprs_ns2_ll linklayer, enum gprs_ns2_dialect dialect,
788 bool ip_sns_role_sgsn)
Alexander Couzens6a161492020-07-12 13:45:50 +0200789{
790 struct gprs_ns2_nse *nse;
791
792 nse = gprs_ns2_nse_by_nsei(nsi, nsei);
793 if (nse) {
Harald Weltef2949742021-01-20 14:54:14 +0100794 LOGNSE(nse, LOGL_ERROR, "Can not create a NSE with already taken NSEI\n");
Alexander Couzens6a161492020-07-12 13:45:50 +0200795 return nse;
796 }
797
798 nse = talloc_zero(nsi, struct gprs_ns2_nse);
799 if (!nse)
800 return NULL;
Harald Welte06d9bf92021-03-05 10:20:11 +0100801 nse->dialect = GPRS_NS2_DIALECT_UNDEF;
Harald Welte5b034fb2021-03-04 14:16:49 +0100802 nse->ip_sns_role_sgsn = ip_sns_role_sgsn;
Alexander Couzens6a161492020-07-12 13:45:50 +0200803
Harald Welte06d9bf92021-03-05 10:20:11 +0100804 if (ns2_nse_set_dialect(nse, dialect) < 0) {
805 talloc_free(nse);
806 return NULL;
Alexander Couzens93ad4992020-12-06 03:03:03 +0100807 }
808
Alexander Couzensaac90162020-11-19 02:44:04 +0100809 nse->ll = linklayer;
Alexander Couzens6a161492020-07-12 13:45:50 +0200810 nse->nsei = nsei;
811 nse->nsi = nsi;
Alexander Couzensda0a2852020-10-01 23:24:07 +0200812 nse->first = true;
Alexander Couzens4f1128f2021-01-20 17:42:48 +0100813 nse->mtu = 0;
Alexander Couzensd5cd8c62021-06-15 20:59:03 +0200814 llist_add_tail(&nse->list, &nsi->nse);
Alexander Couzens6a161492020-07-12 13:45:50 +0200815 INIT_LLIST_HEAD(&nse->nsvc);
816
817 return nse;
818}
819
Harald Welte06d9bf92021-03-05 10:20:11 +0100820int ns2_nse_set_dialect(struct gprs_ns2_nse *nse, enum gprs_ns2_dialect dialect)
821{
822 char sns[16];
823
824 if (nse->dialect == dialect)
825 return 0;
826
827 switch (nse->dialect) {
828 case GPRS_NS2_DIALECT_UNDEF:
829 if (dialect == GPRS_NS2_DIALECT_SNS) {
830 snprintf(sns, sizeof(sns), "NSE%05u-SNS", nse->nsei);
Harald Welte5b034fb2021-03-04 14:16:49 +0100831 if (nse->ip_sns_role_sgsn)
832 nse->bss_sns_fi = ns2_sns_sgsn_fsm_alloc(nse, sns);
833 else
834 nse->bss_sns_fi = ns2_sns_bss_fsm_alloc(nse, sns);
Harald Welte06d9bf92021-03-05 10:20:11 +0100835 if (!nse->bss_sns_fi)
836 return -1;
837 }
838 nse->dialect = dialect;
839 break;
840 default:
841 if (dialect == GPRS_NS2_DIALECT_UNDEF) {
842 if (nse->bss_sns_fi)
843 osmo_fsm_inst_term(nse->bss_sns_fi, OSMO_FSM_TERM_REQUEST, NULL);
844 nse->bss_sns_fi = NULL;
845 nse->dialect = GPRS_NS2_DIALECT_UNDEF;
846 } else {
847 /* we don't support arbitrary changes without going through UNDEF first */
848 return -EPERM;
849 }
850 }
851
852 return 0;
853}
854
Harald Welte5b034fb2021-03-04 14:16:49 +0100855/*! Create a NS Entity within given NS instance.
856 * \param[in] nsi NS instance in which to create NS Entity
857 * \param[in] nsei NS Entity Identifier of to-be-created NSE
858 * \returns newly-allocated NS-E in successful case; NULL on error */
859struct gprs_ns2_nse *gprs_ns2_create_nse(struct gprs_ns2_inst *nsi, uint16_t nsei,
860 enum gprs_ns2_ll linklayer, enum gprs_ns2_dialect dialect)
861{
862 return gprs_ns2_create_nse2(nsi, nsei, linklayer, dialect, false);
863}
864
Alexander Couzens05e7f7d2020-10-11 19:51:46 +0200865/*! Return the NSEI
866 * \param[in] nse NS Entity
867 * \return the nsei.
868 */
869uint16_t gprs_ns2_nse_nsei(struct gprs_ns2_nse *nse)
870{
871 return nse->nsei;
872}
873
Harald Welte5bef2cc2020-09-18 22:33:24 +0200874/*! Destroy given NS Entity.
875 * \param[in] nse NS Entity to destroy */
Alexander Couzens6a161492020-07-12 13:45:50 +0200876void gprs_ns2_free_nse(struct gprs_ns2_nse *nse)
877{
Alexander Couzens6a161492020-07-12 13:45:50 +0200878 if (!nse)
879 return;
880
Alexander Couzensd1cd6502021-01-15 02:16:23 +0100881 nse->alive = false;
Alexander Couzens26653882021-02-19 12:56:35 +0100882 if (nse->bss_sns_fi) {
883 osmo_fsm_inst_term(nse->bss_sns_fi, OSMO_FSM_TERM_REQUEST, NULL);
884 nse->bss_sns_fi = NULL;
885 }
886
Alexander Couzens47558792020-12-06 03:16:11 +0100887 gprs_ns2_free_nsvcs(nse);
Alexander Couzens138b96f2021-01-25 16:23:29 +0100888 ns2_prim_status_ind(nse, NULL, 0, GPRS_NS2_AFF_CAUSE_FAILURE);
Alexander Couzens6a161492020-07-12 13:45:50 +0200889
890 llist_del(&nse->list);
Alexander Couzens6a161492020-07-12 13:45:50 +0200891 talloc_free(nse);
892}
893
Alexander Couzens4b6c8af2020-10-11 20:15:25 +0200894void gprs_ns2_free_nses(struct gprs_ns2_inst *nsi)
895{
896 struct gprs_ns2_nse *nse, *ntmp;
897
898 llist_for_each_entry_safe(nse, ntmp, &nsi->nse, list) {
899 gprs_ns2_free_nse(nse);
900 }
901}
902
Alexander Couzens6a161492020-07-12 13:45:50 +0200903static inline int ns2_tlv_parse(struct tlv_parsed *dec,
904 const uint8_t *buf, int buf_len, uint8_t lv_tag,
905 uint8_t lv_tag2)
906{
907 /* workaround for NS_IE_IP_ADDR not following any known TLV rules.
908 * See comment of ns_att_tlvdef1. */
909 int rc = tlv_parse(dec, &ns_att_tlvdef1, buf, buf_len, lv_tag, lv_tag2);
910 if (rc < 0)
911 return tlv_parse(dec, &ns_att_tlvdef2, buf, buf_len, lv_tag, lv_tag2);
912 return rc;
913}
914
Harald Weltefe0266e2021-03-03 18:12:31 +0100915static enum ns2_cs ns2_create_vc_sns(struct gprs_ns2_vc_bind *bind,
916 const struct osmo_sockaddr *remote,
917 struct gprs_ns2_vc **success, uint16_t nsei)
918{
919 struct gprs_ns2_vc *nsvc;
920 struct gprs_ns2_nse *nse;
921
922 nsvc = gprs_ns2_nsvc_by_sockaddr_bind(bind, remote);
923 /* ns2_create_vc() is only called if no NS-VC could be found */
924 OSMO_ASSERT(!nsvc);
925
926 nse = gprs_ns2_nse_by_nsei(bind->nsi, nsei);
927 if (!nse) {
928 if (!bind->accept_sns) {
929 struct osmo_sockaddr_str remote_str;
930 osmo_sockaddr_str_from_sockaddr(&remote_str, &remote->u.sas);
931 /* no dynamic creation of IP-SNS NSE permitted */
932 LOGP(DLNS, LOGL_ERROR, "[%s]:%u: Dynamic creation of NSE(%05u) via IP-SNS not "
933 "permitted. Check your config.\n", remote_str.ip, remote_str.port, nsei);
934 return NS2_CS_ERROR;
935 }
936 nse = gprs_ns2_create_nse2(bind->nsi, nsei, bind->ll, GPRS_NS2_DIALECT_SNS, true);
937 if (!nse) {
938 LOGP(DLNS, LOGL_ERROR, "Failed to create NSE(%05u)\n", nsei);
939 return NS2_CS_ERROR;
940 }
Harald Welted164ef82021-03-04 22:29:17 +0100941 /* add configured list of default binds; if that fails, use only current bind */
942 if (!ns2_sns_add_sns_default_binds(nse))
943 gprs_ns2_sns_add_bind(nse, bind);
Harald Weltefe0266e2021-03-03 18:12:31 +0100944 } else {
945 /* nsei already known */
946 if (nse->ll != bind->ll) {
947 LOGNSE(nse, LOGL_ERROR, "Received NS-RESET with wrong linklayer(%s)"
948 " for already known NSE(%s)\n", gprs_ns2_lltype_str(bind->ll),
949 gprs_ns2_lltype_str(nse->ll));
950 return NS2_CS_SKIPPED;
951 }
952 }
953
954 nsvc = ns2_ip_bind_connect(bind, nse, remote);
955 if (!nsvc)
956 return NS2_CS_SKIPPED;
957
958 nsvc->nsvci_is_valid = false;
959
960 *success = nsvc;
961
962 return NS2_CS_CREATED;
963}
Alexander Couzens6a161492020-07-12 13:45:50 +0200964
Harald Welte5bef2cc2020-09-18 22:33:24 +0200965/*! Create a new NS-VC based on a [received] message. Depending on the bind it might create a NSE.
966 * \param[in] bind the bind through which msg was received
967 * \param[in] msg the actual received message
Harald Welte7d0daac2021-03-02 23:08:43 +0100968 * \param[in] remote address of remote peer sending message
Harald Welte5bef2cc2020-09-18 22:33:24 +0200969 * \param[in] logname A name to describe the VC. E.g. ip address pair
970 * \param[out] reject A message filled to be sent back. Only used in failure cases.
971 * \param[out] success A pointer which will be set to the new VC on success
972 * \return enum value indicating the status, e.g. GPRS_NS2_CS_CREATED */
Alexander Couzensba5a9922021-01-25 16:03:23 +0100973enum ns2_cs ns2_create_vc(struct gprs_ns2_vc_bind *bind,
974 struct msgb *msg,
Harald Welte7d0daac2021-03-02 23:08:43 +0100975 const struct osmo_sockaddr *remote,
Alexander Couzensba5a9922021-01-25 16:03:23 +0100976 const char *logname,
977 struct msgb **reject,
978 struct gprs_ns2_vc **success)
Alexander Couzens6a161492020-07-12 13:45:50 +0200979{
980 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *)msg->l2h;
981 struct tlv_parsed tp;
982 struct gprs_ns2_vc *nsvc;
983 struct gprs_ns2_nse *nse;
Alexander Couzensd923cff2020-12-01 01:03:52 +0100984 enum gprs_ns2_dialect dialect;
985 enum gprs_ns2_vc_mode vc_mode;
Alexander Couzens6a161492020-07-12 13:45:50 +0200986 uint16_t nsvci;
987 uint16_t nsei;
Alexander Couzensd7948062021-06-03 20:35:47 +0200988 const struct osmo_sockaddr *local;
989 char idbuf[256], tmp[INET6_ADDRSTRLEN + 8];
Alexander Couzens6a161492020-07-12 13:45:50 +0200990
Alexander Couzens12e5e6b2020-12-10 00:18:17 +0100991 int rc, tlv;
Alexander Couzens6a161492020-07-12 13:45:50 +0200992
993 if (msg->len < sizeof(struct gprs_ns_hdr))
Alexander Couzensba5a9922021-01-25 16:03:23 +0100994 return NS2_CS_ERROR;
Alexander Couzens6a161492020-07-12 13:45:50 +0200995
Alexander Couzens12e5e6b2020-12-10 00:18:17 +0100996 /* parse the tlv early to allow reject status msg to
997 * work with valid tp.
998 * Ignore the return code until the pdu type is parsed because
999 * an unknown pdu type should be ignored */
1000 tlv = ns2_tlv_parse(&tp, nsh->data,
Alexander Couzensbac5b012020-12-09 23:32:22 +01001001 msgb_l2len(msg) - sizeof(*nsh), 0, 0);
Alexander Couzensbac5b012020-12-09 23:32:22 +01001002
Harald Weltefe0266e2021-03-03 18:12:31 +01001003 if (bind->ll == GPRS_NS2_LL_UDP && nsh->pdu_type == SNS_PDUT_SIZE && tlv >= 0) {
1004 uint16_t nsei;
1005
1006 if (!TLVP_PRES_LEN(&tp, NS_IE_NSEI, 2)) {
1007 rc = reject_status_msg(msg, &tp, reject, NS_CAUSE_MISSING_ESSENT_IE);
1008 if (rc < 0)
1009 LOGP(DLNS, LOGL_ERROR, "Failed to generate reject message (%d)\n", rc);
1010 return NS2_CS_REJECTED;
1011 }
1012 nsei = tlvp_val16be(&tp, NS_IE_NSEI);
1013 /* Create NS-VC, and if required, even NSE dynamically */
1014 return ns2_create_vc_sns(bind, remote, success, nsei);
1015 }
1016
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001017 switch (nsh->pdu_type) {
1018 case NS_PDUT_STATUS:
Alexander Couzens6a161492020-07-12 13:45:50 +02001019 /* Do not respond, see 3GPP TS 08.16, 7.5.1 */
1020 LOGP(DLNS, LOGL_INFO, "Ignoring NS STATUS from %s "
1021 "for non-existing NS-VC\n",
1022 logname);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001023 return NS2_CS_SKIPPED;
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001024 case NS_PDUT_ALIVE_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +02001025 /* Ignore this, see 3GPP TS 08.16, 7.4.1 */
1026 LOGP(DLNS, LOGL_INFO, "Ignoring NS ALIVE ACK from %s "
1027 "for non-existing NS-VC\n",
1028 logname);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001029 return NS2_CS_SKIPPED;
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001030 case NS_PDUT_RESET_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +02001031 /* Ignore this, see 3GPP TS 08.16, 7.3.1 */
1032 LOGP(DLNS, LOGL_INFO, "Ignoring NS RESET ACK from %s "
1033 "for non-existing NS-VC\n",
1034 logname);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001035 return NS2_CS_SKIPPED;
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001036 case NS_PDUT_RESET:
1037 /* accept PDU RESET when vc_mode matches */
Alexander Couzensd923cff2020-12-01 01:03:52 +01001038 if (bind->accept_ipaccess) {
Alexander Couzens138b96f2021-01-25 16:23:29 +01001039 dialect = GPRS_NS2_DIALECT_IPACCESS;
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001040 break;
Alexander Couzensd923cff2020-12-01 01:03:52 +01001041 }
Alexander Couzens6a161492020-07-12 13:45:50 +02001042
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001043 rc = reject_status_msg(msg, &tp, reject, NS_CAUSE_PDU_INCOMP_PSTATE);
Alexander Couzens3c22f912020-12-10 00:20:18 +01001044 if (rc < 0)
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001045 LOGP(DLNS, LOGL_ERROR, "Failed to generate reject message (%d)\n", rc);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001046 return NS2_CS_REJECTED;
Alexander Couzensd87a2f12020-11-30 22:20:20 +01001047 default:
Alexander Couzens8ebc1ac2020-10-12 03:57:26 +02001048 rc = reject_status_msg(msg, &tp, reject, NS_CAUSE_PDU_INCOMP_PSTATE);
Alexander Couzens3c22f912020-12-10 00:20:18 +01001049 if (rc < 0)
Alexander Couzens8ebc1ac2020-10-12 03:57:26 +02001050 LOGP(DLNS, LOGL_ERROR, "Failed to generate reject message (%d)\n", rc);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001051 return NS2_CS_REJECTED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001052 }
1053
Alexander Couzens12e5e6b2020-12-10 00:18:17 +01001054 if (tlv < 0) {
1055 /* TODO: correct behaviour would checking what's wrong.
1056 * If it's an essential TLV for the PDU return NS_CAUSE_INVAL_ESSENT_IE.
1057 * Otherwise ignore the non-essential TLV. */
1058 LOGP(DLNS, LOGL_ERROR, "Rx NS RESET Error %d during "
1059 "TLV Parse\n", tlv);
1060 rc = reject_status_msg(msg, &tp, reject, NS_CAUSE_PROTO_ERR_UNSPEC);
Alexander Couzens3c22f912020-12-10 00:20:18 +01001061 if (rc < 0)
Alexander Couzens12e5e6b2020-12-10 00:18:17 +01001062 LOGP(DLNS, LOGL_ERROR, "Failed to generate reject message (%d)\n", rc);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001063 return NS2_CS_REJECTED;
Alexander Couzens12e5e6b2020-12-10 00:18:17 +01001064 }
1065
Harald Welte798efea2020-12-03 16:01:02 +01001066 if (!TLVP_PRES_LEN(&tp, NS_IE_CAUSE, 1) ||
1067 !TLVP_PRES_LEN(&tp, NS_IE_VCI, 2) || !TLVP_PRES_LEN(&tp, NS_IE_NSEI, 2)) {
Alexander Couzens8ebc1ac2020-10-12 03:57:26 +02001068 LOGP(DLNS, LOGL_ERROR, "NS RESET Missing mandatory IE\n");
1069 rc = reject_status_msg(msg, &tp, reject, NS_CAUSE_MISSING_ESSENT_IE);
Alexander Couzens3c22f912020-12-10 00:20:18 +01001070 if (rc < 0)
1071 LOGP(DLNS, LOGL_ERROR, "Failed to generate reject message (%d)\n", rc);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001072 return NS2_CS_REJECTED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001073 }
1074
Alexander Couzens6a161492020-07-12 13:45:50 +02001075 nsei = tlvp_val16be(&tp, NS_IE_NSEI);
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001076 nsvci = tlvp_val16be(&tp, NS_IE_VCI);
1077
1078 /* find or create NSE */
Alexander Couzens6a161492020-07-12 13:45:50 +02001079 nse = gprs_ns2_nse_by_nsei(bind->nsi, nsei);
1080 if (!nse) {
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001081 /* only create nse for udp & ipaccess */
Alexander Couzens138b96f2021-01-25 16:23:29 +01001082 if (bind->ll != GPRS_NS2_LL_UDP || dialect != GPRS_NS2_DIALECT_IPACCESS)
Alexander Couzensba5a9922021-01-25 16:03:23 +01001083 return NS2_CS_SKIPPED;
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001084
Alexander Couzens2e1a3a92021-01-27 20:44:41 +01001085 if (!bind->accept_ipaccess)
Alexander Couzensba5a9922021-01-25 16:03:23 +01001086 return NS2_CS_SKIPPED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001087
Alexander Couzensd923cff2020-12-01 01:03:52 +01001088 nse = gprs_ns2_create_nse(bind->nsi, nsei, bind->ll, dialect);
Alexander Couzens6a161492020-07-12 13:45:50 +02001089 if (!nse) {
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001090 LOGP(DLNS, LOGL_ERROR, "Failed to create NSE(%05u)\n", nsei);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001091 return NS2_CS_ERROR;
Alexander Couzens6a161492020-07-12 13:45:50 +02001092 }
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001093 } else {
1094 /* nsei already known */
1095 if (nse->ll != bind->ll) {
Harald Weltef2949742021-01-20 14:54:14 +01001096 LOGNSE(nse, LOGL_ERROR, "Received NS-RESET NS-VCI(%05u) with wrong linklayer(%s)"
1097 " for already known NSE(%s)\n", nsvci, gprs_ns2_lltype_str(bind->ll),
1098 gprs_ns2_lltype_str(nse->ll));
Alexander Couzensba5a9922021-01-25 16:03:23 +01001099 return NS2_CS_SKIPPED;
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001100 }
1101 }
1102
1103 nsvc = gprs_ns2_nsvc_by_nsvci(bind->nsi, nsvci);
1104 if (nsvc) {
1105 if (nsvc->persistent) {
Harald Weltef2949742021-01-20 14:54:14 +01001106 LOGNSVC(nsvc, LOGL_ERROR, "Received NS-RESET for a persistent NSE over wrong connection.\n");
Alexander Couzensba5a9922021-01-25 16:03:23 +01001107 return NS2_CS_SKIPPED;
Alexander Couzens05ac4e52021-01-04 19:07:05 +01001108 }
1109 /* destroy old dynamic nsvc */
1110 gprs_ns2_free_nsvc(nsvc);
1111 }
1112
1113 /* do nse persistent check late to be more precise on the error message */
1114 if (nse->persistent) {
Harald Weltef2949742021-01-20 14:54:14 +01001115 LOGNSE(nse, LOGL_ERROR, "Received NS-RESET for a persistent NSE but the unknown "
1116 "NS-VCI(%05u)\n", nsvci);
Alexander Couzensba5a9922021-01-25 16:03:23 +01001117 return NS2_CS_SKIPPED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001118 }
1119
Harald Welte603f4042020-11-29 17:39:19 +01001120 nsvci = tlvp_val16be(&tp, NS_IE_VCI);
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001121 vc_mode = ns2_dialect_to_vc_mode(dialect);
Alexander Couzensd7948062021-06-03 20:35:47 +02001122
1123 local = gprs_ns2_ip_bind_sockaddr(bind);
1124 osmo_sockaddr_to_str_buf(tmp, sizeof(tmp), local);
1125 snprintf(idbuf, sizeof(idbuf), "%s-NSE%05u-NSVC%05u-%s-%s", gprs_ns2_lltype_str(nse->ll),
1126 nse->nsei, nsvci, tmp, osmo_sockaddr_to_str(remote));
1127 osmo_identifier_sanitize_buf(idbuf, NULL, '_');
Harald Welte603f4042020-11-29 17:39:19 +01001128 nsvc = ns2_vc_alloc(bind, nse, false, vc_mode, idbuf);
Alexander Couzens6a161492020-07-12 13:45:50 +02001129 if (!nsvc)
Alexander Couzensba5a9922021-01-25 16:03:23 +01001130 return NS2_CS_SKIPPED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001131
Alexander Couzens6a161492020-07-12 13:45:50 +02001132 nsvc->nsvci = nsvci;
1133 nsvc->nsvci_is_valid = true;
1134
1135 *success = nsvc;
1136
Alexander Couzensba5a9922021-01-25 16:03:23 +01001137 return NS2_CS_CREATED;
Alexander Couzens6a161492020-07-12 13:45:50 +02001138}
1139
Harald Welte5bef2cc2020-09-18 22:33:24 +02001140/*! Create, and connect an inactive, new IP-based NS-VC
1141 * \param[in] bind bind in which the new NS-VC is to be created
1142 * \param[in] remote remote address to which to connect
1143 * \param[in] nse NS Entity in which the NS-VC is to be created
1144 * \param[in] nsvci is only required when bind->vc_mode == NS2_VC_MODE_BLOCKRESET
1145 * \return pointer to newly-allocated, connected and inactive NS-VC; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +02001146struct gprs_ns2_vc *gprs_ns2_ip_connect_inactive(struct gprs_ns2_vc_bind *bind,
Vadim Yanitskiya07f25e2020-10-09 21:47:01 +07001147 const struct osmo_sockaddr *remote,
Alexander Couzens6a161492020-07-12 13:45:50 +02001148 struct gprs_ns2_nse *nse,
1149 uint16_t nsvci)
1150{
1151 struct gprs_ns2_vc *nsvc;
1152
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001153 nsvc = ns2_ip_bind_connect(bind, nse, remote);
Alexander Couzens6a161492020-07-12 13:45:50 +02001154 if (!nsvc)
1155 return NULL;
1156
Alexander Couzens138b96f2021-01-25 16:23:29 +01001157 if (nsvc->mode == GPRS_NS2_VC_MODE_BLOCKRESET) {
Alexander Couzens6a161492020-07-12 13:45:50 +02001158 nsvc->nsvci = nsvci;
1159 nsvc->nsvci_is_valid = true;
1160 }
1161
1162 return nsvc;
1163}
1164
Harald Welte5bef2cc2020-09-18 22:33:24 +02001165/*! Create, connect and activate a new IP-based NS-VC
1166 * \param[in] bind bind in which the new NS-VC is to be created
1167 * \param[in] remote remote address to which to connect
1168 * \param[in] nse NS Entity in which the NS-VC is to be created
1169 * \param[in] nsvci is only required when bind->vc_mode == NS2_VC_MODE_BLOCKRESET
1170 * \return pointer to newly-allocated, connected and activated NS-VC; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +02001171struct gprs_ns2_vc *gprs_ns2_ip_connect(struct gprs_ns2_vc_bind *bind,
Vadim Yanitskiya07f25e2020-10-09 21:47:01 +07001172 const struct osmo_sockaddr *remote,
Alexander Couzens6a161492020-07-12 13:45:50 +02001173 struct gprs_ns2_nse *nse,
1174 uint16_t nsvci)
1175{
1176 struct gprs_ns2_vc *nsvc;
1177 nsvc = gprs_ns2_ip_connect_inactive(bind, remote, nse, nsvci);
1178 if (!nsvc)
1179 return NULL;
1180
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001181 ns2_vc_fsm_start(nsvc);
Alexander Couzens6a161492020-07-12 13:45:50 +02001182
1183 return nsvc;
1184}
1185
Harald Welte5bef2cc2020-09-18 22:33:24 +02001186/*! Create, connect and activate a new IP-based NS-VC
1187 * \param[in] bind bind in which the new NS-VC is to be created
1188 * \param[in] remote remote address to which to connect
1189 * \param[in] nsei NSEI of the NS Entity in which the NS-VC is to be created
1190 * \param[in] nsvci is only required when bind->vc_mode == NS2_VC_MODE_BLOCKRESET
1191 * \return pointer to newly-allocated, connected and activated NS-VC; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +02001192struct gprs_ns2_vc *gprs_ns2_ip_connect2(struct gprs_ns2_vc_bind *bind,
Vadim Yanitskiya07f25e2020-10-09 21:47:01 +07001193 const struct osmo_sockaddr *remote,
Alexander Couzens6a161492020-07-12 13:45:50 +02001194 uint16_t nsei,
Alexander Couzensd923cff2020-12-01 01:03:52 +01001195 uint16_t nsvci,
1196 enum gprs_ns2_dialect dialect)
Alexander Couzens6a161492020-07-12 13:45:50 +02001197{
1198 struct gprs_ns2_nse *nse = gprs_ns2_nse_by_nsei(bind->nsi, nsei);
1199
1200 if (!nse) {
Alexander Couzensd923cff2020-12-01 01:03:52 +01001201 nse = gprs_ns2_create_nse(bind->nsi, nsei, GPRS_NS2_LL_UDP, dialect);
Alexander Couzens6a161492020-07-12 13:45:50 +02001202 if (!nse)
1203 return NULL;
1204 }
1205
1206 return gprs_ns2_ip_connect(bind, remote, nse, nsvci);
1207}
1208
Harald Welte5bef2cc2020-09-18 22:33:24 +02001209/*! Find NS-VC for given socket address.
1210 * \param[in] nse NS Entity in which to search
1211 * \param[in] sockaddr socket address to search for
1212 * \return NS-VC matching sockaddr; NULL if none found */
Alexander Couzens38b19e82020-09-23 23:56:37 +02001213struct gprs_ns2_vc *gprs_ns2_nsvc_by_sockaddr_nse(struct gprs_ns2_nse *nse,
Vadim Yanitskiya07f25e2020-10-09 21:47:01 +07001214 const struct osmo_sockaddr *sockaddr)
Alexander Couzens6a161492020-07-12 13:45:50 +02001215{
1216 struct gprs_ns2_vc *nsvc;
Alexander Couzens9a4cf272020-10-11 20:48:04 +02001217 const struct osmo_sockaddr *remote;
Alexander Couzens6a161492020-07-12 13:45:50 +02001218
1219 OSMO_ASSERT(nse);
1220 OSMO_ASSERT(sockaddr);
1221
1222 llist_for_each_entry(nsvc, &nse->nsvc, list) {
Alexander Couzensc4229a42020-10-11 20:58:04 +02001223 remote = gprs_ns2_ip_vc_remote(nsvc);
Alexander Couzens6a161492020-07-12 13:45:50 +02001224 if (!osmo_sockaddr_cmp(sockaddr, remote))
1225 return nsvc;
1226 }
1227
1228 return NULL;
1229}
1230
Alexander Couzens6cb5d5f2020-10-11 23:23:31 +02001231/*!
1232 * Iterate over all nsvc of a NS Entity and call the callback.
1233 * If the callback returns < 0 it aborts the loop and returns the callback return code.
1234 * \param[in] nse NS Entity to iterate over all nsvcs
1235 * \param[in] cb the callback to call
1236 * \param[inout] cb_data the private data of the callback
1237 * \return 0 if the loop completes. If a callback returns < 0 it will returns this value.
1238 */
1239int gprs_ns2_nse_foreach_nsvc(struct gprs_ns2_nse *nse, gprs_ns2_foreach_nsvc_cb cb, void *cb_data)
1240{
1241 struct gprs_ns2_vc *nsvc, *tmp;
1242 int rc = 0;
1243 llist_for_each_entry_safe(nsvc, tmp, &nse->nsvc, list) {
1244 rc = cb(nsvc, cb_data);
1245 if (rc < 0)
1246 return rc;
1247 }
1248
1249 return 0;
1250}
1251
1252
Alexander Couzens6a161492020-07-12 13:45:50 +02001253
Harald Welte5bef2cc2020-09-18 22:33:24 +02001254/*! Bottom-side entry-point for received NS PDU from the driver/bind
Harald Welte5bef2cc2020-09-18 22:33:24 +02001255 * \param[in] nsvc NS-VC for which the message was received
Alexander Couzens7619ed42021-03-24 17:44:03 +01001256 * \param msg the received message. Ownership is transferred, caller must not free it!
Harald Welte5bef2cc2020-09-18 22:33:24 +02001257 * \return 0 on success; negative on error */
Alexander Couzensffd49d02020-09-24 00:47:17 +02001258int ns2_recv_vc(struct gprs_ns2_vc *nsvc,
Alexander Couzens6a161492020-07-12 13:45:50 +02001259 struct msgb *msg)
1260{
1261 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
Alexander Couzensba634532021-01-25 13:46:38 +01001262 struct tlv_parsed tp = { };
Alexander Couzens6a161492020-07-12 13:45:50 +02001263 int rc = 0;
1264
Daniel Willmann751977b2020-12-02 18:59:44 +01001265 log_set_context(LOG_CTX_GB_NSE, nsvc->nse);
1266 log_set_context(LOG_CTX_GB_NSVC, nsvc);
1267
Pau Espin Pedrol7b894a72021-06-04 18:17:12 +02001268 rate_ctr_inc(rate_ctr_group_get_ctr(nsvc->ctrg, NS_CTR_PKTS_IN));
1269 rate_ctr_add(rate_ctr_group_get_ctr(nsvc->ctrg, NS_CTR_BYTES_IN), msg->len);
Harald Weltee5f55f72021-01-30 21:51:15 +01001270
Alexander Couzens7619ed42021-03-24 17:44:03 +01001271 if (msg->len < sizeof(struct gprs_ns_hdr)) {
1272 rc = -EINVAL;
1273 goto freemsg;
1274 }
Alexander Couzens6a161492020-07-12 13:45:50 +02001275
Alexander Couzens6cf65d92021-01-18 17:55:35 +01001276 if (nsh->pdu_type != NS_PDUT_UNITDATA)
1277 LOG_NS_RX_SIGNAL(nsvc, nsh->pdu_type);
1278 else
1279 LOG_NS_DATA(nsvc, "Rx", nsh->pdu_type, LOGL_INFO, "\n");
1280
Alexander Couzens6a161492020-07-12 13:45:50 +02001281 switch (nsh->pdu_type) {
1282 case SNS_PDUT_CONFIG:
1283 /* one additional byte ('end flag') before the TLV part starts */
1284 rc = ns2_tlv_parse(&tp, nsh->data+1,
1285 msgb_l2len(msg) - sizeof(*nsh)-1, 0, 0);
1286 if (rc < 0) {
Alexander Couzensbb0a53b2020-10-12 04:18:03 +02001287 LOGP(DLNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));
Alexander Couzens7619ed42021-03-24 17:44:03 +01001288 goto freemsg;
Alexander Couzens6a161492020-07-12 13:45:50 +02001289 }
1290 /* All sub-network service related message types */
Alexander Couzens7619ed42021-03-24 17:44:03 +01001291 return ns2_sns_rx(nsvc, msg, &tp);
Alexander Couzens6a161492020-07-12 13:45:50 +02001292 case SNS_PDUT_ACK:
1293 case SNS_PDUT_ADD:
1294 case SNS_PDUT_CHANGE_WEIGHT:
1295 case SNS_PDUT_DELETE:
1296 /* weird layout: NSEI TLV, then value-only transaction IE, then TLV again */
Harald Welte36be9d82020-10-09 15:39:25 +02001297 rc = ns2_tlv_parse(&tp, nsh->data+5,
1298 msgb_l2len(msg) - sizeof(*nsh)-5, 0, 0);
Alexander Couzens6a161492020-07-12 13:45:50 +02001299 if (rc < 0) {
Alexander Couzensbb0a53b2020-10-12 04:18:03 +02001300 LOGP(DLNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));
Alexander Couzens7619ed42021-03-24 17:44:03 +01001301 goto freemsg;
Alexander Couzens6a161492020-07-12 13:45:50 +02001302 }
1303 tp.lv[NS_IE_NSEI].val = nsh->data+2;
1304 tp.lv[NS_IE_NSEI].len = 2;
1305 tp.lv[NS_IE_TRANS_ID].val = nsh->data+4;
1306 tp.lv[NS_IE_TRANS_ID].len = 1;
Alexander Couzens7619ed42021-03-24 17:44:03 +01001307 return ns2_sns_rx(nsvc, msg, &tp);
Alexander Couzens6a161492020-07-12 13:45:50 +02001308 case SNS_PDUT_CONFIG_ACK:
1309 case SNS_PDUT_SIZE:
1310 case SNS_PDUT_SIZE_ACK:
1311 rc = ns2_tlv_parse(&tp, nsh->data,
1312 msgb_l2len(msg) - sizeof(*nsh), 0, 0);
1313 if (rc < 0) {
Alexander Couzensbb0a53b2020-10-12 04:18:03 +02001314 LOGP(DLNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));
Alexander Couzens7619ed42021-03-24 17:44:03 +01001315 goto freemsg;
Alexander Couzens6a161492020-07-12 13:45:50 +02001316 }
1317 /* All sub-network service related message types */
Alexander Couzens7619ed42021-03-24 17:44:03 +01001318 return ns2_sns_rx(nsvc, msg, &tp);
Alexander Couzens6a161492020-07-12 13:45:50 +02001319 case NS_PDUT_UNITDATA:
Alexander Couzens7619ed42021-03-24 17:44:03 +01001320 return ns2_vc_rx(nsvc, msg, &tp);
Alexander Couzens6a161492020-07-12 13:45:50 +02001321 default:
1322 rc = ns2_tlv_parse(&tp, nsh->data,
1323 msgb_l2len(msg) - sizeof(*nsh), 0, 0);
1324 if (rc < 0) {
Alexander Couzensbb0a53b2020-10-12 04:18:03 +02001325 LOGP(DLNS, LOGL_NOTICE, "Error during TLV Parse\n");
Alexander Couzens6a161492020-07-12 13:45:50 +02001326 if (nsh->pdu_type != NS_PDUT_STATUS)
1327 ns2_tx_status(nsvc, NS_CAUSE_PROTO_ERR_UNSPEC, 0, msg);
1328 return rc;
1329 }
Alexander Couzens7619ed42021-03-24 17:44:03 +01001330 return ns2_vc_rx(nsvc, msg, &tp);
Alexander Couzens6a161492020-07-12 13:45:50 +02001331 }
Alexander Couzens7619ed42021-03-24 17:44:03 +01001332freemsg:
1333 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +02001334
1335 return rc;
1336}
1337
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +01001338/* summarize all active data nsvcs */
1339void ns2_nse_data_sum(struct gprs_ns2_nse *nse)
1340{
1341 struct gprs_ns2_vc *nsvc;
Harald Welte3221f872021-01-18 14:58:51 +01001342
Alexander Couzens8a2a1a42020-12-26 18:00:17 +01001343 nse->nsvc_count = 0;
Harald Welte3221f872021-01-18 14:58:51 +01001344 nse->sum_data_weight = 0;
1345 nse->sum_sig_weight = 0;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +01001346
1347 llist_for_each_entry(nsvc, &nse->nsvc, list) {
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001348 if (!ns2_vc_is_unblocked(nsvc))
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +01001349 continue;
Alexander Couzens8a2a1a42020-12-26 18:00:17 +01001350
1351 nse->nsvc_count++;
Harald Welte3221f872021-01-18 14:58:51 +01001352 nse->sum_data_weight += nsvc->data_weight;
1353 nse->sum_sig_weight += nsvc->sig_weight;
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +01001354 }
1355}
1356
Harald Welte5bef2cc2020-09-18 22:33:24 +02001357/*! Notify a nse about the change of a NS-VC.
1358 * \param[in] nsvc NS-VC which has detected the change (and shall not be notified).
1359 * \param[in] unblocked whether the NSE should be marked as unblocked (true) or blocked (false) */
Alexander Couzens6a161492020-07-12 13:45:50 +02001360void ns2_nse_notify_unblocked(struct gprs_ns2_vc *nsvc, bool unblocked)
1361{
1362 struct gprs_ns2_nse *nse = nsvc->nse;
Alexander Couzens6a161492020-07-12 13:45:50 +02001363
Alexander Couzensbe7cecc2021-02-03 18:25:27 +01001364 ns2_sns_notify_alive(nse, nsvc, unblocked);
Alexander Couzensfc3dd1f2020-11-19 00:41:47 +01001365 ns2_nse_data_sum(nse);
1366
Alexander Couzens6a161492020-07-12 13:45:50 +02001367 if (unblocked == nse->alive)
1368 return;
1369
Harald Welte3221f872021-01-18 14:58:51 +01001370 /* wait until both data_weight and sig_weight are != 0 before declaring NSE as alive */
1371 if (unblocked && nse->sum_data_weight && nse->sum_sig_weight) {
Alexander Couzens6a161492020-07-12 13:45:50 +02001372 nse->alive = true;
Alexander Couzens138b96f2021-01-25 16:23:29 +01001373 ns2_prim_status_ind(nse, NULL, 0, GPRS_NS2_AFF_CAUSE_RECOVERY);
Alexander Couzensda0a2852020-10-01 23:24:07 +02001374 nse->first = false;
Alexander Couzens6a161492020-07-12 13:45:50 +02001375 return;
1376 }
1377
Harald Welte3221f872021-01-18 14:58:51 +01001378 if (nse->alive && (nse->sum_data_weight == 0 || nse->sum_sig_weight == 0)) {
1379 /* nse became unavailable */
1380 nse->alive = false;
Alexander Couzens138b96f2021-01-25 16:23:29 +01001381 ns2_prim_status_ind(nse, NULL, 0, GPRS_NS2_AFF_CAUSE_FAILURE);
Alexander Couzens6a161492020-07-12 13:45:50 +02001382 }
Alexander Couzens6a161492020-07-12 13:45:50 +02001383}
1384
1385/*! Create a new GPRS NS instance
Harald Welte5bef2cc2020-09-18 22:33:24 +02001386 * \param[in] ctx a talloc context to allocate NS instance from
Alexander Couzenscce88282020-10-26 00:25:50 +01001387 * \param[in] cb Call-back function for dispatching primitives to the user. The Call-back must free all msgb* given in the primitive.
Harald Welte5bef2cc2020-09-18 22:33:24 +02001388 * \param[in] cb_data transparent user data passed to Call-back
1389 * \returns dynamically allocated gprs_ns_inst; NULL on error */
Alexander Couzens6a161492020-07-12 13:45:50 +02001390struct gprs_ns2_inst *gprs_ns2_instantiate(void *ctx, osmo_prim_cb cb, void *cb_data)
1391{
1392 struct gprs_ns2_inst *nsi;
1393
1394 nsi = talloc_zero(ctx, struct gprs_ns2_inst);
1395 if (!nsi)
1396 return NULL;
1397
1398 nsi->cb = cb;
1399 nsi->cb_data = cb_data;
1400 INIT_LLIST_HEAD(&nsi->binding);
1401 INIT_LLIST_HEAD(&nsi->nse);
1402
1403 nsi->timeout[NS_TOUT_TNS_BLOCK] = 3;
1404 nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES] = 3;
1405 nsi->timeout[NS_TOUT_TNS_RESET] = 3;
1406 nsi->timeout[NS_TOUT_TNS_RESET_RETRIES] = 3;
1407 nsi->timeout[NS_TOUT_TNS_TEST] = 30;
1408 nsi->timeout[NS_TOUT_TNS_ALIVE] = 3;
1409 nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES] = 10;
1410 nsi->timeout[NS_TOUT_TSNS_PROV] = 3; /* 1..10 */
Alexander Couzens90ee9632020-12-07 06:18:32 +01001411 nsi->timeout[NS_TOUT_TSNS_SIZE_RETRIES] = 3;
1412 nsi->timeout[NS_TOUT_TSNS_CONFIG_RETRIES] = 3;
Alexander Couzens6a161492020-07-12 13:45:50 +02001413
1414 return nsi;
1415}
1416
Harald Welte5bef2cc2020-09-18 22:33:24 +02001417/*! Destroy a NS Instance (including all its NSEs, binds, ...).
1418 * \param[in] nsi NS instance to destroy */
Alexander Couzens6a161492020-07-12 13:45:50 +02001419void gprs_ns2_free(struct gprs_ns2_inst *nsi)
1420{
Alexander Couzens6a161492020-07-12 13:45:50 +02001421 if (!nsi)
1422 return;
1423
Alexander Couzens4b6c8af2020-10-11 20:15:25 +02001424 gprs_ns2_free_nses(nsi);
Alexander Couzens896fcd52020-10-11 19:52:36 +02001425 gprs_ns2_free_binds(nsi);
Alexander Couzens35315042020-10-10 03:28:17 +02001426
1427 talloc_free(nsi);
Alexander Couzens6a161492020-07-12 13:45:50 +02001428}
1429
Harald Welte5bef2cc2020-09-18 22:33:24 +02001430/*! Start the NS-ALIVE FSM in all NS-VCs of given NSE.
1431 * \param[in] nse NS Entity in whihc to start NS-ALIVE FSMs */
Alexander Couzens6a161492020-07-12 13:45:50 +02001432void gprs_ns2_start_alive_all_nsvcs(struct gprs_ns2_nse *nse)
1433{
1434 struct gprs_ns2_vc *nsvc;
1435 OSMO_ASSERT(nse);
1436
1437 llist_for_each_entry(nsvc, &nse->nsvc, list) {
Harald Weltec962a2e2021-03-05 08:09:08 +01001438 /* A pre-configured endpoint shall not be used for NSE data or signalling traffic
1439 * (with the exception of Size and Configuration procedures) unless it is
1440 * configured by the SGSN using the auto-configuration procedures */
Alexander Couzens6a161492020-07-12 13:45:50 +02001441 if (nsvc->sns_only)
1442 continue;
1443
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001444 ns2_vc_fsm_start(nsvc);
Alexander Couzens6a161492020-07-12 13:45:50 +02001445 }
1446}
1447
Harald Welte5bef2cc2020-09-18 22:33:24 +02001448/*! Destroy a given bind.
1449 * \param[in] bind the bind we want to destroy */
Alexander Couzens6a161492020-07-12 13:45:50 +02001450void gprs_ns2_free_bind(struct gprs_ns2_vc_bind *bind)
1451{
1452 struct gprs_ns2_vc *nsvc, *tmp;
Alexander Couzens6b9d2322021-02-12 03:17:59 +01001453 struct gprs_ns2_nse *nse;
Alexander Couzens6a161492020-07-12 13:45:50 +02001454 if (!bind)
1455 return;
1456
1457 llist_for_each_entry_safe(nsvc, tmp, &bind->nsvc, blist) {
1458 gprs_ns2_free_nsvc(nsvc);
1459 }
1460
Alexander Couzens6b9d2322021-02-12 03:17:59 +01001461 if (gprs_ns2_is_ip_bind(bind)) {
1462 llist_for_each_entry(nse, &bind->nsi->nse, list) {
1463 gprs_ns2_sns_del_bind(nse, bind);
1464 }
1465 }
1466
Alexander Couzens6a161492020-07-12 13:45:50 +02001467 if (bind->driver->free_bind)
1468 bind->driver->free_bind(bind);
1469
1470 llist_del(&bind->list);
Harald Welte76346072021-01-31 11:54:02 +01001471 osmo_stat_item_group_free(bind->statg);
Alexander Couzensaaa55a62020-12-03 06:02:03 +01001472 talloc_free((char *)bind->name);
Alexander Couzens6a161492020-07-12 13:45:50 +02001473 talloc_free(bind);
1474}
Alexander Couzens896fcd52020-10-11 19:52:36 +02001475
1476void gprs_ns2_free_binds(struct gprs_ns2_inst *nsi)
1477{
1478 struct gprs_ns2_vc_bind *bind, *tbind;
1479
1480 llist_for_each_entry_safe(bind, tbind, &nsi->binding, list) {
1481 gprs_ns2_free_bind(bind);
1482 }
1483}
Alexander Couzensd923cff2020-12-01 01:03:52 +01001484
Alexander Couzensaaa55a62020-12-03 06:02:03 +01001485/*! Search for a bind with a unique name
1486 * \param[in] nsi NS instance on which we operate
1487 * \param[in] name The unique bind name to search for
1488 * \return the bind or NULL if not found
1489 */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001490struct gprs_ns2_vc_bind *gprs_ns2_bind_by_name(struct gprs_ns2_inst *nsi, const char *name)
Alexander Couzensaaa55a62020-12-03 06:02:03 +01001491{
1492 struct gprs_ns2_vc_bind *bind;
1493
1494 llist_for_each_entry(bind, &nsi->binding, list) {
1495 if (!strcmp(bind->name, name))
1496 return bind;
1497 }
1498
1499 return NULL;
1500}
1501
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001502enum gprs_ns2_vc_mode ns2_dialect_to_vc_mode(enum gprs_ns2_dialect dialect)
Alexander Couzensd923cff2020-12-01 01:03:52 +01001503{
1504 switch (dialect) {
Alexander Couzens138b96f2021-01-25 16:23:29 +01001505 case GPRS_NS2_DIALECT_SNS:
1506 case GPRS_NS2_DIALECT_STATIC_ALIVE:
1507 return GPRS_NS2_VC_MODE_ALIVE;
1508 case GPRS_NS2_DIALECT_STATIC_RESETBLOCK:
1509 case GPRS_NS2_DIALECT_IPACCESS:
1510 return GPRS_NS2_VC_MODE_BLOCKRESET;
Alexander Couzensd923cff2020-12-01 01:03:52 +01001511 default:
1512 return -1;
1513 }
1514}
1515
Alexander Couzens1c8785d2020-12-17 06:58:53 +01001516static void add_bind_array(struct gprs_ns2_vc_bind **array,
1517 struct gprs_ns2_vc_bind *bind, int size)
1518{
1519 int i;
1520 for (i=0; i < size; i++) {
1521 if (array[i] == bind)
1522 return;
1523 if (!array[i])
1524 break;
1525 }
1526
1527 if (i == size)
1528 return;
1529
1530 array[i] = bind;
1531}
1532
Alexander Couzens4f1128f2021-01-20 17:42:48 +01001533void ns2_nse_update_mtu(struct gprs_ns2_nse *nse)
1534{
1535 struct gprs_ns2_vc *nsvc;
1536 int mtu = 0;
1537
1538 if (llist_empty(&nse->nsvc)) {
1539 nse->mtu = 0;
1540 return;
1541 }
1542
1543 llist_for_each_entry(nsvc, &nse->nsvc, list) {
1544 if (mtu == 0)
1545 mtu = nsvc->bind->mtu;
1546 else if (mtu > nsvc->bind->mtu)
1547 mtu = nsvc->bind->mtu;
1548 }
1549
1550 if (nse->mtu == mtu)
1551 return;
1552
1553 nse->mtu = mtu;
1554 if (nse->alive)
Alexander Couzensdb7b2ab2021-07-02 16:12:28 +02001555 ns2_prim_status_ind(nse, NULL, 0, GPRS_NS2_AFF_CAUSE_MTU_CHANGE);
Alexander Couzens4f1128f2021-01-20 17:42:48 +01001556}
1557
Alexander Couzens1c8785d2020-12-17 06:58:53 +01001558/*! calculate the transfer capabilities for a nse
1559 * \param nse the nse to count the transfer capability
1560 * \param bvci a bvci - unused
1561 * \return the transfer capability in mbit. On error < 0.
1562 */
1563int ns2_count_transfer_cap(struct gprs_ns2_nse *nse,
1564 uint16_t bvci)
1565{
1566 struct gprs_ns2_vc *nsvc;
1567 struct gprs_ns2_vc_bind **active_binds;
1568 int i, active_nsvcs = 0, transfer_cap = 0;
1569
1570 /* calculate the transfer capabilities based on the binds.
1571 * A bind has a transfer capability which is shared across all NSVCs.
1572 * Take care the bind cap is not counted twice within a NSE.
1573 * This should be accurate for FR and UDP but not for FR/GRE. */
1574
1575 if (!nse->alive)
1576 return 0;
1577
1578 llist_for_each_entry(nsvc, &nse->nsvc, list) {
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001579 if (ns2_vc_is_unblocked(nsvc))
Alexander Couzens1c8785d2020-12-17 06:58:53 +01001580 active_nsvcs++;
1581 }
Alexander Couzens32556682021-02-28 23:42:53 +01001582
1583 if (!active_nsvcs)
1584 return 0;
Alexander Couzens1c8785d2020-12-17 06:58:53 +01001585
1586 active_binds = talloc_zero_array(nse, struct gprs_ns2_vc_bind*, active_nsvcs);
1587 if (!active_binds)
1588 return -ENOMEM;
1589
1590 llist_for_each_entry(nsvc, &nse->nsvc, list) {
Alexander Couzens8dfc24c2021-01-25 16:09:23 +01001591 if (!ns2_vc_is_unblocked(nsvc))
Alexander Couzens1c8785d2020-12-17 06:58:53 +01001592 continue;
1593 add_bind_array(active_binds, nsvc->bind, active_nsvcs);
1594 }
1595
1596 /* TODO: change calcuation for FR/GRE */
1597 for (i = 0; i < active_nsvcs; i++) {
1598 if (active_binds[i])
1599 transfer_cap += active_binds[i]->transfer_capability;
1600 }
1601
1602 talloc_free(active_binds);
1603 return transfer_cap;
1604}
1605
Harald Weltec3aa8f92021-01-31 11:41:34 +01001606/*! common allocation + low-level initialization of a bind. Called by vc-drivers */
1607int ns2_bind_alloc(struct gprs_ns2_inst *nsi, const char *name,
1608 struct gprs_ns2_vc_bind **result)
1609{
1610 struct gprs_ns2_vc_bind *bind;
1611
1612 if (!name)
1613 return -EINVAL;
1614
1615 if (gprs_ns2_bind_by_name(nsi, name))
1616 return -EALREADY;
1617
1618 bind = talloc_zero(nsi, struct gprs_ns2_vc_bind);
1619 if (!bind)
Harald Weltebdfb8b92021-01-31 11:44:57 +01001620 return -ENOMEM;
Harald Weltec3aa8f92021-01-31 11:41:34 +01001621
1622 bind->name = talloc_strdup(bind, name);
1623 if (!bind->name) {
1624 talloc_free(bind);
Harald Weltebdfb8b92021-01-31 11:44:57 +01001625 return -ENOMEM;
Harald Weltec3aa8f92021-01-31 11:41:34 +01001626 }
1627
Harald Welte76346072021-01-31 11:54:02 +01001628 bind->statg = osmo_stat_item_group_alloc(bind, &nsbind_statg_desc, nsi->bind_rate_ctr_idx);
1629 if (!bind->statg) {
1630 talloc_free(bind);
1631 return -ENOMEM;
1632 }
1633
Alexander Couzensc4704762021-02-08 23:13:12 +01001634 bind->sns_sig_weight = 1;
1635 bind->sns_data_weight = 1;
Harald Weltec3aa8f92021-01-31 11:41:34 +01001636 bind->nsi = nsi;
1637 INIT_LLIST_HEAD(&bind->nsvc);
Alexander Couzensd5cd8c62021-06-15 20:59:03 +02001638 llist_add_tail(&bind->list, &nsi->binding);
Harald Weltec3aa8f92021-01-31 11:41:34 +01001639
Harald Welte76346072021-01-31 11:54:02 +01001640 nsi->bind_rate_ctr_idx++;
1641
Harald Weltec3aa8f92021-01-31 11:41:34 +01001642 if (result)
1643 *result = bind;
1644
1645 return 0;
1646}
1647
Alexander Couzens6a161492020-07-12 13:45:50 +02001648/*! @} */