LXR linux/arch/arm/mach-integrator/lm.c

   1/*
   2 *  linux/arch/arm/mach-integrator/lm.c
   3 *
   4 *  Copyright (C) 2003 Deep Blue Solutions Ltd, All Rights Reserved.
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License version 2 as
   8 * published by the Free Software Foundation.
   9 */
  10#include <linux/module.h>
  11#include <linux/init.h>
  12#include <linux/device.h>
  13
  14#include <asm/arch/lm.h>
  15
  16#define to_lm_device(d) container_of(d, struct lm_device, dev)
  17#define to_lm_driver(d) container_of(d, struct lm_driver, drv)
  18
  19static int lm_match(struct device *dev, struct device_driver *drv)
  20{
  21        return 1;
  22}
  23
  24static struct bus_type lm_bustype = {
  25        .name           = "logicmodule",
  26        .match          = lm_match,
  27//      .suspend        = lm_suspend,
  28//      .resume         = lm_resume,
  29};
  30
  31static int __init lm_init(void)
  32{
  33        return bus_register(&lm_bustype);
  34}
  35
  36postcore_initcall(lm_init);
  37
  38static int lm_bus_probe(struct device *dev)
  39{
  40        struct lm_device *lmdev = to_lm_device(dev);
  41        struct lm_driver *lmdrv = to_lm_driver(dev->driver);
  42
  43        return lmdrv->probe(lmdev);
  44}
  45
  46static int lm_bus_remove(struct device *dev)
  47{
  48        struct lm_device *lmdev = to_lm_device(dev);
  49        struct lm_driver *lmdrv = to_lm_driver(dev->driver);
  50
  51        lmdrv->remove(lmdev);
  52        return 0;
  53}
  54
  55int lm_driver_register(struct lm_driver *drv)
  56{
  57        drv->drv.bus = &lm_bustype;
  58        drv->drv.probe = lm_bus_probe;
  59        drv->drv.remove = lm_bus_remove;
  60
  61        return driver_register(&drv->drv);
  62}
  63
  64void lm_driver_unregister(struct lm_driver *drv)
  65{
  66        driver_unregister(&drv->drv);
  67}
  68
  69static void lm_device_release(struct device *dev)
  70{
  71        struct lm_device *d = to_lm_device(dev);
  72
  73        kfree(d);
  74}
  75
  76int lm_device_register(struct lm_device *dev)
  77{
  78        int ret;
  79
  80        dev->dev.release = lm_device_release;
  81        dev->dev.bus = &lm_bustype;
  82
  83        snprintf(dev->dev.bus_id, sizeof(dev->dev.bus_id), "lm%d", dev->id);
  84        dev->resource.name = dev->dev.bus_id;
  85
  86        ret = request_resource(&iomem_resource, &dev->resource);
  87        if (ret == 0) {
  88                ret = device_register(&dev->dev);
  89                if (ret)
  90                        release_resource(&dev->resource);
  91        }
  92        return ret;
  93}
  94
  95EXPORT_SYMBOL(lm_driver_register);
  96EXPORT_SYMBOL(lm_driver_unregister);
  97