Add the beginnings of a GSM GPRS dialing app

1 files changed, 374 insertions, 0 deletions

diff --git a/gatchat/gsmdial.c b/gatchat/gsmdial.c
index 705472f7..a2433f09 100644
--- a/gatchat/gsmdial.c
+++ b/gatchat/gsmdial.c
@@ -23,7 +23,381 @@
 #include <config.h>
 #endif
 
+#include <string.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <errno.h>
+#include <unistd.h>
+#include <sys/signalfd.h>
+
+#include <glib.h>
+#include <gatchat.h>
+#include <gattty.h>
+
+static const char *none_prefix[] = { NULL };
+
+static gchar *option_ip = NULL;
+static gint option_port = 0;
+static gchar *option_modem = NULL;
+static gchar *option_control = NULL;
+static gint option_cid = 0;
+static gchar *option_apn = NULL;
+
+static GAtChat *control;
+static GAtChat *modem;
+static GMainLoop *event_loop;
+
+enum state {
+	STATE_NONE = 0,
+	STATE_REGISTERING,
+	STATE_ACTIVATING
+};
+
+static int state = 0;
+
+static void gsmdial_debug(const char *str, void *data)
+{
+	g_print("%s: %s\n", (const char *)data, str);
+}
+
+static gboolean quit_eventloop(gpointer user_data)
+{
+	g_main_loop_quit(event_loop);
+	return FALSE;
+}
+
+static void power_down(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	g_main_loop_quit(event_loop);
+}
+
+static gboolean signal_cb(GIOChannel *channel, GIOCondition cond, gpointer data)
+{
+	static int terminated = 0;
+	int signal_fd = GPOINTER_TO_INT(data);
+	struct signalfd_siginfo si;
+	ssize_t res;
+
+	if (cond & (G_IO_NVAL | G_IO_ERR))
+		return FALSE;
+
+	res = read(signal_fd, &si, sizeof(si));
+	if (res != sizeof(si))
+		return FALSE;
+
+	switch (si.ssi_signo) {
+	case SIGINT:
+	case SIGTERM:
+		if (terminated == 0) {
+			g_timeout_add_seconds(10, quit_eventloop, NULL);
+			g_at_chat_send(control, "AT+CFUN=0", none_prefix,
+					power_down, NULL, NULL);
+		}
+
+		terminated++;
+		break;
+	default:
+		break;
+	}
+
+	return TRUE;
+}
+
+static gboolean at_util_parse_reg_unsolicited(GAtResult *result,
+						const char *prefix, int *status,
+						int *lac, int *ci, int *tech)
+{
+	GAtResultIter iter;
+	int s;
+	int l = -1, c = -1, t = -1;
+	const char *str;
+
+	g_at_result_iter_init(&iter, result);
+
+	if (g_at_result_iter_next(&iter, prefix) == FALSE)
+		return FALSE;
+
+	if (g_at_result_iter_next_number(&iter, &s) == FALSE)
+		return FALSE;
+
+	if (g_at_result_iter_next_string(&iter, &str) == TRUE)
+		l = strtol(str, NULL, 16);
+	else
+		goto out;
+
+	if (g_at_result_iter_next_string(&iter, &str) == TRUE)
+		c = strtol(str, NULL, 16);
+	else
+		goto out;
+
+	g_at_result_iter_next_number(&iter, &t);
+
+out:
+	if (status)
+		*status = s;
+
+	if (lac)
+		*lac = l;
+
+	if (ci)
+		*ci = c;
+
+	if (tech)
+		*tech = t;
+
+	return TRUE;
+}
+
+static void at_cgact_up_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	char buf[64];
+
+	if (!ok) {
+		g_print("Error activating context\n");
+		exit(1);
+	}
+
+	sprintf(buf, "AT+CGDATA=\"PPP\",%u", option_cid);
+
+	g_at_chat_send(modem, buf, none_prefix, NULL, NULL, NULL);
+}
+
+static void at_cgdcont_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	char buf[64];
+
+	if (!ok) {
+		g_print("Unable to define context\n");
+		exit(1);
+	}
+
+	sprintf(buf, "AT+CGACT=1,%u", option_cid);
+
+	g_at_chat_send(control, buf, none_prefix, at_cgact_up_cb, NULL, NULL);
+}
+
+static void creg_notify(GAtResult *result, gpointer user_data)
+{
+	int status, lac, ci, tech;
+
+	if (state != STATE_REGISTERING)
+		return;
+
+	if (at_util_parse_reg_unsolicited(result, "+CREG:", &status,
+				&lac, &ci, &tech) == FALSE)
+		return;
+
+	if (status == 1 || status == 5) {
+		g_print("Registered to network, roaming=%s\n",
+				status == 5 ? "True" : "False");
+		g_print("Activating gprs network...\n");
+		g_at_chat_send(control, "AT+CGATT=1", none_prefix,
+				NULL, NULL, NULL);
+	}
+}
+
+static void cgreg_notify(GAtResult *result, gpointer user_data)
+{
+	int status, lac, ci, tech;
+	char buf[1024];
+	int len;
+
+	if (state != STATE_REGISTERING)
+		return;
+
+	if (at_util_parse_reg_unsolicited(result, "+CGREG:", &status,
+				&lac, &ci, &tech) == FALSE)
+		return;
+
+	if (status != 1 && status != 5)
+		return;
+
+	state = STATE_ACTIVATING;
+
+	g_print("Registered to GPRS network, roaming=%s\n",
+			status == 5 ? "True" : "False");
+
+	len = sprintf(buf, "AT+CGDCONT=%u,\"IP\"", option_cid);
+
+	snprintf(buf + len, sizeof(buf) - len - 3, ",\"%s\"", option_apn);
+
+	g_at_chat_send(control, buf, none_prefix, at_cgdcont_cb, NULL, NULL);
+}
+
+static void register_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	if (!ok) {
+		g_print("Couldn't register to network, exiting...\n");
+		exit(1);
+	}
+
+	state = STATE_REGISTERING;
+	g_print("Waiting for network registration...\n");
+}
+
+static void start_dial(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	if (!ok) {
+		g_print("Turning on the modem failed\n");
+		exit(1);
+	}
+
+	g_at_chat_register(control, "+CREG:",
+				creg_notify, FALSE, NULL, NULL);
+	g_at_chat_register(control, "+CGREG:",
+				cgreg_notify, FALSE, NULL, NULL);
+
+	g_at_chat_send(control, "AT+CREG=2", none_prefix, NULL, NULL, NULL);
+	g_at_chat_send(control, "AT+CGREG=2", none_prefix, NULL, NULL, NULL);
+
+	g_at_chat_send(control, "AT+COPS=0", none_prefix, register_cb, NULL, NULL);
+}
+
+static int open_serial()
+{
+	GAtSyntax *syntax;
+	GIOChannel *channel;
+
+	channel = g_at_tty_open(option_control, NULL);
+	if (channel == NULL)
+		return -EIO;
+
+	syntax = g_at_syntax_new_gsm_permissive();
+	control = g_at_chat_new(channel, syntax);
+	g_io_channel_unref(channel);
+	g_at_syntax_unref(syntax);
+
+	if (control == NULL)
+		return -EIO;
+
+	if (option_modem == NULL) {
+		g_at_chat_ref(control);
+		modem = control;
+		g_at_chat_set_debug(control, gsmdial_debug, "");
+	} else {
+		g_at_chat_set_debug(control, gsmdial_debug, "Control");
+
+		channel = g_at_tty_open(option_modem, NULL);
+		if (channel == NULL)
+			return -EIO;
+
+		syntax = g_at_syntax_new_gsm_permissive();
+		modem = g_at_chat_new(channel, syntax);
+		g_io_channel_unref(channel);
+		g_at_syntax_unref(syntax);
+
+		if (modem == NULL)
+			return -EIO;
+
+		g_at_chat_set_debug(modem, gsmdial_debug, "Modem");
+	}
+
+	return 0;
+}
+
+static GOptionEntry options[] = {
+	{ "ip", 'i', 0, G_OPTION_ARG_STRING, &option_ip,
+				"Specify IP" },
+	{ "port", 'p', 0, G_OPTION_ARG_INT, &option_port,
+				"Specify IP Port" },
+	{ "control", 'n', 0, G_OPTION_ARG_FILENAME, &option_control,
+				"Specify Modem Control port" },
+	{ "modem", 'm', 0, G_OPTION_ARG_FILENAME, &option_modem,
+				"Specify Modem port (ppp), if not provided"
+				" the control port will be used" },
+	{ "cid", 'c', 0, G_OPTION_ARG_INT, &option_cid,
+				"Specify CID to use" },
+	{ "apn", 'a', 0, G_OPTION_ARG_STRING, &option_apn,
+				"Specify APN" },
+	{ NULL },
+};
+
 int main(int argc, char **argv)
 {
+	GOptionContext *context;
+	GError *err = NULL;
+	sigset_t mask;
+	int signal_fd;
+	GIOChannel *signal_io;
+	int signal_source;
+
+	context = g_option_context_new(NULL);
+	g_option_context_add_main_entries(context, options, NULL);
+
+	if (g_option_context_parse(context, &argc, &argv, &err) == FALSE) {
+		if (err != NULL) {
+			g_printerr("%s\n", err->message);
+			g_error_free(err);
+			return 1;
+		}
+
+		g_printerr("An unknown error occurred\n");
+		return 1;
+	}
+
+	g_option_context_free(context);
+
+	if (option_control) {
+		int ret;
+
+		g_print("Control: %s\n", option_control);
+		if (option_modem)
+			g_print("Modem: %s\n", option_modem);
+
+		ret = open_serial();
+		g_free(option_control);
+		g_free(option_modem);
+
+		if (ret < 0)
+			goto out;
+	} else {
+		g_print("IP: %s\n", option_ip);
+		g_print("Port: %d\n", option_port);
+		g_free(option_ip);
+
+		goto out;
+	}
+
+	g_print("APN: %s\n", option_apn);
+	g_print("CID: %d\n", option_cid);
+
+	sigemptyset(&mask);
+	sigaddset(&mask, SIGTERM);
+	sigaddset(&mask, SIGINT);
+	sigaddset(&mask, SIGUSR2);
+	sigaddset(&mask, SIGPIPE);
+
+	if (sigprocmask(SIG_BLOCK, &mask, NULL) < 0) {
+		perror("Can't set signal mask");
+		return 1;
+	}
+
+	signal_fd = signalfd(-1, &mask, 0);
+	if (signal_fd < 0) {
+		perror("Can't create signal filedescriptor");
+		return 1;
+	}
+
+	signal_io = g_io_channel_unix_new(signal_fd);
+	g_io_channel_set_close_on_unref(signal_io, TRUE);
+	signal_source = g_io_add_watch(signal_io,
+			G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
+			signal_cb, GINT_TO_POINTER(signal_fd));
+	g_io_channel_unref(signal_io);
+
+	event_loop = g_main_loop_new(NULL, FALSE);
+
+	g_at_chat_send(control, "ATE0Q0V1", NULL, NULL, NULL, NULL);
+	g_at_chat_send(control, "AT+CFUN=1", NULL, start_dial, NULL, NULL);
+
+	g_main_loop_run(event_loop);
+	g_source_remove(signal_source);
+	g_main_loop_unref(event_loop);
+
+out:
+	g_at_chat_unref(control);
+	g_at_chat_unref(modem);
+	g_free(option_apn);
+
 	return 0;
 }