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