<p>Harald Welte <strong>merged</strong> this change.</p><p><a href="https://gerrit.osmocom.org/9416">View Change</a></p><div style="white-space:pre-wrap">Approvals:
Jenkins Builder: Verified
Harald Welte: Looks good to me, approved
</div><pre style="font-family: monospace,monospace; white-space: pre-wrap;">Add initial 3GPP LCLS support to OsmoBSC<br><br>This code 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>* switch the media streams locally using MDCX to the MGW<br><br>Closes: OS#1602<br>Change-Id: I614fade62834def5cafc94c4d2578cd747a3f9f7<br>---<br>M include/osmocom/bsc/Makefile.am<br>M include/osmocom/bsc/bsc_subscr_conn_fsm.h<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>11 files changed, 981 insertions(+), 1 deletion(-)<br><br></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/bsc_subscr_conn_fsm.h b/include/osmocom/bsc/bsc_subscr_conn_fsm.h</span><br><span>index 9498d9f..e8226f4 100644</span><br><span>--- a/include/osmocom/bsc/bsc_subscr_conn_fsm.h</span><br><span>+++ b/include/osmocom/bsc/bsc_subscr_conn_fsm.h</span><br><span>@@ -48,6 +48,8 @@</span><br><span> GSCON_EV_MGW_MDCX_RESP_BTS,</span><br><span> /* CRCX response received (MSC) */</span><br><span> GSCON_EV_MGW_CRCX_RESP_MSC,</span><br><span style="color: hsl(120, 100%, 40%);">+ /* MDCX response received (MSC) - triggered by LCLS */</span><br><span style="color: hsl(120, 100%, 40%);">+ GSCON_EV_MGW_MDCX_RESP_MSC,</span><br><span> </span><br><span> /* Internal handover request (intra-BSC handover) */</span><br><span> GSCON_EV_HO_START,</span><br><span>@@ -57,6 +59,9 @@</span><br><span> GSCON_EV_HO_FAIL,</span><br><span> /* Handover completed successfully (handover_logic.c) */</span><br><span> GSCON_EV_HO_COMPL,</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* LCLS child FSM has terminated due to hard failure */</span><br><span style="color: hsl(120, 100%, 40%);">+ GSCON_EV_LCLS_FAIL,</span><br><span> };</span><br><span> </span><br><span> struct gsm_subscriber_connection;</span><br><span>diff --git a/include/osmocom/bsc/debug.h b/include/osmocom/bsc/debug.h</span><br><span>index 37f102c..006b918 100644</span><br><span>--- a/include/osmocom/bsc/debug.h</span><br><span>+++ b/include/osmocom/bsc/debug.h</span><br><span>@@ -25,5 +25,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..2e60234</span><br><span>--- /dev/null</span><br><span>+++ b/include/osmocom/bsc/osmo_bsc_lcls.h</span><br><span>@@ -0,0 +1,40 @@</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%);">+ /* apply LCLS config/control */</span><br><span style="color: hsl(120, 100%, 40%);">+ LCLS_EV_APPLY_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%);">+void lcls_apply_config(struct gsm_subscriber_connection *conn);</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..bafe145 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>@@ -111,6 +112,7 @@</span><br><span> {GSCON_EV_MGW_CRCX_RESP_BTS, "MGW_CRCX_RESPONSE_BTS"},</span><br><span> {GSCON_EV_MGW_MDCX_RESP_BTS, "MGW_MDCX_RESPONSE_BTS"},</span><br><span> {GSCON_EV_MGW_CRCX_RESP_MSC, "MGW_CRCX_RESPONSE_MSC"},</span><br><span style="color: hsl(120, 100%, 40%);">+ {GSCON_EV_MGW_MDCX_RESP_MSC, "MGW_MDCX_RESPONSE_MSC"},</span><br><span> </span><br><span> {GSCON_EV_HO_START, "HO_START"},</span><br><span> {GSCON_EV_HO_TIMEOUT, "HO_TIMEOUT"},</span><br><span>@@ -223,6 +225,37 @@</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%);">+ LOGPFSM(conn->fi, "Adding LCLS BSS-Status (%s) to %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gsm0808_lcls_status_name(status),</span><br><span style="color: hsl(120, 100%, 40%);">+ gsm0808_bssmap_name(msg->l3h[2]));</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 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>@@ -236,6 +269,9 @@</span><br><span> conn = lchan->conn;</span><br><span> OSMO_ASSERT(conn);</span><br><span> </span><br><span style="color: hsl(120, 100%, 40%);">+ /* apply LCLS configuration (if any) */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_apply_config(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span> LOGPFSML(fi, LOGL_DEBUG, "Sending assignment complete message... (id=%i)\n", conn->sccp.conn_id);</span><br><span> </span><br><span> /* Generate voice related fields */</span><br><span>@@ -268,6 +304,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>@@ -997,6 +1036,11 @@</span><br><span> resp = gsm0808_create_clear_rqst(GSM0808_CAUSE_RADIO_INTERFACE_FAILURE);</span><br><span> sigtran_send(conn, resp, fi);</span><br><span> break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case GSCON_EV_MGW_MDCX_RESP_MSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_DEBUG, "Rx MDCX of MSC side (LCLS?)\n");</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case GSCON_EV_LCLS_FAIL:</span><br><span style="color: hsl(120, 100%, 40%);">+ break;</span><br><span> default:</span><br><span> OSMO_ASSERT(false);</span><br><span> break;</span><br><span>@@ -1056,6 +1100,12 @@</span><br><span> </span><br><span> /* Make sure all possibly still open MGCP connections get closed */</span><br><span> toss_mgcp_conn(conn, fi);</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%);">+ /* request termination of LCLS FSM */</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%);">+ conn->lcls.fi = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ }</span><br><span> }</span><br><span> </span><br><span> static int gscon_timer_cb(struct osmo_fsm_inst *fi)</span><br><span>@@ -1100,7 +1150,8 @@</span><br><span> .states = gscon_fsm_states,</span><br><span> .num_states = ARRAY_SIZE(gscon_fsm_states),</span><br><span> .allstate_event_mask = S(GSCON_EV_A_DISC_IND) | S(GSCON_EV_A_CLEAR_CMD) | S(GSCON_EV_RSL_CONN_FAIL) |</span><br><span style="color: hsl(0, 100%, 40%);">- S(GSCON_EV_RLL_REL_IND) | S(GSCON_EV_MGW_FAIL_BTS) | S(GSCON_EV_MGW_FAIL_MSC),</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GSCON_EV_RLL_REL_IND) | S(GSCON_EV_MGW_FAIL_BTS) | S(GSCON_EV_MGW_FAIL_MSC) |</span><br><span style="color: hsl(120, 100%, 40%);">+ S(GSCON_EV_MGW_MDCX_RESP_MSC) | S(GSCON_EV_LCLS_FAIL),</span><br><span> .allstate_action = gscon_fsm_allstate,</span><br><span> .cleanup = gscon_cleanup,</span><br><span> .pre_term = gscon_pre_term,</span><br><span>@@ -1117,6 +1168,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 +1189,16 @@</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_child(&lcls_fsm, conn->fi, GSCON_EV_LCLS_FAIL);</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%);">+ conn->lcls.fi->priv = conn;</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 6c2257d..757a8a1 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> if (conn->lchan)</span><br><span> lchan_dump_full_vty(vty, conn->lchan);</span><br><span> if (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..e32376d</span><br><span>--- /dev/null</span><br><span>+++ b/src/libbsc/osmo_bsc_lcls.c</span><br><span>@@ -0,0 +1,760 @@</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%);">+#include <osmocom/mgcp_client/mgcp_client_fsm.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_APPLY_CFG_CSC, "APPLY_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 (%s)\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gsm0808_lcls_status_name(status));</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%);">+ /* We can only correlate if a GCR is present */</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%);">+ /* We can only correlate if we're not in active LS */</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn_local->lcls.fi->state != ST_LOCALLY_SWITCHED &&</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->lcls.fi->state != ST_LOCALLY_SWITCHED_WAIT_BREAK &&</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->lcls.fi->state != ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_other = conn_local->lcls.other;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn_other) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn_local->lcls.fi, "Breaking previous correlation with %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_name(conn_other->lcls.fi));</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn_other->lcls.fi->state != ST_LOCALLY_SWITCHED &&</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_other->lcls.fi->state != ST_LOCALLY_SWITCHED_WAIT_BREAK &&</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_other->lcls.fi->state != ST_LOCALLY_SWITCHED_WAIT_OTHER_BREAK);</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->lcls.other->lcls.other = NULL;</span><br><span style="color: hsl(120, 100%, 40%);">+ conn_local->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%);">+ 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%);">+ LOGPFSM(conn_local->lcls.fi, "Unsuccessful correlation\n");</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%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn_local->lcls.fi, "Successfully correlated with %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_name(conn_other->lcls.fi));</span><br><span style="color: hsl(120, 100%, 40%);">+</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%);">+/* apply the configuration, may be changed before by lcls_update_config */</span><br><span style="color: hsl(120, 100%, 40%);">+void lcls_apply_config(struct gsm_subscriber_connection *conn)</span><br><span style="color: hsl(120, 100%, 40%);">+{</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_fsm_inst_dispatch(conn->lcls.fi, LCLS_EV_APPLY_CFG_CSC, 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 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%);">+ struct mgcp_conn_peer peer;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct sockaddr_in *sin;</span><br><span style="color: hsl(120, 100%, 40%);">+</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%);">+ if (!conn->user_plane.fi_msc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* the MGCP FSM has died, e.g. due to some MGCP/SDP parsing error */</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(conn->lcls.fi, LOGL_NOTICE, "Cannot disable LCLS without MSC-side MGCP FSM\n");</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%);">+ sin = (struct sockaddr_in *)&conn->user_plane.aoip_rtp_addr_remote;</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(sin->sin_family == AF_INET);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ memset(&peer, 0, sizeof(peer));</span><br><span style="color: hsl(120, 100%, 40%);">+ peer.port = htons(sin->sin_port);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_strlcpy(peer.addr, inet_ntoa(sin->sin_addr), sizeof(peer.addr));</span><br><span style="color: hsl(120, 100%, 40%);">+ mgcp_conn_modify(conn->user_plane.fi_msc, 0, &peer);</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_enable_possible(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 LS due to unsupported local config\n");</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%);">+ if (!lcls_is_supported_config(other_conn->lcls.config)) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling LS due to unsupported other config\n");</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%);">+ if (conn->lcls.control != GSM0808_LCLS_CSC_CONNECT) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling LS due to insufficient local control\n");</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%);">+ if (other_conn->lcls.control != GSM0808_LCLS_CSC_CONNECT) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->lcls.fi, "Not enabling LS due to insufficient other control\n");</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%);">+ return true;</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%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.config == 0xff)</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_enable_possible(conn)) {</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%);">+ } else {</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%);">+ }</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%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_enable_possible(conn)) {</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_enable_possible(conn)) {</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_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%);">+ 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%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</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_enable_possible(conn)) {</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%);">+ } else {</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%);">+ }</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%);">+ 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%);">+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_enable_possible(conn)) {</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_enable_possible(conn)) {</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_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%);">+ 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%);">+ //FIXME osmo_fsm_inst_state_chg(fi, </span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</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_is_supported_config(conn->lcls.config))</span><br><span style="color: hsl(120, 100%, 40%);">+ return;</span><br><span style="color: hsl(120, 100%, 40%);">+ if (lcls_enable_possible(conn))</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%);">+ else</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%);">+ 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%);">+ 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%);">+</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%);">+ lcls_break_local_switching(conn);</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%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.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%);">+ /* 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%);">+</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%);">+ struct gsm_subscriber_connection *conn_other = conn->lcls.other;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct mgcp_conn_peer peer;</span><br><span style="color: hsl(120, 100%, 40%);">+ struct sockaddr_in *sin;</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(conn_other);</span><br><span style="color: hsl(120, 100%, 40%);">+</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%);">+ if (!conn->user_plane.fi_msc) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSML(fi, LOGL_ERROR, "Cannot enable LCLS without MSC-side MGCP FSM. FIXME\n");</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%);">+ sin = (struct sockaddr_in *)&conn_other->user_plane.aoip_rtp_addr_local;</span><br><span style="color: hsl(120, 100%, 40%);">+ OSMO_ASSERT(sin->sin_family == AF_INET);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ memset(&peer, 0, sizeof(peer));</span><br><span style="color: hsl(120, 100%, 40%);">+ peer.port = htons(sin->sin_port);</span><br><span style="color: hsl(120, 100%, 40%);">+ osmo_strlcpy(peer.addr, inet_ntoa(sin->sin_addr), sizeof(peer.addr));</span><br><span style="color: hsl(120, 100%, 40%);">+ mgcp_conn_modify(conn->user_plane.fi_msc, 0, &peer);</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_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%);">+ lcls_break_local_switching(conn);</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%);">+ break;</span><br><span style="color: hsl(120, 100%, 40%);">+ case LCLS_EV_APPLY_CFG_CSC:</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.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%);">+ /* 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%);">+ 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%);">+ 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%);">+ lcls_break_local_switching(conn);</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%);">+ /* 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%);">+ 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%);">+ 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%);">+ 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_fsm_cleanup(struct osmo_fsm_inst *fi, enum osmo_fsm_term_cause cause)</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%);">+ if (conn->lcls.other) {</span><br><span style="color: hsl(120, 100%, 40%);">+ /* inform the "other" side that we're dead, so it can disabe LS and send NOTIFY */</span><br><span style="color: hsl(120, 100%, 40%);">+ if (conn->lcls.other->fi)</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%);">+</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_APPLY_CFG_CSC),</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_APPLY_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_APPLY_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_APPLY_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_APPLY_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_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_APPLY_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_APPLY_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 = lcls_fsm_cleanup,</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..24a5e3a 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,8 +34,10 @@</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 style="color: hsl(120, 100%, 40%);">+#include <osmocom/core/fsm.h></span><br><span> </span><br><span> #define IP_V4_ADDR_LEN 4</span><br><span> </span><br><span>@@ -634,6 +636,83 @@</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%);">+ const uint8_t *config, *control;</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%);">+ LOGPFSML(conn->fi, LOGL_ERROR, "Global Call Ref IE of %u bytes is too long\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ tlv->len);</span><br><span style="color: hsl(120, 100%, 40%);">+ else {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->fi, "Setting GCR to %s\n", osmo_hexdump_nospc(tlv->val, tlv->len));</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%);">+ config = TLVP_VAL_MINLEN(tp, GSM0808_IE_LCLS_CONFIG, 1);</span><br><span style="color: hsl(120, 100%, 40%);">+ control = 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%);">+ if (config || control) {</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->fi, "BSSMAP ASS REQ contains LCLS (%s / %s)\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ config ? gsm0808_lcls_config_name(*config) : "NULL",</span><br><span style="color: hsl(120, 100%, 40%);">+ control ? gsm0808_lcls_control_name(*control) : "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%);">+ /* Update the LCLS state with Config + CSC (if any) */</span><br><span style="color: hsl(120, 100%, 40%);">+ lcls_update_config(conn, config, control);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ /* Do not attempt to perform correlation yet, as during processing of the ASS REQ</span><br><span style="color: hsl(120, 100%, 40%);">+ * we don't have the MGCP/MGW connections yet, and hence couldn't enable LS. */</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%);">+ const uint8_t *config, *control;</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%);">+ 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%);">+ LOGPFSML(conn->fi, LOGL_ERROR, "Error parsing TLVs of LCLS CONNT CTRL: %s\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ 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%);">+ config = TLVP_VAL_MINLEN(&tp, GSM0808_IE_LCLS_CONFIG, 1);</span><br><span style="color: hsl(120, 100%, 40%);">+ control = 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%);">+ LOGPFSM(conn->fi, "Rx LCLS CONNECT CTRL (%s / %s)\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ config ? gsm0808_lcls_config_name(*config) : "NULL",</span><br><span style="color: hsl(120, 100%, 40%);">+ control ? gsm0808_lcls_control_name(*control) : "NULL");</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%);">+ LOGPFSML(conn->fi, LOGL_ERROR, "Ignoring LCLS as no GCR was set before\n");</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%);">+ /* 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%);">+ lcls_apply_config(conn);</span><br><span style="color: hsl(120, 100%, 40%);">+</span><br><span style="color: hsl(120, 100%, 40%);">+ LOGPFSM(conn->fi, "Tx LCLS CONNECT CTRL ACK (%s)\n",</span><br><span style="color: hsl(120, 100%, 40%);">+ gsm0808_lcls_status_name(lcls_get_status(conn)));</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 +761,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 +933,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 095a07a..fefc041 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>@@ -369,6 +369,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: merged </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: 3 </div>
<div style="display:none"> Gerrit-Owner: Harald Welte <laforge@gnumonks.org> </div>
<div style="display:none"> Gerrit-Reviewer: Harald Welte <laforge@gnumonks.org> </div>
<div style="display:none"> Gerrit-Reviewer: Jenkins Builder </div>