udt_relay: Add a forked copy of main to just relay messages

Do not run any of the header rewriting for messages. This will
simply relay SCCP friends to the MTP library. Some work on msc_conn.c
is needed to avoid calling most of it.

4 files changed, 378 insertions, 4 deletions

diff --git a/src/Makefile.am b/src/Makefile.am
index e420387..e1e69b7 100644
--- a/src/Makefile.am
+++ b/src/Makefile.am
@@ -2,7 +2,7 @@ INCLUDES = $(all_includes) -I$(top_srcdir)/include
 AM_CFLAGS=-Wall $(LIBOSMOCORE_CFLAGS) $(LIBOSMOSCCP_CFLAGS) $(LIBOSMOVTY_CFLAGS) \
 		$(NEXUSWARE_C7_CFLAGS) $(NEXUSWARE_UNIPORTE_CFLAGS) $(UNIPORTE)
 
-sbin_PROGRAMS = cellmgr_ng mgcp_mgw
+sbin_PROGRAMS = cellmgr_ng udt_relay mgcp_mgw
 
 mgcp_mgw_SOURCES = mgcp_ss7.c thread.c debug.c \
 		   mgcp/mgcp_protocol.c mgcp/mgcp_network.c mgcp/mgcp_vty.c
@@ -14,3 +14,9 @@ cellmgr_ng_SOURCES = main.c mtp_layer3.c thread.c input/ipaccess.c pcap.c \
 		     msc_conn.c link_udp.c snmp_mtp.c debug.c vty_interface.c
 cellmgr_ng_LDADD = $(LIBOSMOCORE_LIBS) $(LIBOSMOSCCP_LIBS) $(LIBOSMOVTY_LIBS) $(NEXUSWARE_C7_LIBS) \
 		   -lpthread -lnetsnmp -lcrypto
