<p>Harald Welte has uploaded this change for <strong>review</strong>.</p><p><a href="https://gerrit.osmocom.org/9416">View Change</a></p><pre style="font-family: monospace,monospace; white-space: pre-wrap;">WIP: Add initial 3GPP LCLS support to OsmoBSC<br><br>This code doesn't yet actually change the media path to the local<br>loopback, but it contains the following code:<br>* receive/parse/interpret LCLS specific BSSMAP IEs and PDUs<br>* osmo_fsm handling the various states and their transitions<br>* call leg correlation (finding the other subscr_conn with same GCR)<br>* communication between the two call-leg LCLS FSMs<br>* detection of supported / unsupported LCLS configurations<br>* display of GCR / LCLS information in "show conns"<br><br>Change-Id: I614fade62834def5cafc94c4d2578cd747a3f9f7<br>---<br>M include/osmocom/bsc/Makefile.am<br>M include/osmocom/bsc/debug.h<br>M include/osmocom/bsc/gsm_data.h<br>A include/osmocom/bsc/osmo_bsc_lcls.h<br>M src/libbsc/Makefile.am<br>M src/libbsc/bsc_subscr_conn_fsm.c<br>M src/libbsc/bsc_vty.c<br>A src/libbsc/osmo_bsc_lcls.c<br>M src/osmo-bsc/osmo_bsc_bssap.c<br>M src/osmo-bsc/osmo_bsc_main.c<br>10 files changed, 818 insertions(+), 0 deletions(-)<br><br></pre><pre style="font-family: monospace,monospace; white-space: pre-wrap;">git pull ssh://gerrit.osmocom.org:29418/osmo-bsc refs/changes/16/9416/1</pre><pre style="font-family: monospace,monospace; white-space: pre-wrap;"><span>diff --git a/include/osmocom/bsc/Makefile.am b/include/osmocom/bsc/Makefile.am</span><br><span>index bae13f0..0987be9 100644</span><br><span>--- a/include/osmocom/bsc/Makefile.am</span><br><span>+++ b/include/osmocom/bsc/Makefile.am</span><br><span>@@ -47,4 +47,5 @@</span><br><span> vty.h \</span><br><span> bsc_api.h \</span><br><span> penalty_timers.h \</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_bsc_lcls.h \</span><br><span> $(NULL)</span><br><span>diff --git a/include/osmocom/bsc/debug.h b/include/osmocom/bsc/debug.h</span><br><span>index 2b3d150..1133bf6 100644</span><br><span>--- a/include/osmocom/bsc/debug.h</span><br><span>+++ b/include/osmocom/bsc/debug.h</span><br><span>@@ -23,5 +23,6 @@</span><br><span> DCTRL,</span><br><span> DFILTER,</span><br><span> DPCU,</span><br><span style="color: hsl(120, 100%, 40%);">+ DLCLS,</span><br><span> Debug_LastEntry,</span><br><span> };</span><br><span>diff --git a/include/osmocom/bsc/gsm_data.h b/include/osmocom/bsc/gsm_data.h</span><br><span>index 1cf79a5..b1fceb3 100644</span><br><span>--- a/include/osmocom/bsc/gsm_data.h</span><br><span>+++ b/include/osmocom/bsc/gsm_data.h</span><br><span>@@ -188,6 +188,18 @@</span><br><span> enum gsm48_chan_mode chan_mode;</span><br><span> </span><br><span> } user_plane;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* LCLS (local call, local switch) related state */</span><br><span style="color: hsl(120, 100%, 40%);">+ struct {</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t global_call_ref[15];</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t global_call_ref_len; /* length of global_call_ref */</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t config; /* TS 48.008 3.2.2.116 */</span><br><span style="color: hsl(120, 100%, 40%);">+ uint8_t control;/* TS 48.008 3.2.2.117 */</span><br><span style="color: hsl(120, 100%, 40%);">+ /* LCLS FSM */</span><br><span style="color: hsl(120, 100%, 40%);">+ struct osmo_fsm_inst *fi;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* pointer to "other" connection, if Call Leg Relocation was successful */</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_subscriber_connection *other;</span><br><span style="color: hsl(120, 100%, 40%);">+ } lcls;</span><br><span> };</span><br><span> </span><br><span> </span><br><span>diff --git a/include/osmocom/bsc/osmo_bsc_lcls.h b/include/osmocom/bsc/osmo_bsc_lcls.h</span><br><span>new file mode 100644</span><br><span>index 0000000..cb43cf3</span><br><span>--- /dev/null</span><br><span>+++ b/include/osmocom/bsc/osmo_bsc_lcls.h</span><br><span>@@ -0,0 +1,36 @@</span><br><span style="color: hsl(120, 100%, 40%);">+#pragma once</span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/fsm.h></span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+enum lcls_fsm_state {</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_NO_LCLS,</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_NOT_YET_LS,</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_NOT_POSSIBLE_LS,</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_NO_LONGER_LS,</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_REQ_LCLS_NOT_SUPP,</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_LOCALLY_SWITCHED,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* locally switched; received remote break; wait for "local" break */</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_LOCALLY_SWITCHED_WAIT_BREAK,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* locally switched; received break; wait for "other" break */</span><br><span style="color: hsl(120, 100%, 40%);">+ ST_LOCALLY_SWITCHED_WAIT_OTHER_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%);">+enum lcls_event {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* update LCLS config/control based on some BSSMAP signaling */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_UPDATE_CFG_CSC,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we have been identified as the correlation peer of another conn */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_CORRELATED,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* "other" LCLS connection has enabled local switching */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_OTHER_ENABLED,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* "other" LCLS connection is breaking local switch */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_OTHER_BREAK,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* "other" LCLS connection is dying */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_OTHER_DEAD,</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 gsm0808_lcls_status lcls_get_status(struct gsm_subscriber_connection *conn);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+void lcls_update_config(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ const uint8_t *config, const uint8_t *control);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+extern struct osmo_fsm lcls_fsm;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span>diff --git a/src/libbsc/Makefile.am b/src/libbsc/Makefile.am</span><br><span>index d215e14..2e44729 100644</span><br><span>--- a/src/libbsc/Makefile.am</span><br><span>+++ b/src/libbsc/Makefile.am</span><br><span>@@ -65,5 +65,6 @@</span><br><span> handover_decision_2.c \</span><br><span> bsc_subscr_conn_fsm.c \</span><br><span> meas_feed.c \</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_bsc_lcls.c \</span><br><span> $(NULL)</span><br><span> </span><br><span>diff --git a/src/libbsc/bsc_subscr_conn_fsm.c b/src/libbsc/bsc_subscr_conn_fsm.c</span><br><span>index 89ac482..46504c4 100644</span><br><span>--- a/src/libbsc/bsc_subscr_conn_fsm.c</span><br><span>+++ b/src/libbsc/bsc_subscr_conn_fsm.c</span><br><span>@@ -30,6 +30,7 @@</span><br><span> #include <osmocom/bsc/chan_alloc.h></span><br><span> #include <osmocom/bsc/bsc_subscriber.h></span><br><span> #include <osmocom/bsc/osmo_bsc_sigtran.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/osmo_bsc_lcls.h></span><br><span> #include <osmocom/bsc/bsc_subscr_conn_fsm.h></span><br><span> #include <osmocom/bsc/osmo_bsc.h></span><br><span> #include <osmocom/bsc/penalty_timers.h></span><br><span>@@ -223,6 +224,33 @@</span><br><span> return channel_mode << 4 | channel;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/* Add the LCLS BSS Status IE to a BSSMAP message. We assume this is</span><br><span style="color: hsl(120, 100%, 40%);">+ * called on a msgb that was returned by gsm0808_create_ass_compl() */</span><br><span style="color: hsl(120, 100%, 40%);">+static void bssmap_add_lcls_status(struct msgb *msg, enum gsm0808_lcls_status status)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(msg->l3h[0] == BSSAP_MSG_BSS_MANAGEMENT);</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(msg->l3h[2] == BSS_MAP_MSG_ASSIGMENT_COMPLETE ||</span><br><span style="color: hsl(120, 100%, 40%);">+ msg->l3h[2] == BSS_MAP_MSG_HANDOVER_RQST_ACKNOWLEDGE ||</span><br><span style="color: hsl(120, 100%, 40%);">+ msg->l3h[2] == BSS_MAP_MSG_HANDOVER_COMPLETE ||</span><br><span style="color: hsl(120, 100%, 40%);">+ msg->l3h[2] == BSS_MAP_MSG_HANDOVER_PERFORMED);</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(msgb_tailroom(msg) >= 2);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* append IE to end of message */</span><br><span style="color: hsl(120, 100%, 40%);">+ msgb_tv_put(msg, GSM0808_IE_LCLS_BSS_STATUS, status);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* increment the "length" byte in the BSSAP header */</span><br><span style="color: hsl(120, 100%, 40%);">+ msg->l3h[1] += 2;</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%);">+/* Add (append) the LCLS BSS Status IE to a BSSMAP message, if there is any LCLS</span><br><span style="color: hsl(120, 100%, 40%);">+ * active on the given \a conn */</span><br><span style="color: hsl(120, 100%, 40%);">+static void bssmap_add_lcls_status_if_needed(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ enum gsm0808_lcls_status status = lcls_get_status(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (status != 0xff)</span><br><span style="color: hsl(120, 100%, 40%);">+ bssmap_add_lcls_status(msg, status);</span><br><span style="color: hsl(120, 100%, 40%);">+}</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> /* Generate and send assignment complete message */</span><br><span> static void send_ass_compl(struct gsm_lchan *lchan, struct osmo_fsm_inst *fi, bool voice)</span><br><span> {</span><br><span>@@ -268,6 +296,9 @@</span><br><span> conn->sccp.conn_id);</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ /* Add LCLS BSS-Status IE in case there is any LCLS status for this connection */</span><br><span style="color: hsl(120, 100%, 40%);">+ bssmap_add_lcls_status_if_needed(conn, resp);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> sigtran_send(conn, resp, fi);</span><br><span> }</span><br><span> </span><br><span>@@ -1026,6 +1057,15 @@</span><br><span> conn->lchan = NULL;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.other) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_DEBUG, "Signaling death to LCLS peern\n");</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_DEAD, conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = 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%);">+ if (conn->lcls.fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_term(conn->lcls.fi, cause, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> if (conn->bsub) {</span><br><span> LOGPFSML(fi, LOGL_DEBUG, "Putting bsc_subscr\n");</span><br><span> bsc_subscr_put(conn->bsub);</span><br><span>@@ -1117,6 +1157,7 @@</span><br><span> </span><br><span> if (!g_initialized) {</span><br><span> osmo_fsm_register(&gscon_fsm);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_register(&lcls_fsm);</span><br><span> g_initialized = true;</span><br><span> }</span><br><span> </span><br><span>@@ -1137,6 +1178,15 @@</span><br><span> return NULL;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ /* initialize to some magic values that indicate "IE not [yet] received" */</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.config = 0xff;</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.control = 0xff;</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.fi = osmo_fsm_inst_alloc(&lcls_fsm, conn, conn, LOGL_NOTICE, NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!conn->lcls.fi) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_term(conn->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> llist_add_tail(&conn->entry, &net->subscr_conns);</span><br><span> return conn;</span><br><span> }</span><br><span>diff --git a/src/libbsc/bsc_vty.c b/src/libbsc/bsc_vty.c</span><br><span>index 1b76578..42d0af4 100644</span><br><span>--- a/src/libbsc/bsc_vty.c</span><br><span>+++ b/src/libbsc/bsc_vty.c</span><br><span>@@ -1521,6 +1521,14 @@</span><br><span> conn->sccp.conn_id, conn->sccp.msc->nr, conn->hodec2.failures,</span><br><span> get_value_string(gsm48_chan_mode_names, conn->user_plane.chan_mode),</span><br><span> conn->user_plane.mgw_endpoint, VTY_NEWLINE);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.global_call_ref_len) {</span><br><span style="color: hsl(120, 100%, 40%);">+ vty_out(vty, " LCLS GCR: %s%s",</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_hexdump_nospc(conn->lcls.global_call_ref, conn->lcls.global_call_ref_len),</span><br><span style="color: hsl(120, 100%, 40%);">+ VTY_NEWLINE);</span><br><span style="color: hsl(120, 100%, 40%);">+ vty_out(vty, " LCLS Config: 0x%02x, LCLS Control: 0x%02x, LCLS BSS Status: %s%s",</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.config, conn->lcls.control, osmo_fsm_inst_state_name(conn->lcls.fi),</span><br><span style="color: hsl(120, 100%, 40%);">+ VTY_NEWLINE);</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span> lchan_dump_full_vty(vty, conn->lchan);</span><br><span> if (conn->secondary_lchan)</span><br><span> lchan_dump_full_vty(vty, conn->secondary_lchan);</span><br><span>diff --git a/src/libbsc/osmo_bsc_lcls.c b/src/libbsc/osmo_bsc_lcls.c</span><br><span>new file mode 100644</span><br><span>index 0000000..c00c9cd</span><br><span>--- /dev/null</span><br><span>+++ b/src/libbsc/osmo_bsc_lcls.c</span><br><span>@@ -0,0 +1,646 @@</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%);">+ * All Rights Reserved</span><br><span style="color: hsl(120, 100%, 40%);">+ *</span><br><span style="color: hsl(120, 100%, 40%);">+ * This program is free software; you can redistribute it and/or modify</span><br><span style="color: hsl(120, 100%, 40%);">+ * it under the terms of the GNU Affero General Public License as published by</span><br><span style="color: hsl(120, 100%, 40%);">+ * the Free Software Foundation; either version 3 of the License, or</span><br><span style="color: hsl(120, 100%, 40%);">+ * (at your option) any later version.</span><br><span style="color: hsl(120, 100%, 40%);">+ *</span><br><span style="color: hsl(120, 100%, 40%);">+ * This program is distributed in the hope that it will be useful,</span><br><span style="color: hsl(120, 100%, 40%);">+ * but WITHOUT ANY WARRANTY; without even the implied warranty of</span><br><span style="color: hsl(120, 100%, 40%);">+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the</span><br><span style="color: hsl(120, 100%, 40%);">+ * GNU Affero General Public License for more details.</span><br><span style="color: hsl(120, 100%, 40%);">+ *</span><br><span style="color: hsl(120, 100%, 40%);">+ * You should have received a copy of the GNU Affero General Public License</span><br><span style="color: hsl(120, 100%, 40%);">+ * along with this program. If not, see <http://www.gnu.org/licenses/>.</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%);">+#include <osmocom/core/utils.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/logging.h></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/linuxlist.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/gsm/gsm0808.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/bsc/bsc_msc_data.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/debug.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/osmo_bsc.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/bsc_subscr_conn_fsm.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/gsm_data.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/osmo_bsc_lcls.h></span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct value_string lcls_event_names[] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ { LCLS_EV_UPDATE_CFG_CSC, "UPDATE_CFG_CSC" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { LCLS_EV_CORRELATED, "CORRELATED" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { LCLS_EV_OTHER_ENABLED, "OTHER_ENABLED" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { LCLS_EV_OTHER_BREAK, "OTHER_BREAK" },</span><br><span style="color: hsl(120, 100%, 40%);">+ { LCLS_EV_OTHER_DEAD, "OTHER_DEAD" },</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%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+/***********************************************************************</span><br><span style="color: hsl(120, 100%, 40%);">+ * Utility functions</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 gsm0808_lcls_status lcls_get_status(struct gsm_subscriber_connection *conn)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!conn->lcls.fi)</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0xff;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ switch (conn->lcls.fi->state) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_NO_LCLS:</span><br><span style="color: hsl(120, 100%, 40%);">+ return 0xff;</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_NOT_YET_LS:</span><br><span style="color: hsl(120, 100%, 40%);">+ return GSM0808_LCLS_STS_NOT_YET_LS;</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_NOT_POSSIBLE_LS:</span><br><span style="color: hsl(120, 100%, 40%);">+ return GSM0808_LCLS_STS_NOT_POSSIBLE_LS;</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_NO_LONGER_LS:</span><br><span style="color: hsl(120, 100%, 40%);">+ return GSM0808_LCLS_STS_NO_LONGER_LS;</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_REQ_LCLS_NOT_SUPP:</span><br><span style="color: hsl(120, 100%, 40%);">+ return GSM0808_LCLS_STS_REQ_LCLS_NOT_SUPP;</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_LOCALLY_SWITCHED:</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_LOCALLY_SWITCHED_WAIT_BREAK:</span><br><span style="color: hsl(120, 100%, 40%);">+ case ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK:</span><br><span style="color: hsl(120, 100%, 40%);">+ return GSM0808_LCLS_STS_LOCALLY_SWITCHED;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</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 lcls_send_notify(struct gsm_subscriber_connection *conn)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ enum gsm0808_lcls_status status = lcls_get_status(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ if (status == 0xff)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Sending BSSMAP LCLS NOTIFICATION\n");</span><br><span style="color: hsl(120, 100%, 40%);">+ msg = gsm0808_create_lcls_notification(status, false);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->fi, GSCON_EV_TX_SCCP, msg);</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 gsm_subscriber_connection *</span><br><span style="color: hsl(120, 100%, 40%);">+find_conn_with_same_gcr(struct gsm_subscriber_connection *conn_local)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_network *net = conn_local->network;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_subscriber_connection *conn_other;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ llist_for_each_entry(conn_other, &net->subscr_conns, entry) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* don't report back the same connection */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn_other == conn_local)</span><br><span style="color: hsl(120, 100%, 40%);">+ continue;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* don't consider any conn where GCR length is not the same as before */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn_other->lcls.global_call_ref_len != conn_local->lcls.global_call_ref_len)</span><br><span style="color: hsl(120, 100%, 40%);">+ continue;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!memcmp(conn_other->lcls.global_call_ref, conn_local->lcls.global_call_ref,</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->lcls.global_call_ref_len))</span><br><span style="color: hsl(120, 100%, 40%);">+ return conn_other;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</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%);">+static bool lcls_is_supported_config(enum gsm0808_lcls_config cfg)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ /* this is the only configuration that we support for now */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cfg == GSM0808_LCLS_CFG_BOTH_WAY)</span><br><span style="color: hsl(120, 100%, 40%);">+ return true;</span><br><span style="color: hsl(120, 100%, 40%);">+ else</span><br><span style="color: hsl(120, 100%, 40%);">+ return false;</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%);">+/* LCLS Call Leg Correlation as per 23.284 4.3 / 48.008 3.1.33.2.1 */</span><br><span style="color: hsl(120, 100%, 40%);">+static int lcls_perform_correlation(struct gsm_subscriber_connection *conn_local)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_subscriber_connection *conn_other;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn_local->lcls.global_call_ref_len);</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn_local->lcls.other == NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_other = find_conn_with_same_gcr(conn_local);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!conn_other) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we found no other call with same GCR: not possible */</span><br><span style="color: hsl(120, 100%, 40%);">+ return -ENODEV;</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%);">+ /* store pointer to "other" in "local" */</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->lcls.other = conn_other;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* notify other conn about our correlation */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn_other->lcls.fi, LCLS_EV_CORRELATED, conn_local);</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%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct lcls_cfg_csc {</span><br><span style="color: hsl(120, 100%, 40%);">+ enum gsm0808_lcls_config config;</span><br><span style="color: hsl(120, 100%, 40%);">+ enum gsm0808_lcls_control control;</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%);">+/* Update the connections LCLS configuration and return old/previous configuration.</span><br><span style="color: hsl(120, 100%, 40%);">+ * \returns (staticallly allocated) old configuration; NULL if new config not supported */</span><br><span style="color: hsl(120, 100%, 40%);">+static struct lcls_cfg_csc *update_lcls_cfg_csc(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ struct lcls_cfg_csc *new_cfg_csc)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ static struct lcls_cfg_csc old_cfg_csc;</span><br><span style="color: hsl(120, 100%, 40%);">+ old_cfg_csc.config = conn->lcls.config;</span><br><span style="color: hsl(120, 100%, 40%);">+ old_cfg_csc.control = conn->lcls.control;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ if (new_cfg_csc->config != 0xff) {</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!lcls_is_supported_config(new_cfg_csc->config))</span><br><span style="color: hsl(120, 100%, 40%);">+ return NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.config != new_cfg_csc->config) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* TODO: logging */</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.config = new_cfg_csc->config;</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 (new_cfg_csc->control != 0xff) {</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.control != new_cfg_csc->control) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* TODO: logging */</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.control = new_cfg_csc->control;</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%);">+ return &old_cfg_csc;</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%);">+/* Attempt to update conn->lcls with the new config/csc provided. If new config is</span><br><span style="color: hsl(120, 100%, 40%);">+ * unsupported, change into LCLS NOT SUPPORTED state and return -EINVAL. */</span><br><span style="color: hsl(120, 100%, 40%);">+static int lcls_handle_cfg_update(struct gsm_subscriber_connection *conn, void *data)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct lcls_cfg_csc *new_cfg_csc, *old_cfg_csc;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ new_cfg_csc = (struct lcls_cfg_csc *) data;</span><br><span style="color: hsl(120, 100%, 40%);">+ old_cfg_csc = update_lcls_cfg_csc(conn, new_cfg_csc);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!old_cfg_csc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(conn->lcls.fi, ST_REQ_LCLS_NOT_SUPP, 0, 0);</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%);">+ 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%);">+/* notify the LCLS FSM about new LCLS Config and/or CSC */</span><br><span style="color: hsl(120, 100%, 40%);">+void lcls_update_config(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ const uint8_t *config, const uint8_t *control)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct lcls_cfg_csc new_cfg = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .config = 0xff,</span><br><span style="color: hsl(120, 100%, 40%);">+ .control = 0xff,</span><br><span style="color: hsl(120, 100%, 40%);">+ };</span><br><span style="color: hsl(120, 100%, 40%);">+ /* nothing to update, skip it */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!config && !control)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (config)</span><br><span style="color: hsl(120, 100%, 40%);">+ new_cfg.config = *config;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (control)</span><br><span style="color: hsl(120, 100%, 40%);">+ new_cfg.control = *control;</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.fi, LCLS_EV_UPDATE_CFG_CSC, &new_cfg);</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 lcls_try_enable(struct gsm_subscriber_connection *conn)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_subscriber_connection *other_conn = conn->lcls.other;</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(other_conn);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ if (!lcls_is_supported_config(conn->lcls.config)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling due to unsupported local config\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%);">+ if (!lcls_is_supported_config(other_conn->lcls.config)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling due to unsupported other config\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%);">+ if (conn->lcls.control != GSM0808_LCLS_CSC_CONNECT) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling due to insufficient local control\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%);">+ if (other_conn->lcls.control != GSM0808_LCLS_CSC_CONNECT) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling due to insufficient other control\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%);">+ 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%);">+ * State callback functions</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 lcls_no_lcls_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we're just starting and cannot yet have a correlated call */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == NULL);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* If there's no GCR set, we can never leave this state */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.global_call_ref_len == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_NOTICE, "No GCR set, ignoring %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_event_name(fi->fsm, event));</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</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%);">+ switch (event) {</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_perform_correlation(conn) != 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Correlation leads to no result: Not Possible to LS */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_POSSIBLE_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we now have two correlated calls */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) != 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Couldn't be enabled: Not yet LS */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_YET_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Local Switching now active */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_ENABLED, conn);</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%);">+ 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 lcls_not_yet_ls_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* not yet locally switched means that we have correlation but no instruction</span><br><span style="color: hsl(120, 100%, 40%);">+ * to actually connect them yet */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_ENABLED, conn);</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%);">+ case LCLS_EV_OTHER_ENABLED:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we couldn't enable our side, so ask other side to break */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_BREAK, conn);</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%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_POSSIBLE_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</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%);">+ 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 lcls_not_possible_ls_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == 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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_perform_correlation(conn) != 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* no correlation result: Remain in NOT_POSSIBLE_LS */</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we now have two correlated calls */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_YET_LS, 0, 0);</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, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_ENABLED, conn);</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%);">+ case LCLS_EV_CORRELATED:</span><br><span style="color: hsl(120, 100%, 40%);">+ /* other call informs us that he correlated with us */</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_YET_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send NOTIFY about the fact that correlation happened */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</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%);">+ 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 lcls_no_longer_ls_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_ENABLED, conn);</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%);">+ case LCLS_EV_OTHER_ENABLED:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ } else {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we couldn't enable our side, so ask other side to break */</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_BREAK, conn);</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%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_POSSIBLE_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</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%);">+ 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 lcls_req_lcls_not_supp_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we could have a correlated other call or not */</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_perform_correlation(conn) != 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_POSSIBLE_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we now have two correlated calls */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_try_enable(conn) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_YET_LS, 0, 0);</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, ST_LOCALLY_SWITCHED, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = NULL;</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%);">+ 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%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static void lcls_locally_switched_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct lcls_cfg_csc *cfg = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ cfg = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cfg->control == GSM0808_LCLS_CSC_RELEASE_LCLS) {</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_BREAK, conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: what if there's a new config included? */</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* TODO: Handle any changes of "config" once we support bi-casting etc. */</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_BREAK:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_LOCALLY_SWITCHED_WAIT_BREAK, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.other = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NOT_POSSIBLE_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</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%);">+ 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 lcls_locally_switched_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: actually enable local switching */</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(fi, "=== HERE IS WHERE WE ENABLE LCLS\n");</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 lcls_break_local_switching(struct gsm_subscriber_connection *conn)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: actually disable local switching */</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "=== HERE IS WHERE WE DISABLE LCLS\n");</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 lcls_locally_switched_wait_break_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct lcls_cfg_csc *cfg = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ cfg = data;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (cfg->control == GSM0808_LCLS_CSC_RELEASE_LCLS) {</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_break_local_switching(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NO_LONGER_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.other->lcls.fi, LCLS_EV_OTHER_BREAK, conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* no NOTIFY here, as the caller will be returning status in LCLS-CTRL-ACK */</span><br><span style="color: hsl(120, 100%, 40%);">+ /* FIXME: what if there's a new config included? */</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* TODO: Handle any changes of "config" once we support bi-casting etc. */</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_BREAK:</span><br><span style="color: hsl(120, 100%, 40%);">+ /* we simply ignore it, must be a re-transmission */</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_locally_switched_fn(fi, event, data);</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 lcls_locally_switched_wait_other_break_fn(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 gsm_subscriber_connection *conn = fi->priv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other);</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 LCLS_EV_UPDATE_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_handle_cfg_update(conn, data) != 0)</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ /* TODO: Handle any changes of "config" once we support bi-casting etc. */</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_BREAK:</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn->lcls.other == data);</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_break_local_switching(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_state_chg(fi, ST_NO_LONGER_LS, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Send LCLS-NOTIFY to inform MSC */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_send_notify(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_OTHER_DEAD:</span><br><span style="color: hsl(120, 100%, 40%);">+ default:</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_locally_switched_fn(fi, event, data);</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%);">+</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%);">+ * FSM Definition</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%);">+#define S(x) (1 << (x))</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+static const struct osmo_fsm_state lcls_fsm_states[] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_NO_LCLS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_CORRELATED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NO_LCLS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_NOT_YET_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_NOT_POSSIBLE_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "NO_LCLS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_no_lcls_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_NOT_YET_LS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_CORRELATED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_ENABLED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NOT_YET_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "NOT_YET_LS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_not_yet_ls_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_NOT_POSSIBLE_LS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_CORRELATED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NOT_YET_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_NOT_POSSIBLE_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "NOT_POSSIBLE_LS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_not_possible_ls_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_NO_LONGER_LS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_CORRELATED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_ENABLED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NO_LONGER_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "NO_LONGER_LS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_no_longer_ls_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_REQ_LCLS_NOT_SUPP] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NOT_YET_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "REQ_LCLS_NOT_SUPP",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_req_lcls_not_supp_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_LOCALLY_SWITCHED] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_BREAK) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NO_LONGER_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_NOT_POSSIBLE_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED_WAIT_BREAK) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "LOCALLY_SWITCHED",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_locally_switched_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ .onenter = lcls_locally_switched_onenter,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ /* received an "other" break, waiting for the local break */</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_LOCALLY_SWITCHED_WAIT_BREAK] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_BREAK) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NO_LONGER_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED_WAIT_BREAK),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "LOCALLY_SWITCHED_WAIT_BREAK",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_locally_switched_wait_break_fn,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+ /* received a local break, waiting for the "other" break */</span><br><span style="color: hsl(120, 100%, 40%);">+ [ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .in_event_mask = S(LCLS_EV_UPDATE_CFG_CSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_BREAK) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(LCLS_EV_OTHER_DEAD),</span><br><span style="color: hsl(120, 100%, 40%);">+ .out_state_mask = S(ST_NO_LONGER_LS) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_REQ_LCLS_NOT_SUPP) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK),</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "LOCALLY_SWITCHED_WAIT_OTHER_BREAK",</span><br><span style="color: hsl(120, 100%, 40%);">+ .action = lcls_locally_switched_wait_other_break_fn,</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%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+struct osmo_fsm lcls_fsm = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "LCLS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .states = lcls_fsm_states,</span><br><span style="color: hsl(120, 100%, 40%);">+ .num_states = ARRAY_SIZE(lcls_fsm_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 = NULL,</span><br><span style="color: hsl(120, 100%, 40%);">+ .log_subsys = DLCLS,</span><br><span style="color: hsl(120, 100%, 40%);">+ .event_names = lcls_event_names,</span><br><span style="color: hsl(120, 100%, 40%);">+};</span><br><span>diff --git a/src/osmo-bsc/osmo_bsc_bssap.c b/src/osmo-bsc/osmo_bsc_bssap.c</span><br><span>index f7f99fa..ae8407d 100644</span><br><span>--- a/src/osmo-bsc/osmo_bsc_bssap.c</span><br><span>+++ b/src/osmo-bsc/osmo_bsc_bssap.c</span><br><span>@@ -34,6 +34,7 @@</span><br><span> #include <osmocom/gsm/gsm0808_utils.h></span><br><span> #include <osmocom/gsm/gsm48.h></span><br><span> #include <osmocom/bsc/osmo_bsc_sigtran.h></span><br><span style="color: hsl(120, 100%, 40%);">+#include <osmocom/bsc/osmo_bsc_lcls.h></span><br><span> #include <osmocom/bsc/a_reset.h></span><br><span> #include <osmocom/core/byteswap.h></span><br><span> </span><br><span>@@ -634,6 +635,57 @@</span><br><span> return -1;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+/* handle LCLS specific IES in BSSMAP ASS REQ */</span><br><span style="color: hsl(120, 100%, 40%);">+static void bssmap_handle_ass_req_lcls(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct tlv_parsed *tp)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ const struct tlv_p_entry *tlv;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ tlv = TLVP_GET(tp, GSM0808_IE_GLOBAL_CALL_REF);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (tlv) {</span><br><span style="color: hsl(120, 100%, 40%);">+ if (tlv->len > sizeof(conn->lcls.global_call_ref))</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGP(DMSC, LOGL_ERROR, "Global Call Ref IE of %u bytes too long.\n", tlv->len);</span><br><span style="color: hsl(120, 100%, 40%);">+ else {</span><br><span style="color: hsl(120, 100%, 40%);">+ memcpy(&conn->lcls.global_call_ref, tlv->val, tlv->len);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn->lcls.global_call_ref_len = tlv->len;</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%);">+ /* Update the LCLS state with Config + CSC (if any) */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_update_config(conn, TLVP_VAL_MINLEN(tp, GSM0808_IE_LCLS_CONFIG, 1),</span><br><span style="color: hsl(120, 100%, 40%);">+ TLVP_VAL_MINLEN(tp, GSM0808_IE_LCLS_CONN_STATUS_CTRL, 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%);">+/* TS 48.008 3.2.1.91 */</span><br><span style="color: hsl(120, 100%, 40%);">+static int bssmap_handle_lcls_connect_ctrl(struct gsm_subscriber_connection *conn,</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *msg, unsigned int length)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ struct msgb *resp;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct tlv_parsed tp;</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%);">+ OSMO_ASSERT(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.global_call_ref_len == 0) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* no LCLS if no GCR set previously! */</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%);">+ rc = tlv_parse(&tp, gsm0808_att_tlvdef(), msg->l4h + 1, length - 1, 0, 0);</span><br><span style="color: hsl(120, 100%, 40%);">+ if (rc < 0)</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%);">+ /* Update the LCLS state with Config + CSC (if any) */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_update_config(conn, TLVP_VAL_MINLEN(&tp, GSM0808_IE_LCLS_CONFIG, 1),</span><br><span style="color: hsl(120, 100%, 40%);">+ TLVP_VAL_MINLEN(&tp, GSM0808_IE_LCLS_CONN_STATUS_CTRL, 1));</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ resp = gsm0808_create_lcls_conn_ctrl_ack(lcls_get_status(conn));</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->fi, GSCON_EV_TX_SCCP, resp);</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%);">+</span><br><span> /*</span><br><span> * Handle the assignment request message.</span><br><span> *</span><br><span>@@ -682,6 +734,8 @@</span><br><span> goto reject;</span><br><span> }</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ bssmap_handle_ass_req_lcls(conn, &tp);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> /* Currently we only support a limited subset of all</span><br><span> * possible channel types, such as multi-slot or CSD */</span><br><span> switch (ct.ch_indctr) {</span><br><span>@@ -852,6 +906,9 @@</span><br><span> case BSS_MAP_MSG_ASSIGMENT_RQST:</span><br><span> ret = bssmap_handle_assignm_req(conn, msg, length);</span><br><span> break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case BSS_MAP_MSG_LCLS_CONNECT_CTRL:</span><br><span style="color: hsl(120, 100%, 40%);">+ ret = bssmap_handle_lcls_connect_ctrl(conn, msg, length);</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span> default:</span><br><span> LOGP(DMSC, LOGL_NOTICE, "Unimplemented msg type: %s\n",</span><br><span> gsm0808_bssmap_name(msg->l4h[0]));</span><br><span>diff --git a/src/osmo-bsc/osmo_bsc_main.c b/src/osmo-bsc/osmo_bsc_main.c</span><br><span>index f3daccc..5d949b8 100644</span><br><span>--- a/src/osmo-bsc/osmo_bsc_main.c</span><br><span>+++ b/src/osmo-bsc/osmo_bsc_main.c</span><br><span>@@ -358,6 +358,12 @@</span><br><span> .description = "PCU Interface",</span><br><span> .enabled = 1, .loglevel = LOGL_DEBUG,</span><br><span> },</span><br><span style="color: hsl(120, 100%, 40%);">+ [DLCLS] = {</span><br><span style="color: hsl(120, 100%, 40%);">+ .name = "DLCLS",</span><br><span style="color: hsl(120, 100%, 40%);">+ .description = "Local Call, Local Switch",</span><br><span style="color: hsl(120, 100%, 40%);">+ .enabled = 1, .loglevel = LOGL_NOTICE,</span><br><span style="color: hsl(120, 100%, 40%);">+ },</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> };</span><br><span> </span><br><span> static int filter_fn(const struct log_context *ctx, struct log_target *tar)</span><br><span></span><br></pre><p>To view, visit <a href="https://gerrit.osmocom.org/9416">change 9416</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/9416"/><meta itemprop="name" content="View Change"/></div></div>
<div style="display:none"> Gerrit-Project: osmo-bsc </div>
<div style="display:none"> Gerrit-Branch: master </div>
<div style="display:none"> Gerrit-MessageType: newchange </div>
<div style="display:none"> Gerrit-Change-Id: I614fade62834def5cafc94c4d2578cd747a3f9f7 </div>
<div style="display:none"> Gerrit-Change-Number: 9416 </div>
<div style="display:none"> Gerrit-PatchSet: 1 </div>
<div style="display:none"> Gerrit-Owner: Harald Welte <laforge@gnumonks.org> </div>