From bdad83d831405c2153aaa24378f04ec2d8f60606 Mon Sep 17 00:00:00 2001 From: Marcel Holtmann Date: Thu, 3 Sep 2009 00:22:06 -0700 Subject: [PATCH] Add basic support for Huawei based devices --- Makefile.am | 7 +- plugins/huawei.c | 174 ++++++++++++++++++++++++++++++++++++++++++++ plugins/ofono.rules | 3 + plugins/udev.c | 38 ++++++++-- 4 files changed, 215 insertions(+), 7 deletions(-) create mode 100644 plugins/huawei.c diff --git a/Makefile.am b/Makefile.am index 0ff8335e..c068cbdd 100644 --- a/Makefile.am +++ b/Makefile.am @@ -108,11 +108,14 @@ endif builtin_modules += phonesim builtin_sources += plugins/phonesim.c +builtin_modules += g1 +builtin_sources += plugins/g1.c + builtin_modules += mbm builtin_sources += plugins/mbm.c -builtin_modules += g1 -builtin_sources += plugins/g1.c +builtin_modules += huawei +builtin_sources += plugins/huawei.c endif if MAINTAINER_MODE diff --git a/plugins/huawei.c b/plugins/huawei.c new file mode 100644 index 00000000..d9d1497f --- /dev/null +++ b/plugins/huawei.c @@ -0,0 +1,174 @@ +/* + * + * oFono - Open Source Telephony + * + * Copyright (C) 2008-2009 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 +#endif + +#include +#include +#include + +#include +#include + +#define OFONO_API_SUBJECT_TO_CHANGE +#include +#include +#include +#include +#include +#include + +struct huawei_data { + GAtChat *chat; +}; + +static int huawei_probe(struct ofono_modem *modem) +{ + struct huawei_data *data; + + DBG("%p", modem); + + data = g_try_new0(struct huawei_data, 1); + if (!data) + return -ENOMEM; + + ofono_modem_set_data(modem, data); + + return 0; +} + +static void huawei_remove(struct ofono_modem *modem) +{ + struct huawei_data *data = ofono_modem_get_data(modem); + + DBG("%p", modem); + + ofono_modem_set_data(modem, NULL); + + g_free(data); +} + +static void huawei_debug(const char *str, void *user_data) +{ + ofono_info("%s", str); +} + +static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data) +{ + struct ofono_modem *modem = user_data; + + DBG(""); + + if (ok) + ofono_modem_set_powered(modem, TRUE); +} + +static int huawei_enable(struct ofono_modem *modem) +{ + struct huawei_data *data = ofono_modem_get_data(modem); + GAtSyntax *syntax; + const char *device; + + DBG("%p", modem); + + device = ofono_modem_get_string(modem, "Device"); + if (!device) + return -EINVAL; + + syntax = g_at_syntax_new_gsmv1(); + data->chat = g_at_chat_new_from_tty(device, syntax); + g_at_syntax_unref(syntax); + + if (!data->chat) + return -EIO; + + if (getenv("OFONO_AT_DEBUG")) + g_at_chat_set_debug(data->chat, huawei_debug, NULL); + + g_at_chat_send(data->chat, "AT+CFUN=1", NULL, + cfun_enable, modem, NULL); + + return 0; +} + +static void cfun_disable(gboolean ok, GAtResult *result, gpointer user_data) +{ + struct ofono_modem *modem = user_data; + + DBG(""); + + if (ok) + ofono_modem_set_powered(modem, FALSE); +} + +static int huawei_disable(struct ofono_modem *modem) +{ + struct huawei_data *data = ofono_modem_get_data(modem); + + DBG("%p", modem); + + if (!data->chat) + return 0; + + g_at_chat_send(data->chat, "AT+CFUN=0", NULL, + cfun_disable, modem, NULL); + + g_at_chat_shutdown(data->chat); + + g_at_chat_unref(data->chat); + data->chat = NULL; + + return 0; +} + +static void huawei_populate(struct ofono_modem *modem) +{ + struct huawei_data *data = ofono_modem_get_data(modem); + + DBG("%p", modem); + + ofono_devinfo_create(modem, 0, "atmodem", data->chat); + ofono_netreg_create(modem, 0, "atmodem", data->chat); +} + +static struct ofono_modem_driver huawei_driver = { + .name = "huawei", + .probe = huawei_probe, + .remove = huawei_remove, + .enable = huawei_enable, + .disable = huawei_disable, + .populate = huawei_populate, +}; + +static int huawei_init(void) +{ + return ofono_modem_driver_register(&huawei_driver); +} + +static void huawei_exit(void) +{ + ofono_modem_driver_unregister(&huawei_driver); +} + +OFONO_PLUGIN_DEFINE(huawei, "HUAWEI Mobile modem driver", VERSION, + OFONO_PLUGIN_PRIORITY_DEFAULT, huawei_init, huawei_exit) diff --git a/plugins/ofono.rules b/plugins/ofono.rules index a446f0de..0105d044 100644 --- a/plugins/ofono.rules +++ b/plugins/ofono.rules @@ -4,6 +4,9 @@ ACTION!="add|change", GOTO="ofono_end" SUBSYSTEM!="usb", GOTO="ofono_end" ENV{DEVTYPE}!="usb_device", GOTO="ofono_end" +# HUAWEI Technology +ATTRS{idVendor}=="12d1", ENV{OFONO_DRIVER}="huawei" + # Ericsson F3507g ATTRS{idVendor}=="0bdb", ATTRS{idProduct}=="1900", ENV{OFONO_DRIVER}="mbm" ATTRS{idVendor}=="0bdb", ATTRS{idProduct}=="1902", ENV{OFONO_DRIVER}="mbm" diff --git a/plugins/udev.c b/plugins/udev.c index ca7a25ce..82421cca 100644 --- a/plugins/udev.c +++ b/plugins/udev.c @@ -91,7 +91,8 @@ static const char *get_driver(struct udev_device *udev_device) #define MBM_GPS_DEVICE "GPSDevice" #define MBM_NETWORK_INTERFACE "NetworkInterface" -static void add_mbm(struct ofono_modem *modem, struct udev_device *udev_device) +static void add_mbm(struct ofono_modem *modem, + struct udev_device *udev_device) { const char *description, *devnode; const char *device, *network; @@ -134,6 +135,23 @@ static void add_mbm(struct ofono_modem *modem, struct udev_device *udev_device) } } +static void add_huawei(struct ofono_modem *modem, + struct udev_device *udev_device) +{ + const char *devnode; + int registered; + + registered = ofono_modem_get_integer(modem, "Registered"); + if (registered != 0) + return; + + devnode = udev_device_get_devnode(udev_device); + ofono_modem_set_string(modem, "Device", devnode); + + ofono_modem_set_integer(modem, "Registered", 1); + ofono_modem_register(modem); +} + static void add_modem(struct udev_device *udev_device) { struct ofono_modem *modem; @@ -148,8 +166,12 @@ static void add_modem(struct udev_device *udev_device) if (driver == NULL) { parent = udev_device_get_parent(parent); driver = get_driver(parent); - if (driver == NULL) - return; + if (driver == NULL) { + parent = udev_device_get_parent(parent); + driver = get_driver(parent); + if (driver == NULL) + return; + } } devpath = udev_device_get_devpath(parent); @@ -170,6 +192,8 @@ static void add_modem(struct udev_device *udev_device) if (g_strcmp0(driver, "mbm") == 0) add_mbm(modem, udev_device); + else if (g_strcmp0(driver, "huawei") == 0) + add_huawei(modem, udev_device); } static void remove_modem(struct udev_device *udev_device) @@ -186,8 +210,12 @@ static void remove_modem(struct udev_device *udev_device) if (driver == NULL) { parent = udev_device_get_parent(parent); driver = get_driver(parent); - if (driver == NULL) - return; + if (driver == NULL) { + parent = udev_device_get_parent(parent); + driver = get_driver(parent); + if (driver == NULL) + return; + } } devpath = udev_device_get_devpath(parent);