--- plugins/speedupcdma.c | 135 ++++++++++++++++++++++++++++++++++++++----------- 1 files changed, 105 insertions(+), 30 deletions(-) diff --git a/plugins/speedupcdma.c b/plugins/speedupcdma.c index b7e54a1..88f68f5 100644 --- a/plugins/speedupcdma.c +++ b/plugins/speedupcdma.c @@ -23,7 +23,6 @@ #include <config.h> #endif -#include <stdio.h> #include <errno.h> #include <stdlib.h> @@ -38,12 +37,12 @@ #include <ofono/cdma-connman.h> #include <ofono/log.h> -#include <drivers/atmodem/atutil.h> - static const char *none_prefix[] = { NULL }; struct speedupcdma_data { - GAtChat *chat; + GAtChat *modem; + GAtChat *aux; + struct ofono_cdma_connman *cm; }; static void speedupcdma_debug(const char *str, void *data) @@ -87,8 +86,12 @@ static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data) DBG(""); if (!ok) { - g_at_chat_unref(data->chat); - data->chat = NULL; + g_at_chat_unref(data->modem); + data->modem = NULL; + + + g_at_chat_unref(data->aux); + data->aux = NULL; ofono_modem_set_powered(modem, FALSE); return; @@ -97,39 +100,98 @@ static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data) ofono_modem_set_powered(modem, TRUE); } -static int speedupcdma_enable(struct ofono_modem *modem) +static GAtChat *create_port(const char *device) { - struct speedupcdma_data *data = ofono_modem_get_data(modem); GAtSyntax *syntax; GIOChannel *channel; - const char *modem_path; - - modem_path = ofono_modem_get_string(modem, "Modem"); - if (modem_path == NULL) - return -EINVAL; - - DBG("path is: %s", modem_path); + GAtChat *chat; - channel = g_at_tty_open(modem_path, NULL); + channel = g_at_tty_open(device, NULL); if (channel == NULL) - return -EIO; + return NULL; syntax = g_at_syntax_new_gsm_permissive(); - data->chat = g_at_chat_new(channel, syntax); + chat = g_at_chat_new(channel, syntax); g_at_syntax_unref(syntax); - g_io_channel_unref(channel); - if (data->chat == NULL) - return -ENOMEM; + if (chat == NULL) + return NULL; + + return chat; +} + +static GAtChat *open_device(struct ofono_modem *modem, + const char *key, char *debug) +{ + const char *device; + GAtChat *chat; + + device = ofono_modem_get_string(modem, key); + if (device == NULL) + return NULL; + + DBG("%s %s", key, device); + + chat = create_port(device); + if (chat == NULL) + return NULL; + + g_at_chat_add_terminator(chat, "COMMAND NOT SUPPORT", -1, FALSE); if (getenv("OFONO_AT_DEBUG")) - g_at_chat_set_debug(data->chat, speedupcdma_debug, "Modem: "); + g_at_chat_set_debug(chat, speedupcdma_debug, debug); + + return chat; +} + +static void speedupcdma_disconnect(gpointer user_data) +{ + struct ofono_modem *modem = user_data; + struct speedupcdma_data *data = ofono_modem_get_data(modem); + + DBG(""); + + ofono_cdma_connman_remove(data->cm); + + g_at_chat_unref(data->modem); + data->modem = NULL; + + data->modem = open_device(modem, "Modem", "Modem: "); + if (data->modem == NULL) + return; + + g_at_chat_set_disconnect_function(data->modem, + speedupcdma_disconnect, modem); + + data->cm = ofono_cdma_connman_create(modem, 0, "cdmamodem", + data->modem); +} + +static int speedupcdma_enable(struct ofono_modem *modem) +{ + struct speedupcdma_data *data = ofono_modem_get_data(modem); + + DBG(""); + + data->modem = open_device(modem, "Modem", "Modem: "); + if (data->modem == NULL) + return -EINVAL; + + g_at_chat_set_disconnect_function(data->modem, + speedupcdma_disconnect, modem); - g_at_chat_send(data->chat, "ATE0 +CMEE=1", none_prefix, + data->aux = open_device(modem, "Aux", "Aux: "); + if (data->aux == NULL) { + g_at_chat_unref(data->modem); + data->modem = NULL; + return -EIO; + } + + g_at_chat_send(data->aux, "ATE0 +CMEE=1", none_prefix, NULL, NULL, NULL); - g_at_chat_send(data->chat, "AT+CFUN=1", none_prefix, + g_at_chat_send(data->aux, "AT+CFUN=1", none_prefix, cfun_enable, modem, NULL); return -EINPROGRESS; @@ -142,8 +204,8 @@ static void cfun_disable(gboolean ok, GAtResult *result, gpointer user_data) DBG(""); - g_at_chat_unref(data->chat); - data->chat = NULL; + g_at_chat_unref(data->aux); + data->aux = NULL; if (ok) ofono_modem_set_powered(modem, FALSE); @@ -155,7 +217,19 @@ static int speedupcdma_disable(struct ofono_modem *modem) DBG("%p", modem); - g_at_chat_send(data->chat, "AT+CFUN=0", none_prefix, + if (data->modem) { + g_at_chat_cancel_all(data->modem); + g_at_chat_unregister_all(data->modem); + g_at_chat_unref(data->modem); + data->modem = NULL; + } + + if (data->aux == NULL) + return 0; + + g_at_chat_cancel_all(data->aux); + g_at_chat_unregister_all(data->aux); + g_at_chat_send(data->aux, "AT+CFUN=0", none_prefix, cfun_disable, modem, NULL); return -EINPROGRESS; @@ -167,7 +241,7 @@ static void speedupcdma_pre_sim(struct ofono_modem *modem) DBG("%p", modem); - ofono_devinfo_create(modem, 0, "cdmamodem", data->chat); + ofono_devinfo_create(modem, 0, "cdmamodem", data->aux); } static void speedupcdma_post_sim(struct ofono_modem *modem) @@ -181,7 +255,8 @@ static void speedupcdma_post_online(struct ofono_modem *modem) DBG("%p", modem); - ofono_cdma_connman_create(modem, 0, "cdmamodem", data->chat); + data->cm = ofono_cdma_connman_create(modem, 0, "cdmamodem", + data->modem); } static struct ofono_modem_driver speedupcdma_driver = { @@ -207,4 +282,4 @@ static void speedupcdma_exit(void) OFONO_PLUGIN_DEFINE(speedupcdma, "Speed Up CDMA modem driver", VERSION, OFONO_PLUGIN_PRIORITY_DEFAULT, - speedupcdma_init, speedupcdma_exit) + speedupcdma_init, speedupcdma_exit) \ No newline at end of file -- 1.7.4.1 --------------------------------------------------------------------- Intel Corporation SAS (French simplified joint stock company) Registered headquarters: "Les Montalets"- 2, rue de Paris, 92196 Meudon Cedex, France Registration Number: 302 456 199 R.C.S. NANTERRE Capital: 4,572,000 Euros This e-mail and any attachments may contain confidential material for the sole use of the intended recipient(s). Any review or distribution by others is strictly prohibited. If you are not the intended recipient, please contact the sender and delete all copies.