<p>Harald Welte has uploaded this change for <strong>review</strong>.</p><p><a href="https://gerrit.osmocom.org/13014">View Change</a></p><pre style="font-family: monospace,monospace; white-space: pre-wrap;">WIP: Add support for GPRS NS IP Sub-Network-Service (SNS)<br><br>Related: OS#3372<br>Change-Id: I84786c3b43a8ae34ef3b3ba84b33c90042d234ea<br>---<br>M include/osmocom/gprs/gprs_msgb.h<br>M include/osmocom/gprs/gprs_ns.h<br>M include/osmocom/gprs/protocol/gsm_08_16.h<br>M src/gb/Makefile.am<br>M src/gb/gb_internal.h<br>M src/gb/gprs_ns.c<br>A src/gb/gprs_ns_sns.c<br>M src/gb/gprs_ns_vty.c<br>M src/gb/libosmogb.map<br>9 files changed, 895 insertions(+), 24 deletions(-)<br><br></pre><pre style="font-family: monospace,monospace; white-space: pre-wrap;">git pull ssh://gerrit.osmocom.org:29418/libosmocore refs/changes/14/13014/1</pre><pre style="font-family: monospace,monospace; white-space: pre-wrap;"><span>diff --git a/include/osmocom/gprs/gprs_msgb.h b/include/osmocom/gprs/gprs_msgb.h</span><br><span>index 43471e2..3f48b5b 100644</span><br><span>--- a/include/osmocom/gprs/gprs_msgb.h</span><br><span>+++ b/include/osmocom/gprs/gprs_msgb.h</span><br><span>@@ -3,19 +3,19 @@</span><br><span> #pragma once</span><br><span> </span><br><span> #include <stdint.h></span><br><span style="color: hsl(0, 100%, 40%);">-/* the data structure stored in msgb->cb for libgb apps */</span><br><span style="color: hsl(120, 100%, 40%);">+/*! the data structure stored in msgb->cb for libgb apps */</span><br><span> struct libgb_msgb_cb {</span><br><span> unsigned char *bssgph;</span><br><span> unsigned char *llch;</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">- /* Cell Identifier */</span><br><span style="color: hsl(120, 100%, 40%);">+ /*! Cell Identifier */</span><br><span> unsigned char *bssgp_cell_id;</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">- /* Identifiers of a BTS, equal to 'struct bssgp_bts_ctx' */</span><br><span style="color: hsl(120, 100%, 40%);">+ /*! Identifiers of a BTS, equal to 'struct bssgp_bts_ctx' */</span><br><span> uint16_t nsei;</span><br><span> uint16_t bvci;</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">- /* Identifier of a MS (inside BTS), equal to 'struct sgsn_mm_ctx' */</span><br><span style="color: hsl(120, 100%, 40%);">+ /*! Identifier of a MS (inside BTS), equal to 'struct sgsn_mm_ctx' */</span><br><span> uint32_t tlli;</span><br><span> } __attribute__((packed, may_alias));</span><br><span> #define LIBGB_MSGB_CB(__msgb) ((struct libgb_msgb_cb *)&((__msgb)->cb[0]))</span><br><span>diff --git a/include/osmocom/gprs/gprs_ns.h b/include/osmocom/gprs/gprs_ns.h</span><br><span>index 1c99ed0..c62ef98 100644</span><br><span>--- a/include/osmocom/gprs/gprs_ns.h</span><br><span>+++ b/include/osmocom/gprs/gprs_ns.h</span><br><span>@@ -14,8 +14,8 @@</span><br><span> </span><br><span> #include <osmocom/gprs/protocol/gsm_08_16.h></span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">-#define NS_TIMERS_COUNT 7</span><br><span style="color: hsl(0, 100%, 40%);">-#define NS_TIMERS "(tns-block|tns-block-retries|tns-reset|tns-reset-retries|tns-test|tns-alive|tns-alive-retries)"</span><br><span style="color: hsl(120, 100%, 40%);">+#define NS_TIMERS_COUNT 8</span><br><span style="color: hsl(120, 100%, 40%);">+#define NS_TIMERS "(tns-block|tns-block-retries|tns-reset|tns-reset-retries|tns-test|tns-alive|tns-alive-retries|tsns-prov)"</span><br><span> #define NS_TIMERS_HELP \</span><br><span> "(un)blocking Timer (Tns-block) timeout\n" \</span><br><span> "(un)blocking Timer (Tns-block) number of retries\n" \</span><br><span>@@ -23,7 +23,8 @@</span><br><span> "Reset Timer (Tns-reset) number of retries\n" \</span><br><span> "Test Timer (Tns-test) timeout\n" \</span><br><span> "Alive Timer (Tns-alive) timeout\n" \</span><br><span style="color: hsl(0, 100%, 40%);">- "Alive Timer (Tns-alive) number of retries\n"</span><br><span style="color: hsl(120, 100%, 40%);">+ "Alive Timer (Tns-alive) number of retries\n" \</span><br><span style="color: hsl(120, 100%, 40%);">+ "SNS Provision Timer (Tsns-prov) timeout\n"</span><br><span> </span><br><span> /* Educated guess - LLC user payload is 1500 bytes plus possible headers */</span><br><span> #define NS_ALLOC_SIZE 3072</span><br><span>@@ -37,6 +38,7 @@</span><br><span> NS_TOUT_TNS_TEST,</span><br><span> NS_TOUT_TNS_ALIVE,</span><br><span> NS_TOUT_TNS_ALIVE_RETRIES,</span><br><span style="color: hsl(120, 100%, 40%);">+ NS_TOUT_TSNS_PROV,</span><br><span> };</span><br><span> </span><br><span> #define NSE_S_BLOCKED 0x0001</span><br><span>@@ -102,6 +104,8 @@</span><br><span> uint32_t local_ip;</span><br><span> unsigned int enabled:1;</span><br><span> } frgre;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ struct osmo_fsm_inst *bss_sns_fi;</span><br><span> };</span><br><span> </span><br><span> enum nsvc_timer_mode {</span><br><span>@@ -150,6 +154,10 @@</span><br><span> struct sockaddr_in bts_addr;</span><br><span> } frgre;</span><br><span> };</span><br><span style="color: hsl(120, 100%, 40%);">+ /*! signalling weight. 0 = don't use for signalling (BVCI == 0)*/</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t sig_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ /*! signaling weight. 0 = don't use for user data (BVCI != 0) */</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t data_weight;</span><br><span> };</span><br><span> </span><br><span> /* Create a new NS protocol instance */</span><br><span>@@ -169,6 +177,9 @@</span><br><span> struct sockaddr_in *dest,</span><br><span> uint16_t nsei, uint16_t nsvci);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/* Establish a connection (from the BSS) to the SGSN using IP SNS */</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_ns_nsip_connect_sns(struct gprs_ns_inst *nsi, struct sockaddr_in *dest,</span><br><span style="color: hsl(120, 100%, 40%);">+ uint16_t nsei, uint16_t nsvci);</span><br><span> </span><br><span> struct sockaddr_in;</span><br><span> </span><br><span>@@ -185,9 +196,12 @@</span><br><span> int gprs_ns_frgre_listen(struct gprs_ns_inst *nsi);</span><br><span> </span><br><span> struct gprs_nsvc *gprs_nsvc_create(struct gprs_ns_inst *nsi, uint16_t nsvci);</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_nsvc_create2(struct gprs_ns_inst *nsi, uint16_t nsvci,</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t sig_weight, uint8_t data_weight);</span><br><span> void gprs_nsvc_delete(struct gprs_nsvc *nsvc);</span><br><span> struct gprs_nsvc *gprs_nsvc_by_nsei(struct gprs_ns_inst *nsi, uint16_t nsei);</span><br><span> struct gprs_nsvc *gprs_nsvc_by_nsvci(struct gprs_ns_inst *nsi, uint16_t nsvci);</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_nsvc_by_rem_addr(struct gprs_ns_inst *nsi, const struct sockaddr_in *sin);</span><br><span> </span><br><span> /* Initiate a RESET procedure (including timer start, ...)*/</span><br><span> int gprs_nsvc_reset(struct gprs_nsvc *nsvc, uint8_t cause);</span><br><span>@@ -213,6 +227,7 @@</span><br><span> S_NS_ALIVE_EXP, /* Tns-alive expired more than N times */</span><br><span> S_NS_REPLACED, /* nsvc object is replaced (sets old_nsvc) */</span><br><span> S_NS_MISMATCH, /* got an unexpected IE (sets msg, pdu_type, ie_type) */</span><br><span style="color: hsl(120, 100%, 40%);">+ S_SNS_CONFIGURED, /* IP-SNS configuration completed */</span><br><span> };</span><br><span> </span><br><span> extern const struct value_string gprs_ns_signal_ns_names[];</span><br><span>diff --git a/include/osmocom/gprs/protocol/gsm_08_16.h b/include/osmocom/gprs/protocol/gsm_08_16.h</span><br><span>index 15d92d3..95efcb6 100644</span><br><span>--- a/include/osmocom/gprs/protocol/gsm_08_16.h</span><br><span>+++ b/include/osmocom/gprs/protocol/gsm_08_16.h</span><br><span>@@ -66,6 +66,7 @@</span><br><span> NS_IE_IPv6_EP_NR = 0x09,</span><br><span> NS_IE_RESET_FLAG = 0x0a,</span><br><span> NS_IE_IP_ADDR = 0x0b,</span><br><span style="color: hsl(120, 100%, 40%);">+ NS_IE_TRANS_ID = 0xff, /* osmocom. Spec has this IE but without IEI! */</span><br><span> };</span><br><span> </span><br><span> /*! NS Cause (TS 08.16, Section 10.3.2, Table 13) */</span><br><span>diff --git a/src/gb/Makefile.am b/src/gb/Makefile.am</span><br><span>index d074092..3180f9c 100644</span><br><span>--- a/src/gb/Makefile.am</span><br><span>+++ b/src/gb/Makefile.am</span><br><span>@@ -17,7 +17,7 @@</span><br><span> $(top_builddir)/src/vty/libosmovty.la \</span><br><span> $(top_builddir)/src/gsm/libosmogsm.la</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">-libosmogb_la_SOURCES = gprs_ns.c gprs_ns_frgre.c gprs_ns_vty.c \</span><br><span style="color: hsl(120, 100%, 40%);">+libosmogb_la_SOURCES = gprs_ns.c gprs_ns_frgre.c gprs_ns_vty.c gprs_ns_sns.c \</span><br><span> gprs_bssgp.c gprs_bssgp_util.c gprs_bssgp_vty.c \</span><br><span> gprs_bssgp_bss.c common_vty.c</span><br><span> endif</span><br><span>diff --git a/src/gb/gb_internal.h b/src/gb/gb_internal.h</span><br><span>index c1fa8e1..d9eb0e0 100644</span><br><span>--- a/src/gb/gb_internal.h</span><br><span>+++ b/src/gb/gb_internal.h</span><br><span>@@ -4,6 +4,16 @@</span><br><span> #include <osmocom/gsm/tlv.h></span><br><span> #include <osmocom/gprs/gprs_ns.h></span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/* gprs_ns_sns.c */</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_ns_rx_sns(struct gprs_ns_inst *nsi, struct msgb *msg, struct tlv_parsed *tp);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct osmo_fsm_inst *gprs_sns_bss_fsm_alloc(void *ctx, struct gprs_nsvc *nsvc, const char *id);</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_sns_bss_fsm_start(struct gprs_ns_inst *nsi);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_sns_init(void);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/* gprs_ns.c */</span><br><span style="color: hsl(120, 100%, 40%);">+void gprs_start_alive_all_nsvcs(struct gprs_ns_inst *nsi);</span><br><span> int gprs_ns_tx_sns_ack(struct gprs_nsvc *nsvc, uint8_t trans_id, uint8_t *cause,</span><br><span> const struct gprs_ns_ie_ip4_elem *ip4_elems,unsigned int num_ip4_elems);</span><br><span> </span><br><span>diff --git a/src/gb/gprs_ns.c b/src/gb/gprs_ns.c</span><br><span>index 816d2db..8be6146 100644</span><br><span>--- a/src/gb/gprs_ns.c</span><br><span>+++ b/src/gb/gprs_ns.c</span><br><span>@@ -71,6 +71,7 @@</span><br><span> #include <sys/socket.h></span><br><span> #include <arpa/inet.h></span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/fsm.h></span><br><span> #include <osmocom/core/msgb.h></span><br><span> #include <osmocom/core/byteswap.h></span><br><span> #include <osmocom/gsm/tlv.h></span><br><span>@@ -92,6 +93,18 @@</span><br><span> #define ns_set_remote_state(ns_, st_) ns_set_state_with_log(ns_, st_, true, __FILE__, __LINE__)</span><br><span> #define ns_mark_blocked(ns_) ns_set_state(ns_, (ns_)->state | NSE_S_BLOCKED)</span><br><span> #define ns_mark_unblocked(ns_) ns_set_state(ns_, (ns_)->state & (~NSE_S_BLOCKED));</span><br><span style="color: hsl(120, 100%, 40%);">+#define ns_mark_alive(ns_) ns_set_state(ns_, (ns_)->state | NSE_S_ALIVE)</span><br><span style="color: hsl(120, 100%, 40%);">+#define ns_mark_dead(ns_) ns_set_state(ns_, (ns_)->state & (~NSE_S_ALIVE));</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#define ERR_IF_NSVC_USES_SNS(nsvc, reason) \</span><br><span style="color: hsl(120, 100%, 40%);">+ do { \</span><br><span style="color: hsl(120, 100%, 40%);">+ if ((nsvc)->nsi->bss_sns_fi) { \</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Asked to %s. Rejected on IP-SNS\n", \</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei, reason); \</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_log_backtrace(DNS, LOGL_ERROR); \</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO; \</span><br><span style="color: hsl(120, 100%, 40%);">+ } \</span><br><span style="color: hsl(120, 100%, 40%);">+ } while (0)</span><br><span> </span><br><span> static const struct tlv_definition ns_att_tlvdef = {</span><br><span> .def = {</span><br><span>@@ -106,6 +119,7 @@</span><br><span> [NS_IE_IPv4_EP_NR] = { TLV_TYPE_FIXED, 2 },</span><br><span> [NS_IE_IPv6_EP_NR] = { TLV_TYPE_FIXED, 2 },</span><br><span> [NS_IE_RESET_FLAG] = { TLV_TYPE_TV, 0 },</span><br><span style="color: hsl(120, 100%, 40%);">+ [NS_IE_IP_ADDR] = { TLV_TYPE_FIXED, 4 },</span><br><span> },</span><br><span> };</span><br><span> </span><br><span>@@ -170,6 +184,7 @@</span><br><span> { S_NS_ALIVE_EXP, "NS-ALIVE expired" },</span><br><span> { S_NS_REPLACED, "NSVC replaced" },</span><br><span> { S_NS_MISMATCH, "Unexpected IE" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { S_SNS_CONFIGURED, "SNS Configured" },</span><br><span> { 0, NULL }</span><br><span> };</span><br><span> </span><br><span>@@ -236,11 +251,20 @@</span><br><span> return NULL;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/*! Determine active NS-VC for given NSEI + BVCI.</span><br><span style="color: hsl(120, 100%, 40%);">+ * Use this function to determine which of the NS-VCs inside the NS Instance</span><br><span style="color: hsl(120, 100%, 40%);">+ * shall be used to transmit data for given NSEI + BVCI */</span><br><span> static struct gprs_nsvc *gprs_active_nsvc_by_nsei(struct gprs_ns_inst *nsi,</span><br><span style="color: hsl(0, 100%, 40%);">- uint16_t nsei)</span><br><span style="color: hsl(120, 100%, 40%);">+ uint16_t nsei, uint16_t bvci)</span><br><span> {</span><br><span> struct gprs_nsvc *nsvc;</span><br><span> llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* if signalling BVCI, skip any NSVC with signalling weight == 0 */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (bvci == 0 && nsvc->sig_weight == 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ continue;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* if point-to-point BVCI, skip any NSVC with data weight == 0 */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (bvci != 0 && nsvc->data_weight == 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ continue;</span><br><span> if (nsvc->nsei == nsei) {</span><br><span> if (!(nsvc->state & NSE_S_BLOCKED) &&</span><br><span> nsvc->state & NSE_S_ALIVE)</span><br><span>@@ -250,9 +274,11 @@</span><br><span> return NULL;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">-/* Lookup struct gprs_nsvc based on remote peer socket addr */</span><br><span style="color: hsl(0, 100%, 40%);">-static struct gprs_nsvc *nsvc_by_rem_addr(struct gprs_ns_inst *nsi,</span><br><span style="color: hsl(0, 100%, 40%);">- struct sockaddr_in *sin)</span><br><span style="color: hsl(120, 100%, 40%);">+/*! Lookup NS-VC based on specified remote peer socket addr.</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] nsi NS Instance within which we shall look up the NS-VC</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] sin Remote peer Socket Address (IP + UDP Port)</span><br><span style="color: hsl(120, 100%, 40%);">+ * \returns NS-VC matching the given peer; NULL in case of none */</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_nsvc_by_rem_addr(struct gprs_ns_inst *nsi, const struct sockaddr_in *sin)</span><br><span> {</span><br><span> struct gprs_nsvc *nsvc;</span><br><span> llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {</span><br><span>@@ -266,27 +292,52 @@</span><br><span> </span><br><span> static void gprs_ns_timer_cb(void *data);</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">-struct gprs_nsvc *gprs_nsvc_create(struct gprs_ns_inst *nsi, uint16_t nsvci)</span><br><span style="color: hsl(120, 100%, 40%);">+/*! Create a new NS-VC (Virtual Circuit) within given instance</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] nsi NS Instance in which to create the NSVC</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] nsvci] NS Virtual Connection Identifier for this NSVC</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] sig_weight Signalling Weight of this NS-VC. Use "0" for no signalling</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] data_weight Data WEight of this NS-VC. Use "0" for no data</span><br><span style="color: hsl(120, 100%, 40%);">+ * \returns newly-created gprs_nsvc within nsi. NULL on error. */</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_nsvc_create2(struct gprs_ns_inst *nsi, uint16_t nsvci,</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t sig_weight, uint8_t data_weight)</span><br><span> {</span><br><span> struct gprs_nsvc *nsvc;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (gprs_nsvc_by_nsvci(nsi, nsvci)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "Cannot create NS-VC for already-existing NSVCI=%u\n", nsvci);</span><br><span style="color: hsl(120, 100%, 40%);">+ return NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> LOGP(DNS, LOGL_INFO, "NSVCI=%u Creating NS-VC\n", nsvci);</span><br><span> </span><br><span> nsvc = talloc_zero(nsi, struct gprs_nsvc);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ return NULL;</span><br><span> nsvc->nsvci = nsvci;</span><br><span> nsvc->nsvci_is_valid = 1;</span><br><span> /* before RESET procedure: BLOCKED and DEAD */</span><br><span style="color: hsl(0, 100%, 40%);">- ns_set_state(nsvc, NSE_S_BLOCKED);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_set_state(nsvc, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ else</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_set_state(nsvc, NSE_S_BLOCKED);</span><br><span> nsvc->nsi = nsi;</span><br><span> osmo_timer_setup(&nsvc->timer, gprs_ns_timer_cb, nsvc);</span><br><span> nsvc->ctrg = rate_ctr_group_alloc(nsvc, &nsvc_ctrg_desc, nsvci);</span><br><span> nsvc->statg = osmo_stat_item_group_alloc(nsvc, &nsvc_statg_desc, nsvci);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->sig_weight = sig_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->data_weight = data_weight;</span><br><span> </span><br><span> llist_add(&nsvc->list, &nsi->gprs_nsvcs);</span><br><span> </span><br><span> return nsvc;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/*! Old API for creating a NS-VC. Uses gprs_nsvc_create2 with fixed weights. */</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_nsvc_create(struct gprs_ns_inst *nsi, uint16_t nsvci)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ return gprs_nsvc_create2(nsi, nsvci, 1, 1);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> /*! Delete given NS-VC</span><br><span> * \param[in] nsvc gprs_nsvc to be deleted</span><br><span> */</span><br><span>@@ -442,13 +493,16 @@</span><br><span> */</span><br><span> int gprs_ns_tx_reset(struct gprs_nsvc *nsvc, uint8_t cause)</span><br><span> {</span><br><span style="color: hsl(0, 100%, 40%);">- struct msgb *msg = gprs_ns_msgb_alloc();</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg;</span><br><span> struct gprs_ns_hdr *nsh;</span><br><span> uint16_t nsvci = osmo_htons(nsvc->nsvci);</span><br><span> uint16_t nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> log_set_context(LOG_CTX_GB_NSVC, nsvc);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "transmit NS RESET");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ msg = gprs_ns_msgb_alloc();</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span>@@ -528,12 +582,15 @@</span><br><span> */</span><br><span> int gprs_ns_tx_block(struct gprs_nsvc *nsvc, uint8_t cause)</span><br><span> {</span><br><span style="color: hsl(0, 100%, 40%);">- struct msgb *msg = gprs_ns_msgb_alloc();</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg;</span><br><span> struct gprs_ns_hdr *nsh;</span><br><span> uint16_t nsvci = osmo_htons(nsvc->nsvci);</span><br><span> </span><br><span> log_set_context(LOG_CTX_GB_NSVC, nsvc);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "transmit NS BLOCK");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ msg = gprs_ns_msgb_alloc();</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span>@@ -566,6 +623,8 @@</span><br><span> </span><br><span> log_set_context(LOG_CTX_GB_NSVC, nsvc);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "transmit NS BLOCK ACK");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> msg = gprs_ns_msgb_alloc();</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span>@@ -589,6 +648,9 @@</span><br><span> int gprs_ns_tx_unblock(struct gprs_nsvc *nsvc)</span><br><span> {</span><br><span> log_set_context(LOG_CTX_GB_NSVC, nsvc);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "transmit NS UNBLOCK");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> LOGP(DNS, LOGL_INFO, "NSEI=%u Tx NS UNBLOCK (NSVCI=%u)\n",</span><br><span> nsvc->nsei, nsvc->nsvci);</span><br><span> </span><br><span>@@ -679,16 +741,21 @@</span><br><span> nsvc->alive_retries++;</span><br><span> if (nsvc->alive_retries ></span><br><span> nsvc->nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {</span><br><span style="color: hsl(0, 100%, 40%);">- /* mark as dead and blocked */</span><br><span style="color: hsl(0, 100%, 40%);">- ns_set_state(nsvc, NSE_S_BLOCKED);</span><br><span style="color: hsl(0, 100%, 40%);">- rate_ctr_inc(&nsvc->ctrg->ctr[NS_CTR_BLOCKED]);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* mark as dead (and blocked unless IP-SNS) */</span><br><span> rate_ctr_inc(&nsvc->ctrg->ctr[NS_CTR_DEAD]);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_set_state(nsvc, NSE_S_BLOCKED);</span><br><span style="color: hsl(120, 100%, 40%);">+ rate_ctr_inc(&nsvc->ctrg->ctr[NS_CTR_BLOCKED]);</span><br><span style="color: hsl(120, 100%, 40%);">+ } else</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_set_state(nsvc, 0);</span><br><span> LOGP(DNS, LOGL_NOTICE,</span><br><span> "NSEI=%u Tns-alive expired more then "</span><br><span> "%u times, blocking NS-VC\n", nsvc->nsei,</span><br><span> nsvc->nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]);</span><br><span> ns_osmo_signal_dispatch(nsvc, S_NS_ALIVE_EXP, 0);</span><br><span style="color: hsl(0, 100%, 40%);">- ns_osmo_signal_dispatch(nsvc, S_NS_BLOCK, NS_CAUSE_NSVC_BLOCKED);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: should we send this signal in case of SNS? */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsvc->nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_osmo_signal_dispatch(nsvc, S_NS_BLOCK, NS_CAUSE_NSVC_BLOCKED);</span><br><span> return;</span><br><span> }</span><br><span> /* Tns-test case: send NS-ALIVE PDU */</span><br><span>@@ -725,11 +792,15 @@</span><br><span> /* Section 9.2.6 */</span><br><span> static int gprs_ns_tx_reset_ack(struct gprs_nsvc *nsvc)</span><br><span> {</span><br><span style="color: hsl(0, 100%, 40%);">- struct msgb *msg = gprs_ns_msgb_alloc();</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg;</span><br><span> struct gprs_ns_hdr *nsh;</span><br><span> uint16_t nsvci, nsei;</span><br><span> </span><br><span> log_set_context(LOG_CTX_GB_NSVC, nsvc);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "transmit NS RESET ACK");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ msg = gprs_ns_msgb_alloc();</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span>@@ -769,6 +840,13 @@</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Cannot transmit SNS on NSVC without SNS active\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei);</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_free(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> msg->l2h = msgb_put(msg, sizeof(*nsh));</span><br><span>@@ -807,6 +885,13 @@</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Cannot transmit SNS on NSVC without SNS active\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei);</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_free(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> msg->l2h = msgb_put(msg, sizeof(*nsh));</span><br><span>@@ -839,6 +924,13 @@</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Cannot transmit SNS on NSVC without SNS active\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei);</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_free(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> msg->l2h = msgb_put(msg, sizeof(*nsh));</span><br><span>@@ -872,6 +964,13 @@</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Cannot transmit SNS on NSVC without SNS active\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei);</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_free(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> msg->l2h = msgb_put(msg, sizeof(*nsh));</span><br><span>@@ -904,6 +1003,13 @@</span><br><span> if (!msg)</span><br><span> return -ENOMEM;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Cannot transmit SNS on NSVC without SNS active\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei);</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_free(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EIO;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsei = osmo_htons(nsvc->nsei);</span><br><span> </span><br><span> msg->l2h = msgb_put(msg, sizeof(*nsh));</span><br><span>@@ -934,7 +1040,7 @@</span><br><span> struct gprs_ns_hdr *nsh;</span><br><span> uint16_t bvci = msgb_bvci(msg);</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">- nsvc = gprs_active_nsvc_by_nsei(nsi, msgb_nsei(msg));</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_active_nsvc_by_nsei(nsi, msgb_nsei(msg), msgb_bvci(msg));</span><br><span> if (!nsvc) {</span><br><span> int rc;</span><br><span> if (gprs_nsvc_by_nsei(nsi, msgb_nsei(msg))) {</span><br><span>@@ -1352,7 +1458,7 @@</span><br><span> int rc = 0;</span><br><span> </span><br><span> /* look up the NSVC based on source address */</span><br><span style="color: hsl(0, 100%, 40%);">- nsvc = nsvc_by_rem_addr(nsi, saddr);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_by_rem_addr(nsi, saddr);</span><br><span> </span><br><span> if (!nsvc) {</span><br><span> struct gprs_nsvc *fallback_nsvc;</span><br><span>@@ -1566,6 +1672,7 @@</span><br><span> struct gprs_nsvc **nsvc)</span><br><span> {</span><br><span> struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed tp;</span><br><span> int rc = 0;</span><br><span> </span><br><span> msgb_nsei(msg) = (*nsvc)->nsei;</span><br><span>@@ -1588,6 +1695,7 @@</span><br><span> rc = gprs_ns_tx_alive_ack(*nsvc);</span><br><span> break;</span><br><span> case NS_PDUT_ALIVE_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_mark_alive(*nsvc);</span><br><span> if ((*nsvc)->timer_mode == NSVC_TIMER_TNS_ALIVE)</span><br><span> osmo_stat_item_set((*nsvc)->statg->items[NS_STAT_ALIVE_DELAY],</span><br><span> nsvc_timer_elapsed_ms(*nsvc));</span><br><span>@@ -1642,15 +1750,68 @@</span><br><span> /* mark remote NS-VC as blocked + active */</span><br><span> ns_set_remote_state(*nsvc, NSE_S_BLOCKED | NSE_S_ALIVE);</span><br><span> break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CONFIG:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ goto unexpected_sns;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* one additional byte ('end flag') before the TLV part starts */</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = tlv_parse(&tp, &ns_att_tlvdef, nsh->data+1,</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_l2len(msg) - sizeof(*nsh)-1, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPC(DNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));</span><br><span style="color: hsl(120, 100%, 40%);">+ return rc;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ /* All sub-network service related message types */</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = gprs_ns_rx_sns(nsi, msg, &tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_ADD:</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CHANGE_WEIGHT:</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_DELETE:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ goto unexpected_sns;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* weird layout: NSEI TLV, then value-only transaction IE, then TLV again */</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = tlv_parse(&tp, &ns_att_tlvdef, nsh->data+5,</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_l2len(msg) - sizeof(*nsh)-5, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPC(DNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));</span><br><span style="color: hsl(120, 100%, 40%);">+ return rc;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ tp.lv[NS_IE_NSEI].val = nsh->data+2;</span><br><span style="color: hsl(120, 100%, 40%);">+ tp.lv[NS_IE_NSEI].len = 2;</span><br><span style="color: hsl(120, 100%, 40%);">+ tp.lv[NS_IE_TRANS_ID].val = nsh->data+4;</span><br><span style="color: hsl(120, 100%, 40%);">+ tp.lv[NS_IE_TRANS_ID].len = 1;</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = gprs_ns_rx_sns(nsi, msg, &tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CONFIG_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_SIZE:</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_SIZE_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ goto unexpected_sns;</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = tlv_parse(&tp, &ns_att_tlvdef, nsh->data,</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_l2len(msg) - sizeof(*nsh), 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPC(DNS, LOGL_NOTICE, "Error during TLV Parse in %s\n", msgb_hexdump(msg));</span><br><span style="color: hsl(120, 100%, 40%);">+ return rc;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ /* All sub-network service related message types */</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = gprs_ns_rx_sns(nsi, msg, &tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span> default:</span><br><span> LOGP(DNS, LOGL_NOTICE, "NSEI=%u Rx Unknown NS PDU type 0x%02x\n",</span><br><span> (*nsvc)->nsei, nsh->pdu_type);</span><br><span> rc = -EINVAL;</span><br><span> break;</span><br><span style="color: hsl(120, 100%, 40%);">+unexpected_sns:</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_NOTICE, "NSEI=%u Rx %s for NS Instance that has no SNS!\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ (*nsvc)->nsei, get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = -EINVAL;</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span> }</span><br><span> return rc;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+static bool gprs_sns_fsm_registered = false;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> /*! Create a new GPRS NS instance</span><br><span> * \param[in] cb Call-back function for incoming BSSGP data</span><br><span> * \returns dynamically allocated gprs_ns_inst</span><br><span>@@ -1659,6 +1820,11 @@</span><br><span> {</span><br><span> struct gprs_ns_inst *nsi = talloc_zero(ctx, struct gprs_ns_inst);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (!gprs_sns_fsm_registered) {</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_sns_init();</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_sns_fsm_registered = true;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> nsi->cb = cb;</span><br><span> INIT_LLIST_HEAD(&nsi->gprs_nsvcs);</span><br><span> nsi->timeout[NS_TOUT_TNS_BLOCK] = 3;</span><br><span>@@ -1668,6 +1834,7 @@</span><br><span> nsi->timeout[NS_TOUT_TNS_TEST] = 30;</span><br><span> nsi->timeout[NS_TOUT_TNS_ALIVE] = 3;</span><br><span> nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES] = 10;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsi->timeout[NS_TOUT_TSNS_PROV] = 3; /* 1..10 */</span><br><span> </span><br><span> /* Create the dummy NSVC that we use for sending</span><br><span> * messages to non-existant/unknown NS-VC's */</span><br><span>@@ -1869,6 +2036,8 @@</span><br><span> {</span><br><span> int rc;</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ ERR_IF_NSVC_USES_SNS(nsvc, "RESET procedure based on API request");</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> LOGP(DNS, LOGL_INFO, "NSEI=%u RESET procedure based on API request\n",</span><br><span> nsvc->nsei);</span><br><span> </span><br><span>@@ -1903,7 +2072,7 @@</span><br><span> {</span><br><span> struct gprs_nsvc *nsvc;</span><br><span> </span><br><span style="color: hsl(0, 100%, 40%);">- nsvc = nsvc_by_rem_addr(nsi, dest);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_by_rem_addr(nsi, dest);</span><br><span> if (!nsvc)</span><br><span> nsvc = gprs_nsvc_create(nsi, nsvci);</span><br><span> nsvc->ip.bts_addr = *dest;</span><br><span>@@ -1914,6 +2083,47 @@</span><br><span> return nsvc;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/*! Establish a NS connection (from the BSS) to the SGSN using SNS auto-configuration</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param nsi NS-instance</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] dest Destination IP/Port</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] nsei NSEI of the to-be-established NS-VC</span><br><span style="color: hsl(120, 100%, 40%);">+ * \param[in] nsvci NSVCI of the to-be-established NS-VC</span><br><span style="color: hsl(120, 100%, 40%);">+ * \returns struct gprs_nsvc representing the new NS-VC</span><br><span style="color: hsl(120, 100%, 40%);">+ *</span><br><span style="color: hsl(120, 100%, 40%);">+ * This function will establish a single NS/UDP/IP connection in uplink</span><br><span style="color: hsl(120, 100%, 40%);">+ * (BSS to SGSN) direction. It will start with the SNS-SIZE procedure,</span><br><span style="color: hsl(120, 100%, 40%);">+ * followed by BSS-originated SNS-CONFIG, then SGSN-originated SNS-CONFIG.</span><br><span style="color: hsl(120, 100%, 40%);">+ *</span><br><span style="color: hsl(120, 100%, 40%);">+ * Once configuration completes, the user will be notified by the S_SNS_CONFIGURED signal,</span><br><span style="color: hsl(120, 100%, 40%);">+ * at which point he typically would want to initiate NS-RESET by means of gprs_nsvc_reset().</span><br><span style="color: hsl(120, 100%, 40%);">+ */</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_nsvc *gprs_ns_nsip_connect_sns(struct gprs_ns_inst *nsi,</span><br><span style="color: hsl(120, 100%, 40%);">+ struct sockaddr_in *dest, uint16_t nsei,</span><br><span style="color: hsl(120, 100%, 40%);">+ uint16_t nsvci)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: We are getting the order wrong here. Normally, one would want</span><br><span style="color: hsl(120, 100%, 40%);">+ * to start the SNS FSM *before* creating any NS-VC and then create the NS-VC</span><br><span style="color: hsl(120, 100%, 40%);">+ * after the SNS layer has established the IP/port/etc. However, this would</span><br><span style="color: hsl(120, 100%, 40%);">+ * require some massive code and API changes compared to existing libosmogb,</span><br><span style="color: hsl(120, 100%, 40%);">+ * so let's keep the old logic. */</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_by_rem_addr(nsi, dest);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_create(nsi, nsvci);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->ip.bts_addr = *dest;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei = nsei;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->remote_end_is_sgsn = 1;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* NSVCs are always UNBLOCKED in IP-SNS */</span><br><span style="color: hsl(120, 100%, 40%);">+ ns_set_state(nsvc, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsi->bss_sns_fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_term(nsi->bss_sns_fi, OSMO_FSM_TERM_REQUEST, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsi->bss_sns_fi = gprs_sns_bss_fsm_alloc(nsi, nsvc, "NSIP");</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_sns_bss_fsm_start(nsi);</span><br><span style="color: hsl(120, 100%, 40%);">+ return nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> void gprs_ns_set_log_ss(int ss)</span><br><span> {</span><br><span> DNS = ss;</span><br><span>@@ -1941,4 +2151,15 @@</span><br><span> return s;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/*! Start the ALIVE timer procedure in all NS-VCs part of this NS Instance */</span><br><span style="color: hsl(120, 100%, 40%);">+void gprs_start_alive_all_nsvcs(struct gprs_ns_inst *nsi)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+ llist_for_each_entry(nsvc, &nsi->gprs_nsvcs, list) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* start the test procedure */</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_alive(nsvc);</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc_start_timer(nsvc, NSVC_TIMER_TNS_TEST);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> /*! @} */</span><br><span>diff --git a/src/gb/gprs_ns_sns.c b/src/gb/gprs_ns_sns.c</span><br><span>new file mode 100644</span><br><span>index 0000000..159e136</span><br><span>--- /dev/null</span><br><span>+++ b/src/gb/gprs_ns_sns.c</span><br><span>@@ -0,0 +1,617 @@</span><br><span style="color: hsl(120, 100%, 40%);">+/* Implementation of 3GPP TS 48.016 NS IP Sub-Network Service */</span><br><span style="color: hsl(120, 100%, 40%);">+/* (C) 2018 by Harald Welte <laforge@gnumonks.org> */</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/* The BSS NSE only has one SGSN IP address configured, and it will use the SNS procedures</span><br><span style="color: hsl(120, 100%, 40%);">+ * to communicated its local IPs/ports as well as all the SGSN side IPs/ports and</span><br><span style="color: hsl(120, 100%, 40%);">+ * associated weights. In theory, the BSS then uses this to establish a full mesh</span><br><span style="color: hsl(120, 100%, 40%);">+ * of NSVCs between all BSS-side IPs/ports and SGSN-side IPs/ports */</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#include <errno.h></span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#include <netinet/in.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <arpa/inet.h></span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/fsm.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/msgb.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/signal.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/socket.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/gsm/tlv.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/gprs/gprs_msgb.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/gprs/gprs_ns.h></span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#include "common_vty.h"</span><br><span style="color: hsl(120, 100%, 40%);">+#include "gb_internal.h"</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+#define S(x) (1 << (x))</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct gprs_sns_state {</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc_hack;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* local configuration to send to the remote end */</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_ie_ip4_elem *ip4_local;</span><br><span style="color: hsl(120, 100%, 40%);">+ size_t num_ip4_local;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* local configuration about our capabilities in terms of connections to</span><br><span style="color: hsl(120, 100%, 40%);">+ * remote (SGSN) side */</span><br><span style="color: hsl(120, 100%, 40%);">+ size_t num_max_nsvcs;</span><br><span style="color: hsl(120, 100%, 40%);">+ size_t num_max_ip4_remote;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* remote configuration as received */</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_ie_ip4_elem *ip4_remote;</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int num_ip4_remote;</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static inline struct gprs_ns_inst *ns_inst_from_fi(struct osmo_fsm_inst *fi)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ return gss->nsi;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/* helper function to compute the sum of all (data or signaling) weights */</span><br><span style="color: hsl(120, 100%, 40%);">+static int ip4_weight_sum(const struct gprs_ns_ie_ip4_elem *ip4, unsigned int num,</span><br><span style="color: hsl(120, 100%, 40%);">+ bool data_weight)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int i;</span><br><span style="color: hsl(120, 100%, 40%);">+ int weight_sum = 0;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ for (i = 0; i < num; i++) {</span><br><span style="color: hsl(120, 100%, 40%);">+ if (data_weight)</span><br><span style="color: hsl(120, 100%, 40%);">+ weight_sum += ip4[i].data_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ else</span><br><span style="color: hsl(120, 100%, 40%);">+ weight_sum += ip4[i].sig_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ return weight_sum;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+#define ip4_weight_sum_data(x,y) ip4_weight_sum(x, y, true)</span><br><span style="color: hsl(120, 100%, 40%);">+#define ip4_weight_sum_sig(x,y) ip4_weight_sum(x, y, false)</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static struct gprs_nsvc *nsvc_by_ip4_elem(struct gprs_ns_inst *nsi,</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct gprs_ns_ie_ip4_elem *ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct sockaddr_in sin;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* copy over. Both data structures use network byte order */</span><br><span style="color: hsl(120, 100%, 40%);">+ sin.sin_addr.s_addr = ip4->ip_addr;</span><br><span style="color: hsl(120, 100%, 40%);">+ sin.sin_port = ip4->udp_port;</span><br><span style="color: hsl(120, 100%, 40%);">+ return gprs_nsvc_by_rem_addr(nsi, &sin);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static struct gprs_nsvc *gprs_nsvc_create_ip4(struct gprs_ns_inst *nsi,</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct gprs_ns_ie_ip4_elem *ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) nsi->bss_sns_fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct sockaddr_in sin;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* copy over. Both data structures use network byte order */</span><br><span style="color: hsl(120, 100%, 40%);">+ sin.sin_addr.s_addr = ip4->ip_addr;</span><br><span style="color: hsl(120, 100%, 40%);">+ sin.sin_port = ip4->udp_port;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_create2(nsi, 0xFFFF, ip4->sig_weight, ip4->data_weight);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ return NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsei = gss->nsvc_hack->nsei;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->nsvci_is_valid = 0;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->ip.bts_addr = sin;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ return nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static int create_missing_nsvcs(struct osmo_fsm_inst *fi)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int i;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ for (i = 0; i < gss->num_ip4_remote; i++) {</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct gprs_ns_ie_ip4_elem *ip4 = &gss->ip4_remote[i];</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc = nsvc_by_ip4_elem(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* create, if it doesn't exist */</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_create_ip4(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_ERROR, "SNS-CONFIG: Failed to create NSVC\n");</span><br><span style="color: hsl(120, 100%, 40%);">+ continue;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* update data / signalling weight */</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->data_weight = ip4->data_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->sig_weight = ip4->sig_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_INFO, "NS-VC %s data_weight=%u, sig_weight=%u\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_ll_str(nsvc), nsvc->data_weight, nsvc->sig_weight);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static int do_sns_change_weight(struct osmo_fsm_inst *fi, const struct gprs_ns_ie_ip4_elem *ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc = nsvc_by_ip4_elem(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ return -ENODEV;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->data_weight = ip4->data_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc->sig_weight = ip4->sig_weight;</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_INFO, "CHANGE-WEIGHT NS-VC %s data_weight=%u, sig_weight=%u\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_ll_str(nsvc), nsvc->data_weight, nsvc->sig_weight);</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static int do_sns_add(struct osmo_fsm_inst *fi, const struct gprs_ns_ie_ip4_elem *ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc = nsvc_by_ip4_elem(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EEXIST;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ nsvc = gprs_nsvc_create_ip4(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_ERROR, "SNS-ADD: Failed to create NSVC\n");</span><br><span style="color: hsl(120, 100%, 40%);">+ return -1;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_INFO, "ADD NS-VC %s data_weight=%u, sig_weight=%u\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_ll_str(nsvc), nsvc->data_weight, nsvc->sig_weight);</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static int do_sns_delete(struct osmo_fsm_inst *fi, const struct gprs_ns_ie_ip4_elem *ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_nsvc *nsvc = nsvc_by_ip4_elem(nsi, ip4);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!nsvc)</span><br><span style="color: hsl(120, 100%, 40%);">+ return -ENODEV;</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_INFO, "DELETE NS-VC %s\n", gprs_ns_ll_str(nsvc));</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_nsvc_delete(nsvc);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: remove from gss->ip4_remote */</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/***********************************************************************</span><br><span style="color: hsl(120, 100%, 40%);">+ * BSS-side FSM for IP Sub-Network Service</span><br><span style="color: hsl(120, 100%, 40%);">+ ***********************************************************************/</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+enum gprs_sns_bss_state {</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_ST_UNCONFIGURED,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_ST_SIZE, /*!< SNS-SIZE procedure ongoing */</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_ST_CONFIG_BSS, /*!< SNS-CONFIG procedure (BSS->SGSN) ongoing */</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_ST_CONFIG_SGSN, /*!< SNS-CONFIG procedure (SGSN->BSS) ongoing */</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_ST_CONFIGURED,</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+enum gprs_sns_event {</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_START,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_SIZE,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_SIZE_ACK,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_CONFIG,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_CONFIG_END, /*!< SNS-CONFIG with end flag received */</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_CONFIG_ACK,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_ADD,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_DELETE,</span><br><span style="color: hsl(120, 100%, 40%);">+ GPRS_SNS_EV_CHANGE_WEIGHT,</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static const struct value_string gprs_sns_event_names[] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_START, "START" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_SIZE, "SIZE" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_SIZE_ACK, "SIZE_ACK" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_CONFIG, "CONFIG" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_CONFIG_END, "CONFIG_END" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { GPRS_SNS_EV_CONFIG_ACK, "CONFIG_ACK" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { 0, NULL }</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_unconfigured(struct osmo_fsm_inst *fi, uint32_t event, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_START:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_SIZE, nsi->timeout[NS_TOUT_TSNS_PROV], 1);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(0);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_size(struct osmo_fsm_inst *fi, uint32_t event, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed *tp = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_SIZE_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_VAL_MINLEN(tp, NS_IE_CAUSE, 1)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_ERROR, "SNS-SIZE-ACK with cause %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_cause_str(*TLVP_VAL(tp, NS_IE_CAUSE)));</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: What to do? */</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_CONFIG_BSS,</span><br><span style="color: hsl(120, 100%, 40%);">+ nsi->timeout[NS_TOUT_TSNS_PROV], 2);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(0);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_size_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ uint16_t num_max_ip4_remote = gss->num_max_ip4_remote;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_size(gss->nsvc_hack, true, gss->num_max_nsvcs, &num_max_ip4_remote, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_config_bss(struct osmo_fsm_inst *fi, uint32_t event, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ //struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ //struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed *tp = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_CONFIG_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_VAL_MINLEN(tp, NS_IE_CAUSE, 1)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_ERROR, "SNS-CONFIG-ACK with cause %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_cause_str(*TLVP_VAL(tp, NS_IE_CAUSE)));</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: What to do? */</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_CONFIG_SGSN, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(0);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_config_bss_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Transmit SNS-CONFIG */</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_config(gss->nsvc_hack, true, gss->ip4_local, gss->num_ip4_local);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_config_sgsn(struct osmo_fsm_inst *fi, uint32_t event, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed *tp = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct gprs_ns_ie_ip4_elem *v4_list;</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int num_v4;</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t cause;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_CONFIG_END:</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_CONFIG:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+#if 0 /* part of incoming SNS-SIZE (doesn't happen on BSS side */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_PRESENT(tp, NS_IE_RESET_FLAG)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* reset all existing config */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (gss->ip4_remote)</span><br><span style="color: hsl(120, 100%, 40%);">+ talloc_free(gss->ip4_remote);</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_ip4_remote = 0;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+#endif</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!TLVP_PRESENT(tp, NS_IE_IPv4_LIST)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_INVAL_NR_IPv4_EP;</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_config_ack(gss->nsvc_hack, &cause);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_UNCONFIGURED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ v4_list = (const struct gprs_ns_ie_ip4_elem *) TLVP_VAL(tp, NS_IE_IPv4_LIST);</span><br><span style="color: hsl(120, 100%, 40%);">+ num_v4 = TLVP_LEN(tp, NS_IE_IPv4_LIST) / sizeof(*v4_list);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* realloc to the new size */</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->ip4_remote = talloc_realloc(gss, gss->ip4_remote,</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_ie_ip4_elem,</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_ip4_remote+num_v4);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* append the new entries to the end of the list */</span><br><span style="color: hsl(120, 100%, 40%);">+ memcpy(&gss->ip4_remote[gss->num_ip4_remote], v4_list, num_v4*sizeof(*v4_list));</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_ip4_remote += num_v4;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_INFO, "Rx SNS-CONFIG: Remote IPv4 list now %u entries\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_ip4_remote);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (event == GPRS_SNS_EV_CONFIG_END) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* check if sum of data / sig weights == 0 */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (ip4_weight_sum_data(gss->ip4_remote, gss->num_ip4_remote) == 0 ||</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4_weight_sum_sig(gss->ip4_remote, gss->num_ip4_remote) == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_INVAL_WEIGH;</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_config_ack(gss->nsvc_hack, &cause);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_UNCONFIGURED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ create_missing_nsvcs(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_config_ack(gss->nsvc_hack, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* start the test procedure on ALL NSVCs! */</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_start_alive_all_nsvcs(nsi);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_CONFIGURED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* just send CONFIG-ACK */</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_config_ack(gss->nsvc_hack, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(0);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_configured(struct osmo_fsm_inst *fi, uint32_t event, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss = (struct gprs_sns_state *) fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed *tp = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct gprs_ns_ie_ip4_elem *v4_list = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int num_v4 = 0;</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t trans_id;</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t cause = 0xff;</span><br><span style="color: hsl(120, 100%, 40%);">+ unsigned int i;</span><br><span style="color: hsl(120, 100%, 40%);">+ int rc;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_ADD:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ trans_id = *TLVP_VAL(tp, NS_IE_TRANS_ID);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_PRESENT(tp, NS_IE_IPv4_LIST)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ v4_list = (const struct gprs_ns_ie_ip4_elem *) TLVP_VAL(tp, NS_IE_IPv4_LIST);</span><br><span style="color: hsl(120, 100%, 40%);">+ num_v4 = TLVP_LEN(tp, NS_IE_IPv4_LIST) / sizeof(*v4_list);</span><br><span style="color: hsl(120, 100%, 40%);">+ for (i = 0; i < num_v4; i++) {</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = do_sns_add(fi, &v4_list[i]);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_EQUIP_FAIL;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* continue to add others */</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cause != 0xff) {</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_INVAL_NR_IPv4_EP;</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, NULL, v4_list, num_v4);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_DELETE:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ trans_id = *TLVP_VAL(tp, NS_IE_TRANS_ID);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_PRESENT(tp, NS_IE_IPv4_LIST)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ v4_list = (const struct gprs_ns_ie_ip4_elem *) TLVP_VAL(tp, NS_IE_IPv4_LIST);</span><br><span style="color: hsl(120, 100%, 40%);">+ num_v4 = TLVP_LEN(tp, NS_IE_IPv4_LIST) / sizeof(*v4_list);</span><br><span style="color: hsl(120, 100%, 40%);">+ for (i = 0; i < num_v4; i++) {</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = do_sns_delete(fi, &v4_list[i]);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_EQUIP_FAIL;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* continue to delete others */</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cause != 0xff) {</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ } else if (TLVP_PRESENT(tp, NS_IE_IP_ADDR)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME */</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_INVAL_NR_IPv4_EP;</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, NULL, v4_list, num_v4);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case GPRS_SNS_EV_CHANGE_WEIGHT:</span><br><span style="color: hsl(120, 100%, 40%);">+ tp = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ trans_id = *TLVP_VAL(tp, NS_IE_TRANS_ID);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (TLVP_PRESENT(tp, NS_IE_IPv4_LIST)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ v4_list = (const struct gprs_ns_ie_ip4_elem *) TLVP_VAL(tp, NS_IE_IPv4_LIST);</span><br><span style="color: hsl(120, 100%, 40%);">+ num_v4 = TLVP_LEN(tp, NS_IE_IPv4_LIST) / sizeof(*v4_list);</span><br><span style="color: hsl(120, 100%, 40%);">+ for (i = 0; i < num_v4; i++) {</span><br><span style="color: hsl(120, 100%, 40%);">+ rc = do_sns_change_weight(fi, &v4_list[i]);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_EQUIP_FAIL;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* continue to others */</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cause != 0xff) {</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ cause = NS_CAUSE_INVAL_NR_IPv4_EP;</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, NULL, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_ns_tx_sns_ack(gss->nsvc_hack, trans_id, &cause, v4_list, num_v4);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void gprs_sns_st_configured_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct ns_signal_data nssd = {0};</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_signal_dispatch(SS_L_NS, S_SNS_CONFIGURED, &nssd);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static const struct osmo_fsm_state gprs_sns_bss_states[] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ [GPRS_SNS_ST_UNCONFIGURED] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(GPRS_SNS_EV_START),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(GPRS_SNS_ST_SIZE),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "UNCONFIGURED",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = gprs_sns_st_unconfigured,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [GPRS_SNS_ST_SIZE] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(GPRS_SNS_EV_SIZE_ACK),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(GPRS_SNS_ST_UNCONFIGURED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_SIZE) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_CONFIG_BSS),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "SIZE",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = gprs_sns_st_size,</span><br><span style="color: hsl(120, 100%, 40%);">+ .onenter = gprs_sns_st_size_onenter,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [GPRS_SNS_ST_CONFIG_BSS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(GPRS_SNS_EV_CONFIG_ACK),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(GPRS_SNS_ST_UNCONFIGURED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_CONFIG_BSS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_CONFIG_SGSN),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "CONFIG_BSS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = gprs_sns_st_config_bss,</span><br><span style="color: hsl(120, 100%, 40%);">+ .onenter = gprs_sns_st_config_bss_onenter,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [GPRS_SNS_ST_CONFIG_SGSN] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(GPRS_SNS_EV_CONFIG) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_EV_CONFIG_END),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(GPRS_SNS_ST_UNCONFIGURED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_CONFIG_SGSN) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_ST_CONFIGURED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "CONFIG_SGSN",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = gprs_sns_st_config_sgsn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [GPRS_SNS_ST_CONFIGURED] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(GPRS_SNS_EV_ADD) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_EV_DELETE) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GPRS_SNS_EV_CHANGE_WEIGHT),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(GPRS_SNS_ST_UNCONFIGURED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "CONFIGURED",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = gprs_sns_st_configured,</span><br><span style="color: hsl(120, 100%, 40%);">+ .onenter = gprs_sns_st_configured_onenter,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static int gprs_sns_fsm_bss_timer_cb(struct osmo_fsm_inst *fi)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = ns_inst_from_fi(fi);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (fi->T) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case 1:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_SIZE, nsi->timeout[NS_TOUT_TSNS_PROV], 1);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case 2:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, GPRS_SNS_ST_CONFIG_BSS, nsi->timeout[NS_TOUT_TSNS_PROV], 2);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static struct osmo_fsm gprs_sns_bss_fsm = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "GPRS-SNS-BSS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .states = gprs_sns_bss_states,</span><br><span style="color: hsl(120, 100%, 40%);">+ .num_states = ARRAY_SIZE(gprs_sns_bss_states),</span><br><span style="color: hsl(120, 100%, 40%);">+ .allstate_event_mask = 0,</span><br><span style="color: hsl(120, 100%, 40%);">+ .allstate_action = NULL,</span><br><span style="color: hsl(120, 100%, 40%);">+ .cleanup = NULL,</span><br><span style="color: hsl(120, 100%, 40%);">+ .timer_cb = gprs_sns_fsm_bss_timer_cb,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* .log_subsys = DNS, "is not constant" */</span><br><span style="color: hsl(120, 100%, 40%);">+ .event_names = gprs_sns_event_names,</span><br><span style="color: hsl(120, 100%, 40%);">+ .pre_term = NULL,</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct osmo_fsm_inst *gprs_sns_bss_fsm_alloc(void *ctx, struct gprs_nsvc *nsvc,</span><br><span style="color: hsl(120, 100%, 40%);">+ const char *id)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct osmo_fsm_inst *fi;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_sns_state *gss;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_ie_ip4_elem *ip4;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_inst *nsi = nsvc->nsi;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ fi = osmo_fsm_inst_alloc(&gprs_sns_bss_fsm, ctx, NULL, LOGL_DEBUG, id);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ return fi;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ gss = talloc_zero(fi, struct gprs_sns_state);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!gss)</span><br><span style="color: hsl(120, 100%, 40%);">+ goto err;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ fi->priv = gss;</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->nsi = nsi;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: we shouldn't use 'nsvc' here but only gprs_ns_inst */</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->nsvc_hack = nsvc;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* create IPv4 list from the one IP/port the NS instance has */</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4 = talloc_zero(gss, struct gprs_ns_ie_ip4_elem);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!ip4)</span><br><span style="color: hsl(120, 100%, 40%);">+ goto err;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsi->nsip.local_ip)</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4->ip_addr = htonl(nsi->nsip.local_ip);</span><br><span style="color: hsl(120, 100%, 40%);">+ else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* unspecified local address. Figure out which address the kernel would use if we</span><br><span style="color: hsl(120, 100%, 40%);">+ * wanted to send a packet to the remote_ip */</span><br><span style="color: hsl(120, 100%, 40%);">+ char local_ip[32];</span><br><span style="color: hsl(120, 100%, 40%);">+ struct in_addr in = { .s_addr = htonl(nsi->nsip.remote_ip) };</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_sock_local_ip(local_ip, inet_ntoa(in));</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4->ip_addr = inet_addr(local_ip);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4->udp_port = htons(gss->nsi->nsip.local_port);</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4->sig_weight = 2;</span><br><span style="color: hsl(120, 100%, 40%);">+ ip4->data_weight = 1;</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->ip4_local = ip4;</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_ip4_local = 1;</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_max_nsvcs = 8;</span><br><span style="color: hsl(120, 100%, 40%);">+ gss->num_max_ip4_remote = 4;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ return fi;</span><br><span style="color: hsl(120, 100%, 40%);">+err:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_term(fi, OSMO_FSM_TERM_ERROR, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+ return NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_sns_bss_fsm_start(struct gprs_ns_inst *nsi)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ return osmo_fsm_inst_dispatch(nsi->bss_sns_fi, GPRS_SNS_EV_START, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/* main entry point for receiving SNS messages from the network */</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_ns_rx_sns(struct gprs_ns_inst *nsi, struct msgb *msg, struct tlv_parsed *tp)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;</span><br><span style="color: hsl(120, 100%, 40%);">+ uint16_t nsei = msgb_nsei(msg);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct osmo_fsm_inst *fi;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_DEBUG, "NSEI=%u Rx SNS PDU type %s\n", nsei,</span><br><span style="color: hsl(120, 100%, 40%);">+ get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: how to resolve SNS FSM Instance by NSEI (SGSN)? */</span><br><span style="color: hsl(120, 100%, 40%);">+ fi = nsi->bss_sns_fi;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (nsh->pdu_type) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_SIZE:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_SIZE, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_SIZE_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_SIZE_ACK, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CONFIG:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsh->data[0] & 0x01)</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_CONFIG_END, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ else</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_CONFIG, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CONFIG_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_CONFIG_ACK, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_ADD:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_ADD, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_DELETE:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_DELETE, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_CHANGE_WEIGHT:</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(fi, GPRS_SNS_EV_CHANGE_WEIGHT, tp);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case SNS_PDUT_ACK:</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_NOTICE, "NSEI=%u Rx unsupported SNS PDU type %s\n", nsei,</span><br><span style="color: hsl(120, 100%, 40%);">+ get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DNS, LOGL_ERROR, "NSEI=%u Rx unknown SNS PDU type %s\n", nsei,</span><br><span style="color: hsl(120, 100%, 40%);">+ get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));</span><br><span style="color: hsl(120, 100%, 40%);">+ return -EINVAL;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0;</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+int gprs_sns_init(void)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ /* "DNS" is not a constant/#define, but an integer variable set by the client app */</span><br><span style="color: hsl(120, 100%, 40%);">+ gprs_sns_bss_fsm.log_subsys = DNS;</span><br><span style="color: hsl(120, 100%, 40%);">+ return osmo_fsm_register(&gprs_sns_bss_fsm);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span>diff --git a/src/gb/gprs_ns_vty.c b/src/gb/gprs_ns_vty.c</span><br><span>index 667db7d..a108b71 100644</span><br><span>--- a/src/gb/gprs_ns_vty.c</span><br><span>+++ b/src/gb/gprs_ns_vty.c</span><br><span>@@ -555,6 +555,12 @@</span><br><span> return CMD_WARNING;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (nsvc->nsi->bss_sns_fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ vty_out(vty, "A NS Instance using the IP Sub-Network doesn't use BLOCK/UNBLOCK/RESET%s",</span><br><span style="color: hsl(120, 100%, 40%);">+ VTY_NEWLINE);</span><br><span style="color: hsl(120, 100%, 40%);">+ return CMD_WARNING;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> if (!strcmp(operation, "block"))</span><br><span> gprs_ns_tx_block(nsvc, NS_CAUSE_OM_INTERVENTION);</span><br><span> else if (!strcmp(operation, "unblock"))</span><br><span>diff --git a/src/gb/libosmogb.map b/src/gb/libosmogb.map</span><br><span>index ec69670..2ad3ff7 100644</span><br><span>--- a/src/gb/libosmogb.map</span><br><span>+++ b/src/gb/libosmogb.map</span><br><span>@@ -52,6 +52,7 @@</span><br><span> gprs_ns_instantiate;</span><br><span> gprs_ns_nsip_listen;</span><br><span> gprs_ns_nsip_connect;</span><br><span style="color: hsl(120, 100%, 40%);">+gprs_ns_nsip_connect_sns;</span><br><span> gprs_ns_rcvmsg;</span><br><span> gprs_ns_sendmsg;</span><br><span> gprs_ns_set_log_ss;</span><br><span></span><br></pre><p>To view, visit <a href="https://gerrit.osmocom.org/13014">change 13014</a>. To unsubscribe, or for help writing mail filters, visit <a href="https://gerrit.osmocom.org/settings">settings</a>.</p><div itemscope itemtype="http://schema.org/EmailMessage"><div itemscope itemprop="action" itemtype="http://schema.org/ViewAction"><link itemprop="url" href="https://gerrit.osmocom.org/13014"/><meta itemprop="name" content="View Change"/></div></div>
<div style="display:none"> Gerrit-Project: libosmocore </div>
<div style="display:none"> Gerrit-Branch: master </div>
<div style="display:none"> Gerrit-MessageType: newchange </div>
<div style="display:none"> Gerrit-Change-Id: I84786c3b43a8ae34ef3b3ba84b33c90042d234ea </div>
<div style="display:none"> Gerrit-Change-Number: 13014 </div>
<div style="display:none"> Gerrit-PatchSet: 1 </div>
<div style="display:none"> Gerrit-Owner: Harald Welte <laforge@gnumonks.org> </div>