+
+udt_relay_SOURCES = main_udt.c mtp_layer3.c thread.c input/ipaccess.c pcap.c \
+		     msc_conn.c link_udp.c snmp_mtp.c debug.c vty_interface.c \
+		     bss_patch.c
+udt_relay_LDADD = $(LIBOSMOCORE_LIBS) $(LIBOSMOSCCP_LIBS) $(LIBOSMOVTY_LIBS) $(NEXUSWARE_C7_LIBS) \
+		   -lpthread -lnetsnmp -lcrypto
diff --git a/src/main.c b/src/main.c
index bcb4035..a5f850f 100644
--- a/src/main.c
+++ b/src/main.c
@@ -703,7 +703,7 @@ static void start_rest(void *start)
 {
 	bsc.setup = 1;
 
-	if (msc_init(&bsc) != 0) {
+	if (msc_init(&bsc, 1) != 0) {
 		fprintf(stderr, "Failed to init MSC part.\n");
 		exit(3);
 	}
diff --git a/src/main_udt.c b/src/main_udt.c
new file mode 100644
index 0000000..0b07da7
--- /dev/null
+++ b/src/main_udt.c
@@ -0,0 +1,363 @@
+/* Relay UDT/all SCCP messages */
+/*
+ * (C) 2010 by Holger Hans Peter Freyther <zecke@selfish.org>
+ * (C) 2010 by On-Waves
+ * All Rights Reserved
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ *
+ */
+
+#include <mtp_data.h>
+#include <mtp_pcap.h>
+#include <thread.h>
+#include <bsc_data.h>
+#include <snmp_mtp.h>
+#include <cellmgr_debug.h>
+
+#include <osmocore/talloc.h>
+
+#include <osmocom/vty/vty.h>
+#include <osmocom/vty/telnet_interface.h>
+
+#include <sys/stat.h>
+#include <sys/types.h>
+
+#include <fcntl.h>
+#include <signal.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <assert.h>
+#include <unistd.h>
+
+#ifndef _GNU_SOURCE
+#define _GNU_SOURCE
+#endif
+#include <getopt.h>
+
+#undef PACKAGE_NAME
+#undef PACKAGE_VERSION
+#undef PACKAGE_BUGREPORT
+#undef PACKAGE_TARNAME
+#undef PACKAGE_STRING
+#include <cellmgr_config.h>
+
+static struct log_target *stderr_target;
+
+static char *config = "udt_relay.cfg";
+
+struct bsc_data bsc;
+extern void cell_vty_init(void);
+
+int link_c7_init(struct link_data *data) __attribute__((__weak__));
+
+int link_c7_init(struct link_data *data)
+{
+	return -1;
+}
+
+/*
+ * methods called from the MTP Level3 part
+ */
+void mtp_link_submit(struct mtp_link *link, struct msgb *msg)
+{
+	bsc.link.write(&bsc.link, msg);
+}
+
+void mtp_link_restart(struct mtp_link *link)
+{
+	LOGP(DINP, LOGL_ERROR, "Need to restart the SS7 link.\n");
+	bsc.link.reset(&bsc.link);
+}
+
+void mtp_link_sccp_down(struct mtp_link *link)
+{
+	msc_clear_queue(&bsc);
+}
+
+void mtp_link_forward_sccp(struct mtp_link *link, struct msgb *_msg, int sls)
+{
+	msc_send_direct(&bsc, _msg);
+}
+
+void bsc_link_down(struct link_data *data)
+{
+	int was_up;
+	struct mtp_link *link = data->the_link;
+
+	link->available = 0;
+	was_up = link->sccp_up;
+	mtp_link_stop(link);
+
+	data->clear_queue(data);
+
+	/* clear pending messages from the MSC */
+	msc_clear_queue(data->bsc);
+
+	/* If we have an A link send a reset to the MSC */
+	msc_send_reset(data->bsc);
+}
+
+void bsc_link_up(struct link_data *data)
+{
+	data->the_link->available = 1;
+	mtp_link_reset(data->the_link);
+}
+
+static void print_usage()
+{
+	printf("Usage: cellmgr_ng\n");
+}
+
+static void sigint()
+{
+	static pthread_mutex_t exit_mutex = PTHREAD_MUTEX_INITIALIZER;
+	static int handled = 0;
+
+	/* failed to lock */
+	if (pthread_mutex_trylock(&exit_mutex) != 0)
+		return;
+	if (handled)
+		goto out;
+
+	printf("Terminating.\n");
+	handled = 1;
+	if (bsc.setup)
+		bsc.link.shutdown(&bsc.link);
+	exit(0);
+
+out:
+	pthread_mutex_unlock(&exit_mutex);
+}
+
+static void sigusr2()
+{
+	printf("Closing the MSC connection on demand.\n");
+	msc_close_connection(&bsc);
+}
+
+static void print_help()
+{
+	printf("  Some useful help...\n");
+	printf("  -h --help this text\n");
+	printf("  -c --config=CFG The config file to use.\n");
+	printf("  -p --pcap=FILE. Write MSUs to the PCAP file.\n");
+	printf("  -c --once. Send the SLTM msg only once.\n");
+	printf("  -v --version. Print the version number\n");
+}
+
+static void handle_options(int argc, char **argv)
+{
+	while (1) {
+		int option_index = 0, c;
+		static struct option long_options[] = {
+			{"help", 0, 0, 'h'},
+			{"config", 1, 0, 'c'},
+			{"pcap", 1, 0, 'p'},
+			{"version", 0, 0, 0},
+			{0, 0, 0, 0},
+		};
+
+		c = getopt_long(argc, argv, "hc:p:v",
+				long_options, &option_index);
+		if (c == -1)
+			break;
+
+		switch (c) {
+		case 'h':
+			print_usage();
+			print_help();
+			exit(0);
+		case 'p':
+			if (bsc.link.pcap_fd >= 0)
+				close(bsc.link.pcap_fd);
+			bsc.link.pcap_fd = open(optarg, O_WRONLY | O_TRUNC | O_CREAT, S_IRUSR | S_IWUSR | S_IRGRP| S_IROTH);
+			if (bsc.link.pcap_fd < 0) {
+				fprintf(stderr, "Failed to open PCAP file.\n");
+				exit(0);
+			}
+			mtp_pcap_write_header(bsc.link.pcap_fd);
+			break;
+		case 'c':
+			config = optarg;
+			break;
+		case 'v':
+			printf("This is %s version %s.\n", PACKAGE, VERSION);
+			exit(0);
+			break;
+		default:
+			fprintf(stderr, "Unknown option.\n");
+			break;
+		}
+	}
+}
+
+static void start_rest(void *start)
+{
+	bsc.setup = 1;
+
+	if (msc_init(&bsc, 0) != 0) {
+		fprintf(stderr, "Failed to init MSC part.\n");
+		exit(3);
+	}
+
+	bsc.link.start(&bsc.link);
+}
+
+
+int main(int argc, char **argv)
+{
+	int rc;
+	INIT_LLIST_HEAD(&bsc.sccp_connections);
+
+	bsc.dpc = 1;
+	bsc.opc = 0;
+	bsc.udp_port = 3456;
+	bsc.udp_ip = NULL;
+	bsc.src_port = 1313;
+
+	mtp_link_init();
+	thread_init();
+
+	log_init(&log_info);
+	stderr_target = log_target_create_stderr();
+	log_add_target(stderr_target);
+
+	/* enable filters */
+	log_set_all_filter(stderr_target, 1);
+	log_set_category_filter(stderr_target, DINP, 1, LOGL_INFO);
+	log_set_category_filter(stderr_target, DSCCP, 1, LOGL_INFO);
+	log_set_category_filter(stderr_target, DMSC, 1, LOGL_INFO);
+	log_set_category_filter(stderr_target, DMGCP, 1, LOGL_INFO);
+	log_set_print_timestamp(stderr_target, 1);
+	log_set_use_color(stderr_target, 0);
+
+	sccp_set_log_area(DSCCP);
+
+	bsc.setup = 0;
+	bsc.msc_address = "127.0.0.1";
+	bsc.link.pcap_fd = -1;
+	bsc.link.udp.reset_timeout = 180;
+	bsc.ping_time = 20;
+	bsc.pong_time = 5;
+	bsc.msc_time = 20;
+
+	handle_options(argc, argv);
+
+	signal(SIGPIPE, SIG_IGN);
+	signal(SIGINT, sigint);
+	signal(SIGUSR2, sigusr2);
+	srand(time(NULL));
+
+	cell_vty_init();
+	if (vty_read_config_file(config, NULL) < 0) {
+		fprintf(stderr, "Failed to read the VTY config.\n");
+		return -1;
+	}
+
+	rc = telnet_init(NULL, NULL, 4242);
+	if (rc < 0)
+		return rc;
+
+	bsc.link.the_link = mtp_link_alloc();
+	bsc.link.the_link->dpc = bsc.dpc;
+	bsc.link.the_link->opc = bsc.opc;
+	bsc.link.the_link->link = 0;
+	bsc.link.the_link->sltm_once = bsc.once;
+	bsc.link.bsc = &bsc;
+
+	if (bsc.udp_ip) {
+		LOGP(DINP, LOGL_NOTICE, "Using UDP MTP mode.\n");
+
+		/* setup SNMP first, it is blocking */
+		bsc.link.udp.session = snmp_mtp_session_create(bsc.udp_ip);
+		if (!bsc.link.udp.session)
+			return -1;
+
+		/* now connect to the transport */
+		if (link_udp_init(&bsc.link, bsc.src_port, bsc.udp_ip, bsc.udp_port) != 0)
+			return -1;
+
+		/* 
+		 * We will ask the MTP link to be taken down for two
+		 * timeouts of the BSC to make sure we are missing the
+		 * SLTM and it begins a reset. Then we will take it up
+		 * again and do the usual business.
+		 */
+		snmp_mtp_deactivate(bsc.link.udp.session);
+		bsc.start_timer.cb = start_rest;
+		bsc.start_timer.data = &bsc;
+		bsc_schedule_timer(&bsc.start_timer, bsc.link.udp.reset_timeout, 0);
+		LOGP(DMSC, LOGL_NOTICE, "Making sure SLTM will timeout.\n");
+	} else {
+		LOGP(DINP, LOGL_NOTICE, "Using NexusWare C7 input.\n");
+		if (link_c7_init(&bsc.link) != 0)
+			return -1;
+
+		/* give time to things to start*/
+		bsc.start_timer.cb = start_rest;
+		bsc.start_timer.data = &bsc;
+		bsc_schedule_timer(&bsc.start_timer, 30, 0);
+		LOGP(DMSC, LOGL_NOTICE, "Waiting to continue to startup.\n");
+	}
+
+
+        while (1) {
+		bsc_select_main(0);
+        }
+
+	return 0;
+}
+
+void release_bsc_resources(struct bsc_data *bsc)
+{
+	/* clear pending messages from the MSC */
+	msc_clear_queue(bsc);
+}
+
+struct msgb *create_sccp_rlc(struct sccp_source_reference *src_ref,
+			     struct sccp_source_reference *dst)
+{
+	abort();
+	return NULL;
+}
+
+struct msgb *create_reset()
+{
+	abort();
+	return NULL;
+}
+
+void update_con_state(struct mtp_link *link, int rc, struct sccp_parse_result *res, struct msgb *msg, int from_msc, int sls)
+{
+	LOGP(DMSC, LOGL_ERROR, "Should not be called.\n");
+	return;
+}
+
+unsigned int sls_for_src_ref(struct sccp_source_reference *ref)
+{
+	return 13;
+}
+
+int bsc_ussd_handle_in_msg(struct bsc_data *bsc, struct sccp_parse_result *res, struct msgb *msg)
+{
+	return 0;
+}
+
+int bsc_ussd_handle_out_msg(struct bsc_data *bsc, struct sccp_parse_result *res, struct msgb *msg)
+{
+	return 0;
+}
diff --git a/src/msc_conn.c b/src/msc_conn.c
index 6e996d9..f980178 100644
--- a/src/msc_conn.c
+++ b/src/msc_conn.c
@@ -519,7 +519,7 @@ static int mgcp_create_port(struct bsc_data *bsc)
 	return 0;
 }
 
-int msc_init(struct bsc_data *bsc)
+int msc_init(struct bsc_data *bsc, int mgcp)
 {
 	write_queue_init(&bsc->msc_connection, 100);
 	bsc->reconnect_timer.cb = msc_reconnect;
@@ -536,7 +536,7 @@ int msc_init(struct bsc_data *bsc)
 	bsc->pong_timeout.data = bsc;
 
 	/* create MGCP port */
-	if (mgcp_create_port(bsc) != 0)
+	if (mgcp && mgcp_create_port(bsc) != 0)
 		return -1;
 
 	/* now connect to the BSC */
@@ -597,6 +597,11 @@ static void msc_send_id_response(struct bsc_data *bsc)
 	msc_send(bsc, msg, IPAC_PROTO_IPACCESS);
 }
 
+void msc_send_direct(struct bsc_data *bsc, struct msgb *msg)
+{
+	return msc_send(bsc, msg, IPAC_PROTO_SCCP);
+}
+
 void msc_send_msg(struct bsc_data *bsc, int rc, struct sccp_parse_result *result, struct msgb *_msg)
 {
 	struct msgb *msg;