1 /*- 2 * Copyright (c) 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 /* 31 * Local interrupt controller driver for Tegra SoCs. 32 */ 33 #include <sys/param.h> 34 #include <sys/module.h> 35 #include <sys/systm.h> 36 #include <sys/bus.h> 37 #include <sys/conf.h> 38 #include <sys/kernel.h> 39 #include <sys/rman.h> 40 41 #include <machine/fdt.h> 42 #include <machine/intr.h> 43 #include <machine/resource.h> 44 45 #include <dev/ofw/ofw_bus.h> 46 #include <dev/ofw/ofw_bus_subr.h> 47 48 #include "pic_if.h" 49 50 #define LIC_VIRQ_CPU 0x00 51 #define LIC_VIRQ_COP 0x04 52 #define LIC_VFRQ_CPU 0x08 53 #define LIC_VFRQ_COP 0x0c 54 #define LIC_ISR 0x10 55 #define LIC_FIR 0x14 56 #define LIC_FIR_SET 0x18 57 #define LIC_FIR_CLR 0x1c 58 #define LIC_CPU_IER 0x20 59 #define LIC_CPU_IER_SET 0x24 60 #define LIC_CPU_IER_CLR 0x28 61 #define LIC_CPU_IEP_CLASS 0x2C 62 #define LIC_COP_IER 0x30 63 #define LIC_COP_IER_SET 0x34 64 #define LIC_COP_IER_CLR 0x38 65 #define LIC_COP_IEP_CLASS 0x3c 66 67 #define WR4(_sc, _b, _r, _v) bus_write_4((_sc)->mem_res[_b], (_r), (_v)) 68 #define RD4(_sc, _b, _r) bus_read_4((_sc)->mem_res[_b], (_r)) 69 70 static struct resource_spec lic_spec[] = { 71 { SYS_RES_MEMORY, 0, RF_ACTIVE }, 72 { SYS_RES_MEMORY, 1, RF_ACTIVE }, 73 { SYS_RES_MEMORY, 2, RF_ACTIVE }, 74 { SYS_RES_MEMORY, 3, RF_ACTIVE }, 75 { SYS_RES_MEMORY, 4, RF_ACTIVE }, 76 { -1, 0 } 77 }; 78 79 static struct ofw_compat_data compat_data[] = { 80 {"nvidia,tegra124-ictlr", 1}, 81 {NULL, 0} 82 }; 83 84 struct tegra_lic_sc { 85 device_t dev; 86 struct resource *mem_res[nitems(lic_spec)]; 87 device_t parent; 88 }; 89 90 static int 91 tegra_lic_alloc_intr(device_t dev, struct intr_irqsrc *isrc, 92 struct resource *res, struct intr_map_data *data) 93 { 94 struct tegra_lic_sc *sc = device_get_softc(dev); 95 96 return (PIC_ALLOC_INTR(sc->parent, isrc, res, data)); 97 } 98 99 static void 100 tegra_lic_disable_intr(device_t dev, struct intr_irqsrc *isrc) 101 { 102 struct tegra_lic_sc *sc = device_get_softc(dev); 103 104 PIC_DISABLE_INTR(sc->parent, isrc); 105 } 106 107 static void 108 tegra_lic_enable_intr(device_t dev, struct intr_irqsrc *isrc) 109 { 110 struct tegra_lic_sc *sc = device_get_softc(dev); 111 112 PIC_ENABLE_INTR(sc->parent, isrc); 113 } 114 115 static int 116 tegra_lic_map_intr(device_t dev, struct intr_map_data *data, 117 struct intr_irqsrc **isrcp) 118 { 119 struct tegra_lic_sc *sc = device_get_softc(dev); 120 121 return (PIC_MAP_INTR(sc->parent, data, isrcp)); 122 } 123 124 static int 125 tegra_lic_release_intr(device_t dev, struct intr_irqsrc *isrc, 126 struct resource *res, struct intr_map_data *data) 127 { 128 struct tegra_lic_sc *sc = device_get_softc(dev); 129 130 return (PIC_RELEASE_INTR(sc->parent, isrc, res, data)); 131 } 132 133 static int 134 tegra_lic_setup_intr(device_t dev, struct intr_irqsrc *isrc, 135 struct resource *res, struct intr_map_data *data) 136 { 137 struct tegra_lic_sc *sc = device_get_softc(dev); 138 139 return (PIC_SETUP_INTR(sc->parent, isrc, res, data)); 140 } 141 142 static int 143 tegra_lic_teardown_intr(device_t dev, struct intr_irqsrc *isrc, 144 struct resource *res, struct intr_map_data *data) 145 { 146 struct tegra_lic_sc *sc = device_get_softc(dev); 147 148 return (PIC_TEARDOWN_INTR(sc->parent, isrc, res, data)); 149 } 150 151 static void 152 tegra_lic_pre_ithread(device_t dev, struct intr_irqsrc *isrc) 153 { 154 struct tegra_lic_sc *sc = device_get_softc(dev); 155 156 PIC_PRE_ITHREAD(sc->parent, isrc); 157 } 158 159 160 static void 161 tegra_lic_post_ithread(device_t dev, struct intr_irqsrc *isrc) 162 { 163 struct tegra_lic_sc *sc = device_get_softc(dev); 164 165 PIC_POST_ITHREAD(sc->parent, isrc); 166 } 167 168 static void 169 tegra_lic_post_filter(device_t dev, struct intr_irqsrc *isrc) 170 { 171 struct tegra_lic_sc *sc = device_get_softc(dev); 172 173 PIC_POST_FILTER(sc->parent, isrc); 174 } 175 176 #ifdef SMP 177 static int 178 tegra_lic_bind_intr(device_t dev, struct intr_irqsrc *isrc) 179 { 180 struct tegra_lic_sc *sc = device_get_softc(dev); 181 182 return (PIC_BIND_INTR(sc->parent, isrc)); 183 } 184 #endif 185 186 static int 187 tegra_lic_probe(device_t dev) 188 { 189 if (!ofw_bus_status_okay(dev)) 190 return (ENXIO); 191 192 if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0) 193 return (ENXIO); 194 195 return (BUS_PROBE_DEFAULT); 196 } 197 198 static int 199 tegra_lic_attach(device_t dev) 200 { 201 struct tegra_lic_sc *sc; 202 phandle_t node; 203 phandle_t parent_xref; 204 int i, rv; 205 206 sc = device_get_softc(dev); 207 sc->dev = dev; 208 node = ofw_bus_get_node(dev); 209 210 rv = OF_getencprop(node, "interrupt-parent", &parent_xref, 211 sizeof(parent_xref)); 212 if (rv <= 0) { 213 device_printf(dev, "Cannot read parent node property\n"); 214 goto fail; 215 } 216 sc->parent = OF_device_from_xref(parent_xref); 217 if (sc->parent == NULL) { 218 device_printf(dev, "Cannott find parent controller\n"); 219 goto fail; 220 } 221 222 if (bus_alloc_resources(dev, lic_spec, sc->mem_res)) { 223 device_printf(dev, "Cannott allocate resources\n"); 224 goto fail; 225 } 226 227 /* Disable all interrupts, route all to irq */ 228 for (i = 0; i < nitems(lic_spec); i++) { 229 if (sc->mem_res[i] == NULL) 230 continue; 231 WR4(sc, i, LIC_CPU_IER_CLR, 0xFFFFFFFF); 232 WR4(sc, i, LIC_CPU_IEP_CLASS, 0); 233 } 234 235 236 if (intr_pic_register(dev, OF_xref_from_node(node)) == NULL) { 237 device_printf(dev, "Cannot register PIC\n"); 238 goto fail; 239 } 240 return (0); 241 242 fail: 243 bus_release_resources(dev, lic_spec, sc->mem_res); 244 return (ENXIO); 245 } 246 247 static int 248 tegra_lic_detach(device_t dev) 249 { 250 struct tegra_lic_sc *sc; 251 int i; 252 253 sc = device_get_softc(dev); 254 for (i = 0; i < nitems(lic_spec); i++) { 255 if (sc->mem_res[i] == NULL) 256 continue; 257 bus_release_resource(dev, SYS_RES_MEMORY, i, 258 sc->mem_res[i]); 259 } 260 return (0); 261 } 262 263 static device_method_t tegra_lic_methods[] = { 264 DEVMETHOD(device_probe, tegra_lic_probe), 265 DEVMETHOD(device_attach, tegra_lic_attach), 266 DEVMETHOD(device_detach, tegra_lic_detach), 267 268 /* Interrupt controller interface */ 269 DEVMETHOD(pic_alloc_intr, tegra_lic_alloc_intr), 270 DEVMETHOD(pic_disable_intr, tegra_lic_disable_intr), 271 DEVMETHOD(pic_enable_intr, tegra_lic_enable_intr), 272 DEVMETHOD(pic_map_intr, tegra_lic_map_intr), 273 DEVMETHOD(pic_release_intr, tegra_lic_release_intr), 274 DEVMETHOD(pic_setup_intr, tegra_lic_setup_intr), 275 DEVMETHOD(pic_teardown_intr, tegra_lic_teardown_intr), 276 DEVMETHOD(pic_pre_ithread, tegra_lic_pre_ithread), 277 DEVMETHOD(pic_post_ithread, tegra_lic_post_ithread), 278 DEVMETHOD(pic_post_filter, tegra_lic_post_filter), 279 #ifdef SMP 280 DEVMETHOD(pic_bind_intr, tegra_lic_bind_intr), 281 #endif 282 DEVMETHOD_END 283 }; 284 devclass_t tegra_lic_devclass; 285 DEFINE_CLASS_0(tegra_lic, tegra_lic_driver, tegra_lic_methods, 286 sizeof(struct tegra_lic_sc)); 287 EARLY_DRIVER_MODULE(tegra_lic, simplebus, tegra_lic_driver, tegra_lic_devclass, 288 NULL, NULL, BUS_PASS_INTERRUPT + BUS_PASS_ORDER_MIDDLE + 1); 289