d/freebsd-nq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fix MIPS INTRNG (both FDT and non-FDT) behaviour broken by r304459

Browse Source 
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@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
This commit is contained in:
Stanislav Galabov 2016-09-07 09:31:10 +00:00
parent b67f3d2873
commit 2b99b9f3d2
3 changed files with 94 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
sys/mips/include/intr.h
View File

@ -63,6 +63,8 @@ void cpu_establish_hardintr(const char *, driver_filter_t *, driver_intr_t *,
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 *);

89
sys/mips/mips/mips_pic.c
View File

@ -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, driver_filter_t *filt,
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, driver_filter_t *filt,
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);

17
sys/mips/mips/nexus.c
View File

@ -432,7 +432,16 @@ nexus_activate_resource(device_t bus, device_t child, int type, int rid,
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;