1262925Simp/*- 2262925Simp * Copyright (c) 2014 Warner Losh. All rights reserved. 3262925Simp * 4262925Simp * Redistribution and use in source and binary forms, with or without 5262925Simp * modification, are permitted provided that the following conditions 6262925Simp * are met: 7262925Simp * 1. Redistributions of source code must retain the above copyright 8262925Simp * notice, this list of conditions and the following disclaimer. 9262925Simp * 2. Redistributions in binary form must reproduce the above copyright 10262925Simp * notice, this list of conditions and the following disclaimer in the 11262925Simp * documentation and/or other materials provided with the distribution. 12262925Simp * 13262925Simp * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14262925Simp * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15262925Simp * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16262925Simp * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE 17262925Simp * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18262925Simp * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19262925Simp * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20262925Simp * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21262925Simp * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22262925Simp * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23262925Simp * SUCH DAMAGE. 24262925Simp */ 25262925Simp 26262925Simp#include "opt_platform.h" 27262925Simp 28262925Simp#include <sys/cdefs.h> 29262925Simp__FBSDID("$FreeBSD: releng/11.0/sys/arm/at91/at91_aic.c 271398 2014-09-10 15:25:15Z andrew $"); 30262925Simp 31262925Simp#include <sys/param.h> 32262925Simp#include <sys/bus.h> 33262925Simp#include <sys/kernel.h> 34262925Simp#include <sys/module.h> 35262925Simp#include <sys/resource.h> 36262925Simp#include <sys/systm.h> 37262925Simp#include <sys/rman.h> 38262925Simp 39271398Sandrew#include <machine/armreg.h> 40262925Simp#include <machine/bus.h> 41262925Simp#include <machine/cpu.h> 42262925Simp#include <machine/cpufunc.h> 43262925Simp#include <machine/frame.h> 44262925Simp#include <machine/intr.h> 45262925Simp#include <machine/resource.h> 46262925Simp 47262925Simp#include <arm/at91/at91var.h> 48262925Simp#include <arm/at91/at91_aicreg.h> 49262925Simp 50262925Simp#ifdef FDT 51262925Simp#include <dev/fdt/fdt_common.h> 52262925Simp#include <dev/ofw/ofw_bus.h> 53262925Simp#include <dev/ofw/ofw_bus_subr.h> 54262925Simp#endif 55262925Simp 56262925Simpstatic struct aic_softc { 57262925Simp struct resource *mem_res; /* Memory resource */ 58262925Simp void *intrhand; /* Interrupt handle */ 59262925Simp device_t sc_dev; 60262925Simp} *sc; 61262925Simp 62262925Simpstatic inline uint32_t 63262925SimpRD4(struct aic_softc *sc, bus_size_t off) 64262925Simp{ 65262925Simp 66262925Simp return (bus_read_4(sc->mem_res, off)); 67262925Simp} 68262925Simp 69262925Simpstatic inline void 70262925SimpWR4(struct aic_softc *sc, bus_size_t off, uint32_t val) 71262925Simp{ 72262925Simp 73262925Simp bus_write_4(sc->mem_res, off, val); 74262925Simp} 75262925Simp 76262925Simpvoid 77262925Simparm_mask_irq(uintptr_t nb) 78262925Simp{ 79262925Simp 80262925Simp WR4(sc, IC_IDCR, 1 << nb); 81262925Simp} 82262925Simp 83262925Simpint 84262925Simparm_get_next_irq(int last __unused) 85262925Simp{ 86262925Simp int status; 87262925Simp int irq; 88262925Simp 89262925Simp irq = RD4(sc, IC_IVR); 90262925Simp status = RD4(sc, IC_ISR); 91262925Simp if (status == 0) { 92262925Simp WR4(sc, IC_EOICR, 1); 93262925Simp return (-1); 94262925Simp } 95262925Simp return (irq); 96262925Simp} 97262925Simp 98262925Simpvoid 99262925Simparm_unmask_irq(uintptr_t nb) 100262925Simp{ 101262925Simp 102262925Simp WR4(sc, IC_IECR, 1 << nb); 103262925Simp WR4(sc, IC_EOICR, 0); 104262925Simp} 105262925Simp 106262925Simpstatic int 107262925Simpat91_aic_probe(device_t dev) 108262925Simp{ 109262925Simp#ifdef FDT 110262925Simp if (!ofw_bus_is_compatible(dev, "atmel,at91rm9200-aic")) 111262925Simp return (ENXIO); 112262925Simp#endif 113262925Simp device_set_desc(dev, "AIC"); 114262925Simp return (0); 115262925Simp} 116262925Simp 117262925Simpstatic int 118262925Simpat91_aic_attach(device_t dev) 119262925Simp{ 120262925Simp int i, rid, err = 0; 121262925Simp 122262925Simp device_printf(dev, "Attach %d\n", bus_current_pass); 123262925Simp 124262925Simp sc = device_get_softc(dev); 125262925Simp sc->sc_dev = dev; 126262925Simp 127262925Simp rid = 0; 128262925Simp sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, 129262925Simp RF_ACTIVE); 130262925Simp 131262925Simp if (sc->mem_res == NULL) 132262925Simp panic("couldn't allocate register resources"); 133262925Simp 134262925Simp /* 135262925Simp * Setup the interrupt table. 136262925Simp */ 137262925Simp if (soc_info.soc_data == NULL || soc_info.soc_data->soc_irq_prio == NULL) 138262925Simp panic("Interrupt priority table missing\n"); 139262925Simp for (i = 0; i < 32; i++) { 140262925Simp WR4(sc, IC_SVR + i * 4, i); 141262925Simp /* Priority. */ 142262925Simp WR4(sc, IC_SMR + i * 4, soc_info.soc_data->soc_irq_prio[i]); 143262925Simp if (i < 8) 144262925Simp WR4(sc, IC_EOICR, 1); 145262925Simp } 146262925Simp 147262925Simp WR4(sc, IC_SPU, 32); 148262925Simp /* No debug. */ 149262925Simp WR4(sc, IC_DCR, 0); 150262925Simp /* Disable and clear all interrupts. */ 151262925Simp WR4(sc, IC_IDCR, 0xffffffff); 152262925Simp WR4(sc, IC_ICCR, 0xffffffff); 153271398Sandrew enable_interrupts(PSR_I | PSR_F); 154262925Simp 155262925Simp return (err); 156262925Simp} 157262925Simp 158262925Simpstatic void 159262925Simpat91_aic_new_pass(device_t dev) 160262925Simp{ 161262925Simp device_printf(dev, "Pass %d\n", bus_current_pass); 162262925Simp} 163262925Simp 164262925Simpstatic device_method_t at91_aic_methods[] = { 165262925Simp DEVMETHOD(device_probe, at91_aic_probe), 166262925Simp DEVMETHOD(device_attach, at91_aic_attach), 167262925Simp DEVMETHOD(bus_new_pass, at91_aic_new_pass), 168262925Simp DEVMETHOD_END 169262925Simp}; 170262925Simp 171262925Simpstatic driver_t at91_aic_driver = { 172262925Simp "at91_aic", 173262925Simp at91_aic_methods, 174262925Simp sizeof(struct aic_softc), 175262925Simp}; 176262925Simp 177262925Simpstatic devclass_t at91_aic_devclass; 178262925Simp 179262925Simp#ifdef FDT 180269959SimpEARLY_DRIVER_MODULE(at91_aic, simplebus, at91_aic_driver, at91_aic_devclass, 181269959Simp NULL, NULL, BUS_PASS_INTERRUPT); 182262925Simp#else 183269959SimpEARLY_DRIVER_MODULE(at91_aic, atmelarm, at91_aic_driver, at91_aic_devclass, 184269959Simp NULL, NULL, BUS_PASS_INTERRUPT); 185262925Simp#endif 186