ModemManager/plugins/mm-plugin-moto-c.c

/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * 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:
 *
 * Copyright (C) 2008 - 2009 Novell, Inc.
 * Copyright (C) 2009 Red Hat, Inc.
 */

#include <string.h>
#include <gmodule.h>
#define G_UDEV_API_IS_SUBJECT_TO_CHANGE
#include <gudev/gudev.h>

#include "mm-plugin-moto-c.h"
#include "mm-modem-moto-c-gsm.h"

static void plugin_init (MMPlugin *plugin_class);

G_DEFINE_TYPE_EXTENDED (MMPluginMotoC, mm_plugin_moto_c, G_TYPE_OBJECT,
                        0, G_IMPLEMENT_INTERFACE (MM_TYPE_PLUGIN, plugin_init))

int mm_plugin_major_version = MM_PLUGIN_MAJOR_VERSION;
int mm_plugin_minor_version = MM_PLUGIN_MINOR_VERSION;

#define MM_PLUGIN_MOTO_C_GET_PRIVATE(o) (G_TYPE_INSTANCE_GET_PRIVATE ((o), MM_TYPE_PLUGIN_MOTO_C, MMPluginMotoCPrivate))

typedef struct {
    GUdevClient *client;
    GHashTable *modems;
} MMPluginMotoCPrivate;


G_MODULE_EXPORT MMPlugin *
mm_plugin_create (void)
{
    return MM_PLUGIN (g_object_new (MM_TYPE_PLUGIN_MOTO_C, NULL));
}

/*****************************************************************************/

static char *
get_driver_name (GUdevDevice *device)
{
    GUdevDevice *parent = NULL;
    const char *driver;
    char *ret;

    driver = g_udev_device_get_driver (device);
    if (!driver) {
        parent = g_udev_device_get_parent (device);
        if (parent)
            driver = g_udev_device_get_driver (parent);
    }

    if (driver)
        ret = g_strdup (driver);
    if (parent)
        g_object_unref (parent);

    return ret;
}

static GUdevDevice *
find_physical_device (GUdevDevice *child)
{
    GUdevDevice *iter, *old = NULL;
    const char *bus, *type;

    g_return_val_if_fail (child != NULL, NULL);

    bus = g_udev_device_get_property (child, "ID_BUS");
    if (!bus)
        return NULL;

    if (strcmp (bus, "usb"))
        return NULL;

    /* Walk the parents to find the 'usb_device' for this device. */
    iter = g_object_ref (child);
    while (iter) {
        type = g_udev_device_get_devtype (iter);
        if (type && !strcmp (type, "usb_device"))
            return iter;

        old = iter;
        iter = g_udev_device_get_parent (old);
        g_object_unref (old);
    }
    g_object_unref (child);

    return NULL;
}

#define PROP_GSM   "ID_MM_MODEM_GSM"

static guint32
supports_port (MMPlugin *plugin,
               const char *subsys,
               const char *name)
{
    MMPluginMotoCPrivate *priv = MM_PLUGIN_MOTO_C_GET_PRIVATE (plugin);
    GUdevDevice *device, *physdev = NULL;
    guint32 level = 0;
    const char *tmp;

    g_return_val_if_fail (plugin != NULL, 0);
    g_return_val_if_fail (MM_IS_PLUGIN (plugin), 0);
    g_return_val_if_fail (subsys != NULL, 0);
    g_return_val_if_fail (name != NULL, 0);

    /* Can't do anything with non-serial ports */
    if (strcmp (subsys, "tty"))
        return 0;

    device = g_udev_client_query_by_subsystem_and_name (priv->client, subsys, name);
    if (!device)
        return 0;

    tmp = g_udev_device_get_property (device, "ID_BUS");
    if (!tmp || strcmp (tmp, "usb"))
        goto out;

    tmp = g_udev_device_get_property (device, "ID_VENDOR_ID");
    if (!tmp || strcmp (tmp, "22b8"))
        goto out;

    tmp = g_udev_device_get_property (device, "ID_MODEL_ID");
    if (!tmp || strcmp (tmp, "3802"))
        goto out;

    if (!g_udev_device_get_property_as_boolean (device, PROP_GSM))
        goto out;

    physdev = find_physical_device (device);
    if (!physdev)
        goto out;
    g_object_unref (physdev);
    level = 10;

out:
    g_object_unref (device);
    return level;
}

typedef struct {
    char *key;
    gpointer modem;
} FindInfo;

