ref: 6e461fa21dcaa8bfa437d8205e4a6041751291ff
parent: 895e8613263683091a7f4afd633e112b3ab87521
author: cinap_lenrek <cinap_lenrek@felloff.net>
date: Wed Nov 7 11:49:50 EST 2018
bcm: simplify irq handling by having per cpu Vctl chain
--- a/sys/src/9/bcm/trap.c
+++ b/sys/src/9/bcm/trap.c
@@ -13,7 +13,6 @@
#include "arm.h"
#define INTREGS (VIRTIO+0xB200)
-#define LOCALREGS (VIRTIO+IOSIZE)
typedef struct Intregs Intregs;
typedef struct Vctl Vctl;
@@ -51,7 +50,6 @@
struct Vctl {Vctl *next;
int irq;
- int cpu;
u32int *reg;
u32int mask;
void (*f)(Ureg*, void*);
@@ -59,7 +57,7 @@
};
static Lock vctllock;
-static Vctl *vctl, *vfiq;
+static Vctl *vctl[MAXMACH], *vfiq;
static char *trapnames[PsrMask+1] = {[ PsrMusr ] "user mode",
@@ -82,6 +80,7 @@
{Vpage0 *vpage0;
+ intrcpushutdown();
if (m->machno == 0) {/* disable everything */
intrsoff();
@@ -110,10 +109,10 @@
if(soc.armlocal == 0)
return;
- enable = (u32int*)(LOCALREGS + Localtimerint) + m->machno;
+ enable = (u32int*)(ARMLOCAL + Localtimerint) + m->machno;
*enable = 0;
if(m->machno){- enable = (u32int*)(LOCALREGS + Localmboxint) + m->machno;
+ enable = (u32int*)(ARMLOCAL + Localmboxint) + m->machno;
*enable = 1;
}
}
@@ -143,8 +142,8 @@
int clockintr;
clockintr = 0;
- for(v = vctl; v; v = v->next)
- if(v->cpu == m->machno && (*v->reg & v->mask) != 0){+ for(v = vctl[m->machno]; v != nil; v = v->next)
+ if((*v->reg & v->mask) != 0){coherence();
v->f(ureg, v->a);
coherence();
@@ -180,19 +179,16 @@
u32int *enable;
ip = (Intregs*)INTREGS;
- v = (Vctl*)malloc(sizeof(Vctl));
- if(v == nil)
+ if((v = xalloc(sizeof(Vctl))) == nil)
panic("irqenable: no mem");v->irq = irq;
- v->cpu = 0;
if(irq >= IRQlocal){- v->reg = (u32int*)(LOCALREGS + Localintpending) + m->machno;
+ v->reg = (u32int*)(ARMLOCAL + Localintpending) + m->machno;
if(irq >= IRQmbox0)
- enable = (u32int*)(LOCALREGS + Localmboxint) + m->machno;
+ enable = (u32int*)(ARMLOCAL + Localmboxint) + m->machno;
else
- enable = (u32int*)(LOCALREGS + Localtimerint) + m->machno;
+ enable = (u32int*)(ARMLOCAL + Localtimerint) + m->machno;
v->mask = 1 << (irq - IRQlocal);
- v->cpu = m->machno;
}else if(irq >= IRQbasic){enable = &ip->ARMenable;
v->reg = &ip->ARMpending;
@@ -211,8 +207,8 @@
vfiq = v;
ip->FIQctl = Fiqenable | irq;
}else{- v->next = vctl;
- vctl = v;
+ v->next = vctl[m->machno];
+ vctl[m->machno] = v;
if(irq >= IRQmbox0){if(irq <= IRQmbox3)
*enable |= 1 << (irq - IRQmbox0);
--
⑨