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/device.h>
  16 #include <linux/of_device.h>
  17 #include <linux/of_platform.h>
  18
  19 static int of_platform_bus_match(struct device *dev, struct device_driver *drv)
  20 {
  21         struct of_device *of_dev = to_of_device(dev);
  22         struct of_platform_driver *of_drv = to_of_platform_driver(drv);
  23         const struct of_device_id *matches = of_drv->match_table;
  24
  25         if (!matches)
  26                 return 0;
  27
  28         return of_match_device(matches, of_dev) != NULL;
  29 }
  30
  31 static int of_platform_device_probe(struct device *dev)
  32 {
  33         int error = -ENODEV;
  34         struct of_platform_driver *drv;
  35         struct of_device *of_dev;
  36         const struct of_device_id *match;
  37
  38         drv = to_of_platform_driver(dev->driver);
  39         of_dev = to_of_device(dev);
  40
  41         if (!drv->probe)
  42                 return error;
  43
  44         of_dev_get(of_dev);
  45
  46         match = of_match_device(drv->match_table, of_dev);
  47         if (match)
  48                 error = drv->probe(of_dev, match);
  49         if (error)
  50                 of_dev_put(of_dev);
  51
  52         return error;
  53 }
  54
  55 static int of_platform_device_remove(struct device *dev)
  56 {
  57         struct of_device *of_dev = to_of_device(dev);
  58         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  59
  60         if (dev->driver && drv->remove)
  61                 drv->remove(of_dev);
  62         return 0;
  63 }
  64
  65 static int of_platform_device_suspend(struct device *dev, pm_message_t state)
  66 {
  67         struct of_device *of_dev = to_of_device(dev);
  68         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  69         int error = 0;
  70
  71         if (dev->driver && drv->suspend)
  72                 error = drv->suspend(of_dev, state);
  73         return error;
  74 }
  75
  76 static int of_platform_device_resume(struct device * dev)
  77 {
  78         struct of_device *of_dev = to_of_device(dev);
  79         struct of_platform_driver *drv = to_of_platform_driver(dev->driver);
  80         int error = 0;
  81
  82         if (dev->driver && drv->resume)
  83                 error = drv->resume(of_dev);
  84         return error;
  85 }
  86
  87 int of_bus_type_init(struct bus_type *bus, const char *name)
  88 {
  89         bus->name = name;
  90         bus->match = of_platform_bus_match;
  91         bus->probe = of_platform_device_probe;
  92         bus->remove = of_platform_device_remove;
  93         bus->suspend = of_platform_device_suspend;
  94         bus->resume = of_platform_device_resume;
  95         return bus_register(bus);
  96 }