diff options
| -rw-r--r-- | Makefile.am | 3 | ||||
| -rw-r--r-- | drivers/cdmamodem/cdmamodem.c | 4 | ||||
| -rw-r--r-- | drivers/cdmamodem/cdmamodem.h | 4 | ||||
| -rw-r--r-- | drivers/cdmamodem/connman.c | 283 |
4 files changed, 291 insertions, 3 deletions
diff --git a/Makefile.am b/Makefile.am index b0879343..a402036a 100644 --- a/Makefile.am +++ b/Makefile.am @@ -263,7 +263,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 9eddd880..1b19a4a2 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 4365bec0..90e2848b 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 00000000..d5634133 --- /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); +} |