[PATCH 2/3] udev: Handle Linktop data card

--- plugins/udev.c | 32 ++++++++++++++++++++++++++++++++ 1 files changed, 32 insertions(+), 0 deletions(-) diff --git a/plugins/udev.c b/plugins/udev.c index ce1efe6..84478d7 100644 --- a/plugins/udev.c +++ b/plugins/udev.c @@ -552,6 +552,36 @@ static void add_nokiacdma(struct ofono_modem *modem, ofono_modem_register(modem); } +static void add_linktop(struct ofono_modem *modem, + struct udev_device *udev_device) +{ + const char *devnode, *intfnum; + struct udev_device *parent; + int registered; + + DBG("modem %p", modem); + + registered = ofono_modem_get_integer(modem, "Registered"); + if (registered != 0) + return; + + parent = udev_device_get_parent(udev_device); + intfnum = udev_device_get_sysattr_value(parent, "bInterfaceNumber"); + + DBG("intfnum %s", intfnum); + + if (g_strcmp0(intfnum, "01") == 0) { + devnode = udev_device_get_devnode(udev_device); + ofono_modem_set_string(modem, "Modem", devnode); + } else if (g_strcmp0(intfnum, "03") == 0) { + devnode = udev_device_get_devnode(udev_device); + ofono_modem_set_string(modem, "Control", 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; @@ -646,6 +676,8 @@ done: add_tc65(modem, udev_device); else if (g_strcmp0(driver, "nokiacdma") == 0) add_nokiacdma(modem, udev_device); + else if (g_strcmp0(driver, "linktop") == 0) + add_linktop(modem, udev_device); } static gboolean devpath_remove(gpointer key, gpointer value, gpointer user_data) -- 1.7.1