drivers/of/platform.c

   1 /*
   2  *    Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp.
   3  *                       <benh@kernel.crashing.org>
   4  *    and                Arnd Bergmann, IBM Corp.
   5  *    Merged from powerpc/kernel/of_platform.c and
   6  *    sparc{,64}/kernel/of_device.c by Stephen Rothwell
   7  *
   8  *  This program is free software; you can redistribute it and/or
   9  *  modify it under the terms of the GNU General Public License
  10  *  as published by the Free Software Foundation; either version
  11  *  2 of the License, or (at your option) any later version.
  12  *
  13  */
  14 #include <linux/errno.h>
  15 #include <linux/module.h>
  16 #include <linux/device.h>
  17 #include <linux/of_device.h>
  18 #include <linux/of_platform.h>
  19
  20 static int of_platform_bus_match(struct device *dev, struct device_driver *drv)
  21 {
  22         struct of_device *of_dev = to_of_device(dev);
  23         struct of_platform_driver *of_drv = to_of_platform_driver(drv);
  24         const struct of_device_id *matches = of_drv->match_table;
  25
  26         if (!matches)
  27                 return 0;
  28
  29         return of_match_device(matches, of_dev) != NULL;
  30 }
  31
  32 static int of_platform_device_probe(struct device *dev)
  33 {
  34         int error = -ENODEV;
  35         struct of_platform_driver *drv;
  36         struct of_device *of_dev;
  37         const struct of_device_id *match;
  38
  39         drv = to_of_platform_driver(dev->driver);
  40         of_dev = to_of_device(dev);
  41
  42         if (!drv->probe)
  43                 return error;
  44
  45         of_dev_get(of_dev);
  46
  47         match = of_match_device(drv->match_table, of_dev);
  48         if (match)
  49                 error = drv->probe(of_dev, match);
  50         if (error)
  51                 of_dev_put(of_dev);
  52
  53         return error;
  54 }
  55
  56 static int of_platform_device_remove(struct device *dev)
  57 {
  58         struct of_device *of_dev = to_of_device(dev);
  59         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  60
  61         if (dev->driver && drv->remove)
  62                 drv->remove(of_dev);
  63         return 0;
  64 }
  65
  66 static int of_platform_device_suspend(struct device *dev, pm_message_t state)
  67 {
  68         struct of_device *of_dev = to_of_device(dev);
  69         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  70         int error = 0;
  71
  72         if (dev->driver && drv->suspend)
  73                 error = drv->suspend(of_dev, state);
  74         return error;
  75 }
  76
  77 static int of_platform_device_resume(struct device * dev)
  78 {
  79         struct of_device *of_dev = to_of_device(dev);
  80         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  81         int error = 0;
  82
  83         if (dev->driver && drv->resume)
  84                 error = drv->resume(of_dev);
  85         return error;
  86 }
  87
  88 int of_bus_type_init(struct bus_type *bus, const char *name)
  89 {
  90         bus->name = name;
  91         bus->match = of_platform_bus_match;
  92         bus->probe = of_platform_device_probe;
  93         bus->remove = of_platform_device_remove;
  94         bus->suspend = of_platform_device_suspend;
  95         bus->resume = of_platform_device_resume;
  96         return bus_register(bus);
  97 }
  98
  99 int of_register_driver(struct of_platform_driver *drv, struct bus_type *bus)
 100 {
 101         /* initialize common driver fields */
 102         if (!drv->driver.name)
 103                 drv->driver.name = drv->name;
 104         if (!drv->driver.owner)
 105                 drv->driver.owner = drv->owner;
 106         drv->driver.bus = bus;
 107
 108         /* register with core */
 109         return driver_register(&drv->driver);
 110 }
 111 EXPORT_SYMBOL(of_register_driver);
 112
 113 void of_unregister_driver(struct of_platform_driver *drv)
 114 {
 115         driver_unregister(&drv->driver);
 116 }
 117 EXPORT_SYMBOL(of_unregister_driver);