static void
find_modem (gpointer key, gpointer data, gpointer user_data)
{
    FindInfo *info = user_data;

    if (!info->key && data == info->modem)
        info->key = g_strdup ((const char *) key);
}

static void
modem_destroyed (gpointer data, GObject *modem)
{
    MMPluginMotoC *self = MM_PLUGIN_MOTO_C (data);
    MMPluginMotoCPrivate *priv = MM_PLUGIN_MOTO_C_GET_PRIVATE (self);
    FindInfo info = { NULL, modem };

    g_hash_table_foreach (priv->modems, find_modem, &info);
    if (info.key)
        g_hash_table_remove (priv->modems, info.key);
    g_free (info.key);
}

static MMModem *
grab_port (MMPlugin *plugin,
           const char *subsys,
           const char *name,
           GError **error)
{
    MMPluginMotoC *self = MM_PLUGIN_MOTO_C (plugin);
    MMPluginMotoCPrivate *priv = MM_PLUGIN_MOTO_C_GET_PRIVATE (plugin);
    GUdevDevice *device = NULL, *physdev = NULL;
    const char *devfile, *sysfs_path;
    char *driver = NULL;
    MMModem *modem = NULL;

    g_return_val_if_fail (subsys != NULL, NULL);
    g_return_val_if_fail (name != NULL, NULL);

    /* Can't do anything with non-serial ports */
    if (strcmp (subsys, "tty"))
        return NULL;

    device = g_udev_client_query_by_subsystem_and_name (priv->client, subsys, name);
    if (!device) {
        g_set_error (error, 0, 0, "Could not get port's udev device.");
        return NULL;
    }

    if (!g_udev_device_get_property_as_boolean (device, PROP_GSM)) {
        g_set_error (error, 0, 0, "Modem unsupported (not GSM).");
        goto out;
    }

    physdev = find_physical_device (device);
    if (!physdev) {
        g_set_error (error, 0, 0, "Could not get ports's physical device.");
        goto out;
    }

    devfile = g_udev_device_get_device_file (device);
    if (!devfile) {
        g_set_error (error, 0, 0, "Could not get port's sysfs file.");
        goto out;
    }

    driver = get_driver_name (device);
    if (!driver) {
        g_set_error (error, 0, 0, "Could not get port's driver name.");
        goto out;
    }

    sysfs_path = g_udev_device_get_sysfs_path (physdev);
    if (!devfile) {
        g_set_error (error, 0, 0, "Could not get port's physical device sysfs path.");
        goto out;
    }

    modem = g_hash_table_lookup (priv->modems, sysfs_path);
    if (!modem) {
        modem = mm_modem_moto_c_gsm_new (sysfs_path,
                                         driver,
                                         mm_plugin_get_name (plugin));

        if (modem) {
            if (!mm_modem_grab_port (modem, subsys, name, error)) {
                g_object_unref (modem);
                modem = NULL;
            }
        }

        if (modem) {
            g_object_weak_ref (G_OBJECT (modem), modem_destroyed, self);
            g_hash_table_insert (priv->modems, g_strdup (sysfs_path), modem);
        }
    } else {
        if (!mm_modem_grab_port (modem, subsys, name, error))
            modem = NULL;
    }

out:
    g_free (driver);
    g_object_unref (device);
    g_object_unref (physdev);
    return modem;
}

static const char *
get_name (MMPlugin *plugin)
{
    return "MotoC";
}

/*****************************************************************************/

static void
plugin_init (MMPlugin *plugin_class)
{
    /* interface implementation */
    plugin_class->get_name = get_name;
    plugin_class->supports_port = supports_port;
    plugin_class->grab_port = grab_port;
}

static void
mm_plugin_moto_c_init (MMPluginMotoC *self)
{
    MMPluginMotoCPrivate *priv = MM_PLUGIN_MOTO_C_GET_PRIVATE (self);
    const char *subsys[2] = { "tty", NULL };

    priv->modems = g_hash_table_new_full (g_str_hash, g_str_equal, g_free, NULL);

    priv->client = g_udev_client_new (subsys);
}

static void
dispose (GObject *object)
{
    MMPluginMotoCPrivate *priv = MM_PLUGIN_MOTO_C_GET_PRIVATE (object);

    g_hash_table_destroy (priv->modems);
    g_object_unref (priv->client);
}

static void
mm_plugin_moto_c_class_init (MMPluginMotoCClass *klass)
{
    GObjectClass *object_class = G_OBJECT_CLASS (klass);

    g_type_class_add_private (object_class, sizeof (MMPluginMotoCPrivate));

    object_class->dispose = dispose;
}