[PATCH 5/7] cdmamodem: add CDMA Connection Manager support

[PATCH 5/7] cdmamodem: add CDMA Connection Manager support

[christian.lam]

[-- Attachment #1: Type: text/plain, Size: 9311 bytes --]

From: Christian Lam <christian.lam@nokia.com>

---
 Makefile.am                   |    3 +-
 drivers/cdmamodem/cdmamodem.c |    4 +-
 drivers/cdmamodem/cdmamodem.h |    4 +-
 drivers/cdmamodem/connman.c   |  283 +++++++++++++++++++++++++++++++++++++++++
 4 files changed, 291 insertions(+), 3 deletions(-)
 create mode 100644 drivers/cdmamodem/connman.c

diff --git a/Makefile.am b/Makefile.am
index dc50a83..e077557 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -254,7 +254,8 @@ builtin_modules += cdmamodem
 builtin_sources += drivers/cdmamodem/cdmamodem.h \
 			drivers/cdmamodem/cdmamodem.c \
 			drivers/cdmamodem/voicecall.c \
-			drivers/cdmamodem/devinfo.c
+			drivers/cdmamodem/devinfo.c \
+			drivers/cdmamodem/connman.c
 endif
 
 builtin_modules += g1
diff --git a/drivers/cdmamodem/cdmamodem.c b/drivers/cdmamodem/cdmamodem.c
index 9eddd88..1b19a4a 100644
--- a/drivers/cdmamodem/cdmamodem.c
+++ b/drivers/cdmamodem/cdmamodem.c
@@ -2,7 +2,7 @@
  *
  *  oFono - Open Source Telephony
  *
- *  Copyright (C) 2010 Nokia Corporation. All rights reserved.
+ *  Copyright (C) 2010-2011 Nokia 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
@@ -36,6 +36,7 @@ static int cdmamodem_init(void)
 {
 	cdma_voicecall_init();
 	cdma_devinfo_init();
+	cdma_connman_init();
 
 	return 0;
 }
@@ -44,6 +45,7 @@ static void cdmamodem_exit(void)
 {
 	cdma_voicecall_exit();
 	cdma_devinfo_exit();
+	cdma_connman_exit();
 }
 
 OFONO_PLUGIN_DEFINE(cdmamodem, "CDMA AT modem driver", VERSION,
diff --git a/drivers/cdmamodem/cdmamodem.h b/drivers/cdmamodem/cdmamodem.h
index 4365bec..90e2848 100644
--- a/drivers/cdmamodem/cdmamodem.h
+++ b/drivers/cdmamodem/cdmamodem.h
@@ -2,7 +2,7 @@
  *
  *  oFono - Open Source Telephony
  *
- *  Copyright (C) 2010 Nokia Corporation. All rights reserved.
+ *  Copyright (C) 2010-2011 Nokia 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
@@ -25,3 +25,5 @@ extern void cdma_voicecall_init(void);
 extern void cdma_voicecall_exit(void);
 extern void cdma_devinfo_init(void);
 extern void cdma_devinfo_exit(void);
+extern void cdma_connman_init(void);
+extern void cdma_connman_exit(void);
diff --git a/drivers/cdmamodem/connman.c b/drivers/cdmamodem/connman.c
new file mode 100644
index 0000000..d563413
--- /dev/null
+++ b/drivers/cdmamodem/connman.c
@@ -0,0 +1,283 @@
+/*
+ *
+ *  oFono - Open Source Telephony
+ *
+ *  Copyright (C) 2010-2011 Nokia 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
+
+#define _GNU_SOURCE
+#include <string.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <errno.h>
+
+#include <glib.h>
+
+#include <ofono/log.h>
+#include <ofono/modem.h>
+#include <ofono/cdma-connman.h>
+
+#include "gatchat.h"
+#include "gatresult.h"
+#include "gatppp.h"
+
+#include "cdmamodem.h"
+
+#define STATIC_IP_NETMASK "255.255.255.255"
+
+static const char *none_prefix[] = { NULL };
+
+enum state {
+	STATE_IDLE,
+	STATE_ENABLING,
+	STATE_DISABLING,
+	STATE_ACTIVE,
+};
+
+struct connman_data {
+	GAtChat *chat;
+	GAtPPP *ppp;
+	enum state state;
+	union {
+		ofono_cdma_connman_cb_t down_cb;	/* Down callback */
+		ofono_cdma_connman_up_cb_t up_cb;	/* Up callback */
+	};
+	void *cb_data;					/* Callback data */
+};
+
+static void ppp_debug(const char *str, void *data)
+{
+	ofono_info("%s: %s", (const char *) data, str);
+}
+
+static void ppp_connect(const char *interface, const char *local,
+					const char *remote,
+					const char *dns1, const char *dns2,
+					gpointer user_data)
+{
+	struct ofono_cdma_connman *cm = user_data;
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+	const char *dns[3];
+
+	DBG("");
+
+	dns[0] = dns1;
+	dns[1] = dns2;
+	dns[2] = 0;
+
+	ofono_info("IP: %s", local);
+	ofono_info("DNS: %s, %s", dns1, dns2);
+
+	cd->state = STATE_ACTIVE;
+	CALLBACK_WITH_SUCCESS(cd->up_cb, interface, TRUE, local,
+					STATIC_IP_NETMASK, NULL,
+					dns, cd->cb_data);
+}
+
+static void ppp_disconnect(GAtPPPDisconnectReason reason, gpointer user_data)
+{
+	struct ofono_cdma_connman *cm = user_data;
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+
+	DBG("");
+
+	g_at_ppp_unref(cd->ppp);
+	cd->ppp = NULL;
+
+	switch (cd->state) {
+	case STATE_ENABLING:
+		CALLBACK_WITH_FAILURE(cd->up_cb, NULL, FALSE, NULL,
+					NULL, NULL, NULL, cd->cb_data);
+		break;
+	case STATE_DISABLING:
+		CALLBACK_WITH_SUCCESS(cd->down_cb, cd->cb_data);
+		break;
+	default:
+		/* TODO: Handle network initiated disconnection */
+		break;
+	}
+
+	cd->state = STATE_IDLE;
+	g_at_chat_resume(cd->chat);
+}
+
+static gboolean setup_ppp(struct ofono_cdma_connman *cm)
+{
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+	GAtIO *io;
+
+	DBG("");
+
+	io = g_at_chat_get_io(cd->chat);
+
+	g_at_chat_suspend(cd->chat);
+
+	/* open ppp */
+	cd->ppp = g_at_ppp_new_from_io(io);
+
+	if (cd->ppp == NULL) {
+		g_at_chat_resume(cd->chat);
+		return FALSE;
+	}
+
+	if (getenv("OFONO_PPP_DEBUG"))
+		g_at_ppp_set_debug(cd->ppp, ppp_debug, "PPP");
+
+	/* set connect and disconnect callbacks */
+	g_at_ppp_set_connect_function(cd->ppp, ppp_connect, cm);
+	g_at_ppp_set_disconnect_function(cd->ppp, ppp_disconnect, cm);
+
+	/* open the ppp connection */
+	g_at_ppp_open(cd->ppp);
+
+	return TRUE;
+}
+
+static void atd_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	struct ofono_cdma_connman *cm = user_data;
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+
+	DBG("ok %d", ok);
+
+	if (ok == FALSE) {
+		struct ofono_error error;
+
+		ofono_info("Unable to enter data state");
+
+		cd->state = STATE_IDLE;
+
+		decode_at_error(&error, g_at_result_final_response(result));
+		cd->up_cb(&error, NULL, 0, NULL, NULL, NULL, NULL,
+				cd->cb_data);
+		return;
+	}
+
+	setup_ppp(cm);
+}
+
+static void cdma_connman_activate(struct ofono_cdma_connman *cm,
+					ofono_cdma_connman_up_cb_t cb,
+					void *data)
+{
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+	char buf[64];
+
+	DBG("");
+
+	cd->up_cb = cb;
+	cd->cb_data = data;
+	cd->state = STATE_ENABLING;
+
+	sprintf(buf, "ATD#777");
+
+	if (g_at_chat_send(cd->chat, buf, none_prefix,
+				atd_cb, cm, NULL) > 0)
+		return;
+
+	CALLBACK_WITH_FAILURE(cb, NULL, 0, NULL, NULL, NULL, NULL, data);
+}
+
+static void cdma_connman_deactivate(struct ofono_cdma_connman *cm,
+					ofono_cdma_connman_cb_t cb,
+					void *data)
+{
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+
+	DBG("");
+
+	cd->state = STATE_DISABLING;
+	cd->down_cb = cb;
+	cd->cb_data = data;
+
+	g_at_ppp_shutdown(cd->ppp);
+}
+
+static void at_c0_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+	struct ofono_cdma_connman *cm = user_data;
+
+	DBG("ok %d", ok);
+
+	if (ok == FALSE) {
+		ofono_info("Unable to configure circuit 109");
+		ofono_cdma_connman_remove(cm);
+		return;
+	}
+
+	ofono_cdma_connman_register(cm);
+}
+
+static int cdma_connman_probe(struct ofono_cdma_connman *cm,
+					unsigned int vendor, void *data)
+{
+	GAtChat *chat = data;
+	struct connman_data *cd;
+
+	DBG("");
+
+	cd = g_try_new0(struct connman_data, 1);
+	if (cd == NULL)
+		return -ENOMEM;
+
+	cd->chat = g_at_chat_clone(chat);
+
+	ofono_cdma_connman_set_data(cm, cd);
+
+	g_at_chat_send(cd->chat, "AT&C0", none_prefix, at_c0_cb, cm, NULL);
+
+	return 0;
+}
+
+static void cdma_connman_remove(struct ofono_cdma_connman *cm)
+{
+	struct connman_data *cd = ofono_cdma_connman_get_data(cm);
+
+	DBG("");
+
+	if (cd->state != STATE_IDLE && cd->ppp) {
+		g_at_ppp_unref(cd->ppp);
+		g_at_chat_resume(cd->chat);
+	}
+
+	ofono_cdma_connman_set_data(cm, NULL);
+
+	g_at_chat_unref(cd->chat);
+	g_free(cd);
+}
+
+static struct ofono_cdma_connman_driver driver = {
+	.name			= "cdmamodem",
+	.probe			= cdma_connman_probe,
+	.remove			= cdma_connman_remove,
+	.activate		= cdma_connman_activate,
+	.deactivate		= cdma_connman_deactivate,
+};
+
+void cdma_connman_init(void)
+{
+	ofono_cdma_connman_driver_register(&driver);
+}
+
+void cdma_connman_exit(void)
+{
+	ofono_cdma_connman_driver_unregister(&driver);
+}
-- 
1.7.0.4