at91_aic.c revision 278613
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/10/sys/arm/at91/at91_aic.c 278613 2015-02-12 03:50:33Z ian $"); 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/cpu.h> 42#include <machine/cpufunc.h> 43#include <machine/frame.h> 44#include <machine/intr.h> 45#include <machine/resource.h> 46 47#include <arm/at91/at91var.h> 48#include <arm/at91/at91_aicreg.h> 49 50#ifdef FDT 51#include <dev/fdt/fdt_common.h> 52#include <dev/ofw/ofw_bus.h> 53#include <dev/ofw/ofw_bus_subr.h> 54#endif 55 56static struct aic_softc { 57 struct resource *mem_res; /* Memory resource */ 58 void *intrhand; /* Interrupt handle */ 59 device_t sc_dev; 60} *sc; 61 62static inline uint32_t 63RD4(struct aic_softc *sc, bus_size_t off) 64{ 65 66 return (bus_read_4(sc->mem_res, off)); 67} 68 69static inline void 70WR4(struct aic_softc *sc, bus_size_t off, uint32_t val) 71{ 72 73 bus_write_4(sc->mem_res, off, val); 74} 75 76void 77arm_mask_irq(uintptr_t nb) 78{ 79 80 WR4(sc, IC_IDCR, 1 << nb); 81} 82 83int 84arm_get_next_irq(int last __unused) 85{ 86 int status; 87 int irq; 88 89 irq = RD4(sc, IC_IVR); 90 status = RD4(sc, IC_ISR); 91 if (status == 0) { 92 WR4(sc, IC_EOICR, 1); 93 return (-1); 94 } 95 return (irq); 96} 97 98void 99arm_unmask_irq(uintptr_t nb) 100{ 101 102 WR4(sc, IC_IECR, 1 << nb); 103 WR4(sc, IC_EOICR, 0); 104} 105 106static int 107at91_aic_probe(device_t dev) 108{ 109#ifdef FDT 110 if (!ofw_bus_is_compatible(dev, "atmel,at91rm9200-aic")) 111 return (ENXIO); 112#endif 113 device_set_desc(dev, "AIC"); 114 return (0); 115} 116 117static int 118at91_aic_attach(device_t dev) 119{ 120 int i, rid, err = 0; 121 122 device_printf(dev, "Attach %d\n", bus_current_pass); 123 124 sc = device_get_softc(dev); 125 sc->sc_dev = dev; 126 127 rid = 0; 128 sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, 129 RF_ACTIVE); 130 131 if (sc->mem_res == NULL) 132 panic("couldn't allocate register resources"); 133 134 /* 135 * Setup the interrupt table. 136 */ 137 if (soc_info.soc_data == NULL || soc_info.soc_data->soc_irq_prio == NULL) 138 panic("Interrupt priority table missing\n"); 139 for (i = 0; i < 32; i++) { 140 WR4(sc, IC_SVR + i * 4, i); 141 /* Priority. */ 142 WR4(sc, IC_SMR + i * 4, soc_info.soc_data->soc_irq_prio[i]); 143 if (i < 8) 144 WR4(sc, IC_EOICR, 1); 145 } 146 147 WR4(sc, IC_SPU, 32); 148 /* No debug. */ 149 WR4(sc, IC_DCR, 0); 150 /* Disable and clear all interrupts. */ 151 WR4(sc, IC_IDCR, 0xffffffff); 152 WR4(sc, IC_ICCR, 0xffffffff); 153 enable_interrupts(PSR_I | PSR_F); 154 155 return (err); 156} 157 158static void 159at91_aic_new_pass(device_t dev) 160{ 161 device_printf(dev, "Pass %d\n", bus_current_pass); 162} 163 164static device_method_t at91_aic_methods[] = { 165 DEVMETHOD(device_probe, at91_aic_probe), 166 DEVMETHOD(device_attach, at91_aic_attach), 167 DEVMETHOD(bus_new_pass, at91_aic_new_pass), 168 DEVMETHOD_END 169}; 170 171static driver_t at91_aic_driver = { 172 "at91_aic", 173 at91_aic_methods, 174 sizeof(struct aic_softc), 175}; 176 177static devclass_t at91_aic_devclass; 178 179#ifdef FDT 180DRIVER_MODULE(at91_aic, simplebus, at91_aic_driver, at91_aic_devclass, NULL, 181 NULL); 182#else 183DRIVER_MODULE(at91_aic, atmelarm, at91_aic_driver, at91_aic_devclass, NULL, 184 NULL); 185#endif 186/* not yet 187EARLY_DRIVER_MODULE(at91_aic, simplebus, at91_aic_driver, at91_aic_devclass, 188 NULL, NULL, BUS_PASS_INTERRUPT); 189*/ 190