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