sys/dev/extres/regulator/regulator_bus.c

   1 /*-
   2  * Copyright 2016 Michal Meloun <mmel@FreeBSD.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/systm.h>
  32 #include <sys/kernel.h>
  33 #include <sys/module.h>
  34 #include <sys/bus.h>
  35
  36 #include <dev/fdt/simplebus.h>
  37
  38 #include <dev/ofw/openfirm.h>
  39 #include <dev/ofw/ofw_bus_subr.h>
  40
  41 struct ofw_regulator_bus_softc {
  42         struct simplebus_softc simplebus_sc;
  43 };
  44
  45 static int
  46 ofw_regulator_bus_probe(device_t dev)
  47 {
  48         const char      *name;
  49
  50         name = ofw_bus_get_name(dev);
  51         if (name == NULL || strcmp(name, "regulators") != 0)
  52                 return (ENXIO);
  53         device_set_desc(dev, "OFW regulators bus");
  54
  55         return (0);
  56 }
  57
  58 static int
  59 ofw_regulator_bus_attach(device_t dev)
  60 {
  61         phandle_t node, child;
  62
  63         node  = ofw_bus_get_node(dev);
  64         simplebus_init(dev, node);
  65
  66         for (child = OF_child(node); child > 0; child = OF_peer(child)) {
  67                 simplebus_add_device(dev, child, 0, NULL, -1, NULL);
  68         }
  69
  70         return (bus_generic_attach(dev));
  71 }
  72
  73 static device_method_t ofw_regulator_bus_methods[] = {
  74         /* Device interface */
  75         DEVMETHOD(device_probe,         ofw_regulator_bus_probe),
  76         DEVMETHOD(device_attach,        ofw_regulator_bus_attach),
  77
  78         DEVMETHOD_END
  79 };
  80
  81 DEFINE_CLASS_1(ofw_regulator_bus, ofw_regulator_bus_driver,
  82     ofw_regulator_bus_methods, sizeof(struct ofw_regulator_bus_softc),
  83     simplebus_driver);
  84 static devclass_t ofw_regulator_bus_devclass;
  85 EARLY_DRIVER_MODULE(ofw_regulator_bus, simplebus, ofw_regulator_bus_driver,
  86     ofw_regulator_bus_devclass, 0, 0, BUS_PASS_BUS + BUS_PASS_ORDER_MIDDLE);
  87 MODULE_VERSION(ofw_regulator_bus, 1);