1/*- 2 * Copyright (c) 2014 Warner Losh. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 1. Redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer. 9 * 2. Redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution. 12 * 13 * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16 * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE 17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23 * SUCH DAMAGE. 24 */ 25 26#include "opt_platform.h" 27 28#include <sys/cdefs.h> 29__FBSDID("$FreeBSD: stable/11/sys/arm/at91/at91_aic.c 308325 2016-11-05 04:30:44Z mmel $"); 30 31#include <sys/param.h> 32#include <sys/bus.h> 33#include <sys/kernel.h> 34#include <sys/module.h> 35#include <sys/resource.h> 36#include <sys/systm.h> 37#include <sys/rman.h> 38 39#include <machine/armreg.h> 40#include <machine/bus.h> 41#include <machine/frame.h> 42#include <machine/intr.h> 43#include <machine/resource.h> 44 45#include <arm/at91/at91var.h> 46#include <arm/at91/at91_aicreg.h> 47 48#ifdef FDT 49#include <dev/fdt/fdt_common.h> 50#include <dev/ofw/ofw_bus.h> 51#include <dev/ofw/ofw_bus_subr.h> 52#endif 53 54static struct aic_softc { 55 struct resource *mem_res; /* Memory resource */ 56 void *intrhand; /* Interrupt handle */ 57 device_t sc_dev; 58} *sc; 59 60static inline uint32_t 61RD4(struct aic_softc *sc, bus_size_t off) 62{ 63 64 return (bus_read_4(sc->mem_res, off)); 65} 66 67static inline void 68WR4(struct aic_softc *sc, bus_size_t off, uint32_t val) 69{ 70 71 bus_write_4(sc->mem_res, off, val); 72} 73 74void 75arm_mask_irq(uintptr_t nb) 76{ 77 78 WR4(sc, IC_IDCR, 1 << nb); 79} 80 81int 82arm_get_next_irq(int last __unused) 83{ 84 int status; 85 int irq; 86 87 irq = RD4(sc, IC_IVR); 88 status = RD4(sc, IC_ISR); 89 if (status == 0) { 90 WR4(sc, IC_EOICR, 1); 91 return (-1); 92 } 93 return (irq); 94} 95 96void 97arm_unmask_irq(uintptr_t nb) 98{ 99 100 WR4(sc, IC_IECR, 1 << nb); 101 WR4(sc, IC_EOICR, 0); 102} 103 104static int 105at91_aic_probe(device_t dev) 106{ 107#ifdef FDT 108 if (!ofw_bus_is_compatible(dev, "atmel,at91rm9200-aic")) 109 return (ENXIO); 110#endif 111 device_set_desc(dev, "AIC"); 112 return (0); 113} 114 115static int 116at91_aic_attach(device_t dev) 117{ 118 int i, rid, err = 0; 119 120 device_printf(dev, "Attach %d\n", bus_current_pass); 121 122 sc = device_get_softc(dev); 123 sc->sc_dev = dev; 124 125 rid = 0; 126 sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, 127 RF_ACTIVE); 128 129 if (sc->mem_res == NULL) 130 panic("couldn't allocate register resources"); 131 132 /* 133 * Setup the interrupt table. 134 */ 135 if (soc_info.soc_data == NULL || soc_info.soc_data->soc_irq_prio == NULL) 136 panic("Interrupt priority table missing\n"); 137 for (i = 0; i < 32; i++) { 138 WR4(sc, IC_SVR + i * 4, i); 139 /* Priority. */ 140 WR4(sc, IC_SMR + i * 4, soc_info.soc_data->soc_irq_prio[i]); 141 if (i < 8) 142 WR4(sc, IC_EOICR, 1); 143 } 144 145 WR4(sc, IC_SPU, 32); 146 /* No debug. */ 147 WR4(sc, IC_DCR, 0); 148 /* Disable and clear all interrupts. */ 149 WR4(sc, IC_IDCR, 0xffffffff); 150 WR4(sc, IC_ICCR, 0xffffffff); 151 enable_interrupts(PSR_I | PSR_F); 152 153 return (err); 154} 155 156static void 157at91_aic_new_pass(device_t dev) 158{ 159 device_printf(dev, "Pass %d\n", bus_current_pass); 160} 161 162static device_method_t at91_aic_methods[] = { 163 DEVMETHOD(device_probe, at91_aic_probe), 164 DEVMETHOD(device_attach, at91_aic_attach), 165 DEVMETHOD(bus_new_pass, at91_aic_new_pass), 166 DEVMETHOD_END 167}; 168 169static driver_t at91_aic_driver = { 170 "at91_aic", 171 at91_aic_methods, 172 sizeof(struct aic_softc), 173}; 174 175static devclass_t at91_aic_devclass; 176 177#ifdef FDT 178EARLY_DRIVER_MODULE(at91_aic, simplebus, at91_aic_driver, at91_aic_devclass, 179 NULL, NULL, BUS_PASS_INTERRUPT); 180#else 181EARLY_DRIVER_MODULE(at91_aic, atmelarm, at91_aic_driver, at91_aic_devclass, 182 NULL, NULL, BUS_PASS_INTERRUPT); 183#endif 184