]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/riscv/riscv/soc.c
riscv: Trap cleanup - use nitems()
[FreeBSD/FreeBSD.git] / sys / riscv / riscv / soc.c
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2018 Ruslan Bukin <br@bsdpad.com>
5  * All rights reserved.
6  *
7  * This software was developed by SRI International and the University of
8  * Cambridge Computer Laboratory under DARPA/AFRL contract FA8750-10-C-0237
9  * ("CTSRD"), as part of the DARPA CRASH research programme.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30  * SUCH DAMAGE.
31  */
32
33 #include <sys/cdefs.h>
34 __FBSDID("$FreeBSD$");
35
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h>
39 #include <sys/module.h>
40
41 #include <dev/fdt/simplebus.h>
42 #include <dev/ofw/ofw_bus_subr.h>
43
44 struct soc_softc {
45         struct simplebus_softc  simplebus_sc;
46         device_t                dev;
47 };
48
49 static int
50 soc_probe(device_t dev)
51 {
52
53         if (!ofw_bus_status_okay(dev))
54                 return (ENXIO);
55
56         if (!ofw_bus_is_compatible(dev, "riscv-virtio-soc"))
57                 return (ENXIO);
58
59         device_set_desc(dev, "RISC-V SoC");
60
61         return (BUS_PROBE_DEFAULT);
62 }
63
64 static int
65 soc_attach(device_t dev)
66 {
67         struct soc_softc *sc;
68         phandle_t node;
69
70         sc = device_get_softc(dev);
71         sc->dev = dev;
72
73         node = ofw_bus_get_node(dev);
74         if (node == -1)
75                 return (ENXIO);
76
77         simplebus_init(dev, node);
78
79         /*
80          * Allow devices to identify.
81          */
82         bus_generic_probe(dev);
83
84         /*
85          * Now walk the OFW tree and attach top-level devices.
86          */
87         for (node = OF_child(node); node > 0; node = OF_peer(node))
88                 simplebus_add_device(dev, node, 0, NULL, -1, NULL);
89
90         return (bus_generic_attach(dev));
91 }
92
93 static int
94 soc_detach(device_t dev)
95 {
96
97         return (0);
98 }
99
100 static device_method_t soc_methods[] = {
101         DEVMETHOD(device_probe,         soc_probe),
102         DEVMETHOD(device_attach,        soc_attach),
103         DEVMETHOD(device_detach,        soc_detach),
104         DEVMETHOD_END
105 };
106
107 DEFINE_CLASS_1(soc, soc_driver, soc_methods, sizeof(struct soc_softc),
108     simplebus_driver);
109 static devclass_t soc_devclass;
110 EARLY_DRIVER_MODULE(soc, simplebus, soc_driver, soc_devclass, 0, 0,
111     BUS_PASS_INTERRUPT + BUS_PASS_ORDER_MIDDLE);
112 MODULE_VERSION(soc, 1);