dio-driver.c

Go to the documentation of this file.

/*
 *  DIO Driver Services
 *
 *  Copyright (C) 2004 Jochen Friedrich
 *
 *  Loosely based on drivers/pci/pci-driver.c and drivers/zorro/zorro-driver.c
 *
 *  This file is subject to the terms and conditions of the GNU General Public
 *  License.  See the file COPYING in the main directory of this archive
 *  for more details.
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/dio.h>


const struct dio_device_id *
dio_match_device(const struct dio_device_id *ids,
           const struct dio_dev *d)
{
    while (ids->id) {
        if (ids->id == DIO_WILDCARD)
            return ids;
        if (DIO_NEEDSSECID(ids->id & 0xff)) {
            if (ids->id == d->id)
                return ids;
        } else {
            if ((ids->id & 0xff) == (d->id & 0xff))
                return ids;
        }
        ids++;
    }
    return NULL;
}

static int dio_device_probe(struct device *dev)
{
    int error = 0;
    struct dio_driver *drv = to_dio_driver(dev->driver);
    struct dio_dev *d = to_dio_dev(dev);

    if (!d->driver && drv->probe) {
        const struct dio_device_id *id;

        id = dio_match_device(drv->id_table, d);
        if (id)
            error = drv->probe(d, id);
        if (error >= 0) {
            d->driver = drv;
            error = 0;
        }
    }
    return error;
}


int dio_register_driver(struct dio_driver *drv)
{
    /* initialize common driver fields */
    drv->driver.name = drv->name;
    drv->driver.bus = &dio_bus_type;

    /* register with core */
    return driver_register(&drv->driver);
}


void dio_unregister_driver(struct dio_driver *drv)
{
    driver_unregister(&drv->driver);
}


static int dio_bus_match(struct device *dev, struct device_driver *drv)
{
    struct dio_dev *d = to_dio_dev(dev);
    struct dio_driver *dio_drv = to_dio_driver(drv);
    const struct dio_device_id *ids = dio_drv->id_table;

    if (!ids)
        return 0;

    return dio_match_device(ids, d) ? 1 : 0;
}


struct bus_type dio_bus_type = {
    .name   = "dio",
    .match  = dio_bus_match,
    .probe  = dio_device_probe,
};


static int __init dio_driver_init(void)
{
    return bus_register(&dio_bus_type);
}

postcore_initcall(dio_driver_init);

EXPORT_SYMBOL(dio_match_device);
EXPORT_SYMBOL(dio_register_driver);
EXPORT_SYMBOL(dio_unregister_driver);
EXPORT_SYMBOL(dio_bus_type);