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

rewrite arm_get_next_irq to always make forward progress (should be optimized)

Browse Source
This commit is contained in:
Sam Leffler 2009-06-22 20:36:22 +00:00
parent 73c424b8cb
commit ad0be1f829
1 changed files with 19 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
sys/arm/xscale/ixp425/ixp425.c
View File

@ -214,15 +214,27 @@ ixp435_irq_read(void)
}
int
arm_get_next_irq(int last __unused)
arm_get_next_irq(int last)
{
uint32_t irq;
uint32_t mask;
if ((irq = ixp425_irq_read()))
return (ffs(irq) - 1);
if (cpu_is_ixp43x() && (irq = ixp435_irq_read()))
return (32 + ffs(irq) - 1);
return (-1);
last += 1; /* always advance fwd, NB: handles -1 */
if (last < 32) {
mask = ixp425_irq_read() >> last;
for (; mask != 0; mask >>= 1, last += 1) {
if (mask & 1)
return last;
}
last = 32;
}
if (cpu_is_ixp43x()) {
mask = ixp435_irq_read() >> (32-last);
for (; mask != 0; mask >>= 1, last++) {
if (mask & 1)
return last;
}
}
return -1;
}
void