at91_aic.c revision 302408 
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 271398 2014-09-10 15:25:15Z andrew $");
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
180EARLY_DRIVER_MODULE(at91_aic, simplebus, at91_aic_driver, at91_aic_devclass,
181    NULL, NULL, BUS_PASS_INTERRUPT);
182#else
183EARLY_DRIVER_MODULE(at91_aic, atmelarm, at91_aic_driver, at91_aic_devclass,
184    NULL, NULL, BUS_PASS_INTERRUPT);
185#endif
186