linux-imx

/*

 * Industry-pack bus support functions.

 *

 * Copyright (C) 2011-2012 CERN (www.cern.ch)

 * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com>

 *

 * 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; version 2 of the License.

 */

​

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/idr.h>

#include <linux/io.h>

#include <linux/ipack.h>

​

#define to_ipack_dev(device) container_of(device, struct ipack_device, dev)

#define to_ipack_driver(drv) container_of(drv, struct ipack_driver, driver)

​

static DEFINE_IDA(ipack_ida);

​

static void ipack_device_release(struct device *dev)

{

    struct ipack_device *device = to_ipack_dev(dev);

    kfree(device->id);

    device->release(device);

}

​

static inline const struct ipack_device_id *

ipack_match_one_device(const struct ipack_device_id *id,

               const struct ipack_device *device)

{

    if ((id->format == IPACK_ANY_FORMAT ||

                id->format == device->id_format) &&

        (id->vendor == IPACK_ANY_ID || id->vendor == device->id_vendor) &&

        (id->device == IPACK_ANY_ID || id->device == device->id_device))

        return id;

    return NULL;

}

​

static const struct ipack_device_id *

ipack_match_id(const struct ipack_device_id *ids, struct ipack_device *idev)

{

    if (ids) {

        while (ids->vendor || ids->device) {

            if (ipack_match_one_device(ids, idev))

                return ids;

            ids++;

        }

    }

    return NULL;

}

​

static int ipack_bus_match(struct device *dev, struct device_driver *drv)

{

    struct ipack_device *idev = to_ipack_dev(dev);

    struct ipack_driver *idrv = to_ipack_driver(drv);

    const struct ipack_device_id *found_id;

​

    found_id = ipack_match_id(idrv->id_table, idev);

    return found_id ? 1 : 0;

}

​

static int ipack_bus_probe(struct device *device)

{

    struct ipack_device *dev = to_ipack_dev(device);

    struct ipack_driver *drv = to_ipack_driver(device->driver);

​

    if (!drv->ops->probe)

        return -EINVAL;

​

    return drv->ops->probe(dev);

}

​

static int ipack_bus_remove(struct device *device)

{

    struct ipack_device *dev = to_ipack_dev(device);

    struct ipack_driver *drv = to_ipack_driver(device->driver);

​

    if (!drv->ops->remove)

        return -EINVAL;

​

    drv->ops->remove(dev);

    return 0;

}

​

static int ipack_uevent(struct device *dev, struct kobj_uevent_env *env)

{

    struct ipack_device *idev;

​

    if (!dev)