svn commit: r305527 - in head/sys/mips: include mips
Stanislav Galabov
sgalabov at FreeBSD.org
Wed Sep 7 09:31:12 UTC 2016
Author: sgalabov
Date: Wed Sep 7 09:31:10 2016
New Revision: 305527
URL: https://svnweb.freebsd.org/changeset/base/305527
Log:
Fix MIPS INTRNG (both FDT and non-FDT) behaviour broken by r304459
More changes to MIPS may be required, as commented in D7692, but this
revision aims to restore MIPS INTRNG functionality so we can move on
with working interrupts.
Reported by: yamori813 at yahoo.co.jp
Tested by: mizhka (on BCM), sgalabov (on Mediatek)
Reviewed by: adrian, nwhitehorn (older version)
Sponsored by: Smartcom - Bulgaria AD
Differential Revision: https://reviews.freebsd.org/D7692
Modified:
head/sys/mips/include/intr.h
head/sys/mips/mips/mips_pic.c
head/sys/mips/mips/nexus.c
Modified: head/sys/mips/include/intr.h
==============================================================================
--- head/sys/mips/include/intr.h Wed Sep 7 09:20:58 2016 (r305526)
+++ head/sys/mips/include/intr.h Wed Sep 7 09:31:10 2016 (r305527)
@@ -63,6 +63,8 @@ void cpu_establish_hardintr(const char *
void *, int, int, void **);
void cpu_establish_softintr(const char *, driver_filter_t *, void (*)(void*),
void *, int, int, void **);
+int cpu_create_intr_map(int);
+struct resource *cpu_get_irq_resource(int);
/* MIPS interrupt C entry point */
void cpu_intr(struct trapframe *);
Modified: head/sys/mips/mips/mips_pic.c
==============================================================================
--- head/sys/mips/mips/mips_pic.c Wed Sep 7 09:20:58 2016 (r305526)
+++ head/sys/mips/mips/mips_pic.c Wed Sep 7 09:31:10 2016 (r305527)
@@ -71,6 +71,11 @@ __FBSDID("$FreeBSD$");
static int mips_pic_intr(void *);
+struct intr_map_data_mips_pic {
+ struct intr_map_data hdr;
+ u_int irq;
+};
+
struct mips_pic_irqsrc {
struct intr_irqsrc isrc;
struct resource *res;
@@ -304,24 +309,37 @@ static int
mips_pic_map_intr(device_t dev, struct intr_map_data *data,
struct intr_irqsrc **isrcp)
{
-#ifdef FDT
- struct intr_map_data_fdt *daf;
struct mips_pic_softc *sc;
-
- if (data->type != INTR_MAP_DATA_FDT)
- return (ENOTSUP);
+ int res;
sc = device_get_softc(dev);
- daf = (struct intr_map_data_fdt *)data;
+ res = 0;
+#ifdef FDT
+ if (data->type == INTR_MAP_DATA_FDT) {
+ struct intr_map_data_fdt *daf;
- if (daf->ncells != 1 || daf->cells[0] >= sc->nirqs)
- return (EINVAL);
+ daf = (struct intr_map_data_fdt *)data;
- *isrcp = PIC_INTR_ISRC(sc, daf->cells[0]);
- return (0);
-#else
- return (ENOTSUP);
+ if (daf->ncells != 1 || daf->cells[0] >= sc->nirqs)
+ return (EINVAL);
+
+ *isrcp = PIC_INTR_ISRC(sc, daf->cells[0]);
+ } else
#endif
+ if (data->type == INTR_MAP_DATA_PLAT_1) {
+ struct intr_map_data_mips_pic *mpd;
+
+ mpd = (struct intr_map_data_mips_pic *)data;
+
+ if (mpd->irq < 0 || mpd->irq >= sc->nirqs)
+ return (EINVAL);
+
+ *isrcp = PIC_INTR_ISRC(sc, mpd->irq);
+ } else {
+ res = ENOTSUP;
+ }
+
+ return (res);
}
static void
@@ -383,6 +401,46 @@ cpu_init_interrupts(void)
{
}
+int
+cpu_create_intr_map(int irq)
+{
+ struct intr_map_data_mips_pic *mips_pic_data;
+ intptr_t iparent;
+ size_t len;
+ u_int new_irq;
+
+ len = sizeof(*mips_pic_data);
+ iparent = pic_xref(pic_sc->pic_dev);
+
+ /* Allocate mips_pic data and fill it in */
+ mips_pic_data = (struct intr_map_data_mips_pic *)intr_alloc_map_data(
+ INTR_MAP_DATA_PLAT_1, len, M_WAITOK | M_ZERO);
+ mips_pic_data->irq = irq;
+
+ /* Get the new irq number */
+ new_irq = intr_map_irq(pic_sc->pic_dev, iparent,
+ (struct intr_map_data *)mips_pic_data);
+
+ /* Adjust the resource accordingly */
+ rman_set_start(pic_sc->pic_irqs[irq].res, new_irq);
+ rman_set_end(pic_sc->pic_irqs[irq].res, new_irq);
+
+ /* Activate the new irq */
+ return (intr_activate_irq(pic_sc->pic_dev, pic_sc->pic_irqs[irq].res));
+}
+
+struct resource *
+cpu_get_irq_resource(int irq)
+{
+
+ KASSERT(pic_sc != NULL, ("%s: no pic", __func__));
+
+ if (irq < 0 || irq >= pic_sc->nirqs)
+ panic("%s called for unknown irq %d", __func__, irq);
+
+ return pic_sc->pic_irqs[irq].res;
+}
+
void
cpu_establish_hardintr(const char *name, driver_filter_t *filt,
void (*handler)(void*), void *arg, int irq, int flags, void **cookiep)
@@ -398,6 +456,10 @@ cpu_establish_hardintr(const char *name,
KASSERT(pic_sc != NULL, ("%s: no pic", __func__));
irq += NSOFT_IRQS;
+
+ res = cpu_create_intr_map(irq);
+ if (res != 0) panic("Unable to create map for hard IRQ %d", irq);
+
res = intr_setup_irq(pic_sc->pic_dev, pic_sc->pic_irqs[irq].res, filt,
handler, arg, flags, cookiep);
if (res != 0) panic("Unable to add hard IRQ %d handler", irq);
@@ -415,6 +477,9 @@ cpu_establish_softintr(const char *name,
KASSERT(pic_sc != NULL, ("%s: no pic", __func__));
+ res = cpu_create_intr_map(irq);
+ if (res != 0) panic("Unable to create map for soft IRQ %d", irq);
+
res = intr_setup_irq(pic_sc->pic_dev, pic_sc->pic_irqs[irq].res, filt,
handler, arg, flags, cookiep);
if (res != 0) panic("Unable to add soft IRQ %d handler", irq);
Modified: head/sys/mips/mips/nexus.c
==============================================================================
--- head/sys/mips/mips/nexus.c Wed Sep 7 09:20:58 2016 (r305526)
+++ head/sys/mips/mips/nexus.c Wed Sep 7 09:31:10 2016 (r305527)
@@ -432,7 +432,16 @@ nexus_activate_resource(device_t bus, de
rman_set_bushandle(r, (bus_space_handle_t)(uintptr_t)vaddr);
} else if (type == SYS_RES_IRQ) {
#ifdef INTRNG
+#ifdef FDT
intr_activate_irq(child, r);
+#else
+ /*
+ * INTRNG without FDT needs to have the interrupt properly
+ * mapped first. cpu_create_intr_map() will do that and
+ * call intr_activate_irq() at the end.
+ */
+ cpu_create_intr_map(rman_get_start(r));
+#endif
#endif
}
@@ -466,9 +475,13 @@ static int
nexus_setup_intr(device_t dev, device_t child, struct resource *res, int flags,
driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep)
{
-
#ifdef INTRNG
- return (intr_setup_irq(child, res, filt, intr, arg, flags, cookiep));
+ struct resource *r = res;
+
+#ifndef FDT
+ r = cpu_get_irq_resource(rman_get_start(r));
+#endif
+ return (intr_setup_irq(child, r, filt, intr, arg, flags, cookiep));
#else
int irq;
register_t s;
More information about the svn-src-all
mailing list