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

Add interrupt describing and binding to CIU.

Browse Source
This commit is contained in:
Juli Mallett 2010-12-01 05:24:29 +00:00
parent b172e30376
commit 648260edcc
1 changed files with 115 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

116
sys/mips/cavium/ciu.c
View File

@ -37,6 +37,7 @@ __FBSDID("$FreeBSD$");
#include <sys/module.h>
#include <sys/rman.h>
#include <sys/malloc.h>
#include <sys/smp.h>
#include <machine/bus.h>
#include <machine/intr_machdep.h>
@ -80,13 +81,24 @@ static int ciu_setup_intr(device_t, device_t, struct resource *,
void *, void **);
static int ciu_teardown_intr(device_t, device_t,
struct resource *, void *);
static int ciu_bind_intr(device_t, device_t, struct resource *,
int);
static int ciu_describe_intr(device_t, device_t,
struct resource *, void *,
const char *);
static void ciu_hinted_child(device_t, const char *, int);
static void ciu_en0_intr_mask(void *);
static void ciu_en0_intr_unmask(void *);
#ifdef SMP
static int ciu_en0_intr_bind(void *, u_char);
#endif
static void ciu_en1_intr_mask(void *);
static void ciu_en1_intr_unmask(void *);
#ifdef SMP
static int ciu_en1_intr_bind(void *, u_char);
#endif
static int ciu_intr(void *);
@ -196,6 +208,7 @@ ciu_setup_intr(device_t bus, device_t child, struct resource *res, int flags,
struct intr_event *event, **eventp;
void (*mask_func)(void *);
void (*unmask_func)(void *);
int (*bind_func)(void *, u_char);
mips_intrcnt_t intrcnt;
int error;
int irq;
@ -206,16 +219,25 @@ ciu_setup_intr(device_t bus, device_t child, struct resource *res, int flags,
intrcnt = ciu_en0_intrcnt[irq - CIU_IRQ_EN0_BEGIN];
mask_func = ciu_en0_intr_mask;
unmask_func = ciu_en0_intr_unmask;
#ifdef SMP
bind_func = ciu_en0_intr_bind;
#endif
} else {
eventp = &ciu_en1_intr_events[irq - CIU_IRQ_EN1_BEGIN];
intrcnt = ciu_en1_intrcnt[irq - CIU_IRQ_EN1_BEGIN];
mask_func = ciu_en1_intr_mask;
unmask_func = ciu_en1_intr_unmask;
#ifdef SMP
bind_func = ciu_en1_intr_bind;
#endif
}
#if !defined(SMP)
bind_func = NULL;
#endif
if ((event = *eventp) == NULL) {
error = intr_event_create(eventp, (void *)(uintptr_t)irq, 0,
irq, mask_func, unmask_func, NULL, NULL, "int%d", irq);
irq, mask_func, unmask_func, NULL, bind_func, "int%d", irq);
if (error != 0)
return (error);
@ -245,6 +267,50 @@ ciu_teardown_intr(device_t bus, device_t child, struct resource *res,
return (0);
}
#ifdef SMP
static int
ciu_bind_intr(device_t bus, device_t child, struct resource *res, int cpu)
{
struct intr_event *event;
int irq;
irq = rman_get_start(res);
if (irq <= CIU_IRQ_EN0_END)
event = ciu_en0_intr_events[irq - CIU_IRQ_EN0_BEGIN];
else
event = ciu_en1_intr_events[irq - CIU_IRQ_EN1_BEGIN];
return (intr_event_bind(event, cpu));
}
#endif
static int
ciu_describe_intr(device_t bus, device_t child, struct resource *res,
void *cookie, const char *descr)
{
struct intr_event *event;
mips_intrcnt_t intrcnt;
int error;
int irq;
irq = rman_get_start(res);
if (irq <= CIU_IRQ_EN0_END) {
event = ciu_en0_intr_events[irq - CIU_IRQ_EN0_BEGIN];
intrcnt = ciu_en0_intrcnt[irq - CIU_IRQ_EN0_BEGIN];
} else {
event = ciu_en1_intr_events[irq - CIU_IRQ_EN1_BEGIN];
intrcnt = ciu_en1_intrcnt[irq - CIU_IRQ_EN1_BEGIN];
}
error = intr_event_describe_handler(event, cookie, descr);
if (error != 0)
return (error);
mips_intrcnt_setname(intrcnt, event->ie_fullname);
return (0);
}
static void
ciu_hinted_child(device_t bus, const char *dname, int dunit)
{
@ -275,6 +341,28 @@ ciu_en0_intr_unmask(void *arg)
cvmx_write_csr(CVMX_CIU_INTX_EN0(cvmx_get_core_num()*2), mask);
}
#ifdef SMP
static int
ciu_en0_intr_bind(void *arg, u_char target)
{
uint64_t mask;
int core;
int irq;
irq = (uintptr_t)arg;
CPU_FOREACH(core) {
mask = cvmx_read_csr(CVMX_CIU_INTX_EN0(core*2));
if (core == target)
mask |= 1ull << (irq - CIU_IRQ_EN0_BEGIN);
else
mask &= ~(1ull << (irq - CIU_IRQ_EN0_BEGIN));
cvmx_write_csr(CVMX_CIU_INTX_EN0(core*2), mask);
}
return (0);
}
#endif
static void
ciu_en1_intr_mask(void *arg)
{
@ -299,6 +387,28 @@ ciu_en1_intr_unmask(void *arg)
cvmx_write_csr(CVMX_CIU_INTX_EN1(cvmx_get_core_num()*2), mask);
}
#ifdef SMP
static int
ciu_en1_intr_bind(void *arg, u_char target)
{
uint64_t mask;
int core;
int irq;
irq = (uintptr_t)arg;
CPU_FOREACH(core) {
mask = cvmx_read_csr(CVMX_CIU_INTX_EN1(core*2));
if (core == target)
mask |= 1ull << (irq - CIU_IRQ_EN1_BEGIN);
else
mask &= ~(1ull << (irq - CIU_IRQ_EN1_BEGIN));
cvmx_write_csr(CVMX_CIU_INTX_EN1(core*2), mask);
}
return (0);
}
#endif
static int
ciu_intr(void *arg)
{
@ -358,6 +468,10 @@ static device_method_t ciu_methods[] = {
DEVMETHOD(bus_activate_resource,bus_generic_activate_resource),
DEVMETHOD(bus_setup_intr, ciu_setup_intr),
DEVMETHOD(bus_teardown_intr, ciu_teardown_intr),
#ifdef SMP
DEVMETHOD(bus_bind_intr, ciu_bind_intr),
#endif
DEVMETHOD(bus_describe_intr, ciu_describe_intr),
DEVMETHOD(bus_add_child, bus_generic_add_child),
DEVMETHOD(bus_hinted_child, ciu_hinted_child),