emulator: Add example TCP based emulator

1 files changed, 193 insertions, 0 deletions

diff --git a/examples/emulator.c b/examples/emulator.c
new file mode 100644
index 00000000..b0080cf3
--- /dev/null
+++ b/examples/emulator.c
@@ -0,0 +1,193 @@
+/*
+ *
+ *  oFono - Open Source Telephony
+ *
+ *  Copyright (C) 2008-2011  Intel Corporation. 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 version 2 as
+ *  published by the Free Software Foundation.
+ *
+ *  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 St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <string.h>
+#include <errno.h>
+#include <sys/socket.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <unistd.h>
+
+#include <glib.h>
+
+#define OFONO_API_SUBJECT_TO_CHANGE
+#include <ofono/plugin.h>
+#include <ofono/log.h>
+#include <ofono/modem.h>
+#include <ofono/emulator.h>
+
+#include "ofono.h"
+
+#define TCP_PORT 12346
+
+static unsigned int modemwatch_id;
+guint server_watch;
+static GList *modems;
+
+static gboolean on_socket_connected(GIOChannel *chan, GIOCondition cond,
+							gpointer user)
+{
+	struct sockaddr saddr;
+	unsigned int len = sizeof(saddr);
+	int fd;
+	struct ofono_emulator *em;
+	struct ofono_modem *modem;
+
+	if (cond != G_IO_IN)
+		return FALSE;
+
+	fd = accept(g_io_channel_unix_get_fd(chan), &saddr, &len);
+	if (fd == -1)
+		return FALSE;
+
+	/* Pick the first powered modem */
+	modem = modems->data;
+	DBG("Picked modem %p for emulator", modem);
+
+	em = ofono_emulator_create(modem, OFONO_EMULATOR_TYPE_DUN);
+	if (em == NULL)
+		close(fd);
+	else
+		ofono_emulator_register(em, fd);
+
+	return TRUE;
+}
+
+static gboolean create_tcp(void)
+{
+	struct sockaddr_in addr;
+	int sk;
+	int reuseaddr = 1;
+	GIOChannel *server;
+
+	sk = socket(PF_INET, SOCK_STREAM, 0);
+	if (sk < 0)
+		return FALSE;
+
+	memset(&addr, 0, sizeof(addr));
+
+	addr.sin_family = AF_INET;
+	addr.sin_addr.s_addr = INADDR_ANY;
+	addr.sin_port = htons(TCP_PORT);
+
+	setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &reuseaddr, sizeof(reuseaddr));
+
+	if (bind(sk, (struct sockaddr *) &addr, sizeof(struct sockaddr)) < 0)
+		goto err;
+
+	if (listen(sk, 1) < 0)
+		goto err;
+
+	server = g_io_channel_unix_new(sk);
+	g_io_channel_set_close_on_unref(server, TRUE);
+
+	server_watch = g_io_add_watch_full(server, G_PRIORITY_DEFAULT,
+				G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
+				on_socket_connected, NULL, NULL);
+
+	g_io_channel_unref(server);
+
+	DBG("Created server_watch: %u", server_watch);
+
+	return TRUE;
+
+err:
+	close(sk);
+	return FALSE;
+}
+
+static void powered_watch(struct ofono_modem *modem, gboolean powered,
+				void *user)
+{
+	if (powered == FALSE) {
+		DBG("Removing modem %p from the list", modem);
+		modems = g_list_remove(modems, modem);
+
+		if (modems == NULL && server_watch > 0) {
+			DBG("Removing server watch: %u", server_watch);
+			g_source_remove(server_watch);
+			server_watch = 0;
+		}
+	} else {
+		DBG("Adding modem %p to the list", modem);
+		modems = g_list_append(modems, modem);
+
+		if (modems->next == NULL)
+			create_tcp();
+	}
+}
+
+static void modem_watch(struct ofono_modem *modem, gboolean added, void *user)
+{
+	DBG("modem: %p, added: %d", modem, added);
+
+	if (added == FALSE) {
+		DBG("Removing modem %p from the list", modem);
+		modems = g_list_remove(modems, modem);
+		return;
+	}
+
+	if (ofono_modem_get_powered(modem) == TRUE) {
+		DBG("Adding modem %p to the list", modem);
+		modems = g_list_append(modems, modem);
+
+		if (modems->next == NULL)
+			create_tcp();
+	}
+
+	__ofono_modem_add_powered_watch(modem, powered_watch, NULL, NULL);
+}
+
+static void call_modemwatch(struct ofono_modem *modem, void *user)
+{
+	modem_watch(modem, TRUE, user);
+}
+
+static int example_emulator_init(void)
+{
+	DBG("");
+
+	modemwatch_id = __ofono_modemwatch_add(modem_watch, NULL, NULL);
+
+	__ofono_modem_foreach(call_modemwatch, NULL);
+
+	return 0;
+}
+
+static void example_emulator_exit(void)
+{
+	DBG("");
+
+	__ofono_modemwatch_remove(modemwatch_id);
+
+	g_list_free(modems);
+
+	if (server_watch)
+		g_source_remove(server_watch);
+}
+
+OFONO_PLUGIN_DEFINE(example_emulator, "Example AT Modem Emulator Plugin",
+			VERSION, OFONO_PLUGIN_PRIORITY_DEFAULT,
+			example_emulator_init, example_emulator_exit)