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/param.h>
28 #include <sys/systm.h>
29 #include <sys/kernel.h>
30 #include <sys/module.h>
31 #include <sys/bus.h>
32
33 #include <dev/fdt/simplebus.h>
34
35 #include <dev/ofw/openfirm.h>
36 #include <dev/ofw/ofw_bus_subr.h>
37
38 struct ofw_clkbus_softc {
39 struct simplebus_softc simplebus_sc;
40 };
41
42 static int
ofw_clkbus_probe(device_t dev)43 ofw_clkbus_probe(device_t dev)
44 {
45 const char *name;
46
47 name = ofw_bus_get_name(dev);
48
49 if (name == NULL || strcmp(name, "clocks") != 0)
50 return (ENXIO);
51
52 device_set_desc(dev, "OFW clocks bus");
53
54 return (BUS_PROBE_GENERIC);
55 }
56
57 static int
ofw_clkbus_attach(device_t dev)58 ofw_clkbus_attach(device_t dev)
59 {
60 phandle_t node, child;
61 device_t cdev;
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 cdev = simplebus_add_device(dev, child, 0, NULL, -1, NULL);
68 if (cdev != NULL)
69 device_probe_and_attach(cdev);
70 }
71
72 bus_attach_children(dev);
73 return (0);
74 }
75
76 static device_method_t ofw_clkbus_methods[] = {
77 /* Device interface */
78 DEVMETHOD(device_probe, ofw_clkbus_probe),
79 DEVMETHOD(device_attach, ofw_clkbus_attach),
80
81 DEVMETHOD_END
82 };
83
84 DEFINE_CLASS_1(ofw_clkbus, ofw_clkbus_driver, ofw_clkbus_methods,
85 sizeof(struct ofw_clkbus_softc), simplebus_driver);
86 EARLY_DRIVER_MODULE(ofw_clkbus, simplebus, ofw_clkbus_driver, 0, 0,
87 BUS_PASS_BUS + BUS_PASS_ORDER_MIDDLE);
88 MODULE_VERSION(ofw_clkbus, 1);
89