sys/arm/at91/at91_aic.c

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