Adjust for redesigned powerpc interrupt architecture.

2 files changed, 139 insertions, 130 deletions

diff --git a/sys/arch/socppc/dev/ipic.c b/sys/arch/socppc/dev/ipic.c
index cd6b679be74..a43ede41f04 100644
--- a/sys/arch/socppc/dev/ipic.c
+++ b/sys/arch/socppc/dev/ipic.c
@@ -1,4 +1,4 @@
-/*	$OpenBSD: ipic.c,v 1.4 2008/05/25 14:29:20 kettenis Exp $	*/
+/*	$OpenBSD: ipic.c,v 1.5 2008/10/12 11:50:18 kettenis Exp $	*/
 
 /*
  * Copyright (c) 2008 Mark Kettenis
@@ -63,7 +63,7 @@ struct ipic_softc {
 };
 
 uint32_t ipic_imask;
-struct intrhand *ipic_intrhand[IPIC_NVEC];
+struct intrq ipic_handler[IPIC_NVEC];
 struct ipic_softc *ipic_sc;
 
 int	ipic_match(struct device *, void *, void *);
@@ -82,9 +82,17 @@ void	ipic_write(struct ipic_softc *, bus_addr_t, uint32_t);
 uint32_t ipic_simsr_h(int);
 uint32_t ipic_simsr_l(int);
 uint32_t ipic_semsr(int);
+void	ipic_calc_masks(void);
 
 void	ext_intr(void);
-void	ipic_do_pending_int(void);
+
+ppc_splraise_t ipic_splraise;
+ppc_spllower_t ipic_spllower;
+ppc_splx_t ipic_splx;
+
+void	ipic_setipl(int);
+void	ipic_do_pending(int);
+
 
 int
 ipic_match(struct device *parent, void *cfdata, void *aux)
@@ -97,6 +105,8 @@ ipic_attach(struct device *parent, struct device *self, void *aux)
 {
 	struct ipic_softc *sc = (void *)self;
 	struct obio_attach_args *oa = aux;
+	struct intrq *iq;
+	int i;
 
 	sc->sc_iot = oa->oa_iot;
 	if (bus_space_map(sc->sc_iot, oa->oa_offset, 128, 0, &sc->sc_ioh)) {
@@ -105,6 +115,17 @@ ipic_attach(struct device *parent, struct device *self, void *aux)
 	}
 
 	ipic_sc = sc;
+
+	for (i = 0; i < IPIC_NVEC; i++) {
+		iq = &ipic_handler[i];
+		TAILQ_INIT(&iq->iq_list);
+	}
+
+	ppc_smask_init();
+	ppc_intr_func.raise = ipic_splraise;
+	ppc_intr_func.lower = ipic_spllower;
+	ppc_intr_func.x = ipic_splx;
+
 	printf("\n");
 }
 
@@ -176,32 +197,10 @@ ipic_semsr(int ivec)
 	return 0;
 }
 
-static void
-intr_calculatemasks(void)
+void
+ipic_calc_masks(void)
 {
 	struct ipic_softc *sc = ipic_sc;
-	int level;
-
-	for (level = IPL_NONE; level < IPL_NUM; level++)
-		imask[level] = SINT_MASK | (1 << level);
-
-	/*
-	 * There are tty, network and disk drivers that use free() at interrupt
-	 * time, so vm > (tty | net | bio).
-	 *
-	 * Enforce a hierarchy that gives slow devices a better chance at not
-	 * dropping data.
-	 */
-	imask[IPL_NET] |= imask[IPL_BIO];
-	imask[IPL_TTY] |= imask[IPL_NET];
-	imask[IPL_VM] |= imask[IPL_TTY];
-	imask[IPL_CLOCK] |= imask[IPL_VM] | SPL_CLOCK;
-
-	/*
-	 * These are pseudo-levels.
-	 */
-	imask[IPL_NONE] = 0x00000000;
-	imask[IPL_HIGH] = 0xffffffff;
 
 	sc->sc_simsr_h[IPL_NET] |= sc->sc_simsr_h[IPL_BIO];
 	sc->sc_simsr_h[IPL_TTY] |= sc->sc_simsr_h[IPL_NET];
@@ -227,31 +226,40 @@ intr_establish(int ivec, int type, int level,
     int (*ih_fun)(void *), void *ih_arg, const char *name)
 {
 	struct ipic_softc *sc = ipic_sc;
-	struct intrhand **p, *q, *ih;
+	struct intrhand *ih;
+	struct intrq *iq;
 	uint32_t mask;
+	int s;
 
 	ih = malloc(sizeof *ih, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
 	if (ih == NULL)
 		panic("%s: malloc failed", __func__);
+	iq = &ipic_handler[ivec];
 
 	if (ivec < 0 || ivec >= IPIC_NVEC)
 		panic("%s: invalid vector %d", __func__, ivec);
 
-	for (p = &ipic_intrhand[ivec]; (q = *p) != NULL; p = &q->ih_next)
-		;
-
 	sc->sc_simsr_h[level] |= ipic_simsr_h(ivec);
 	sc->sc_simsr_l[level] |= ipic_simsr_l(ivec);
 	sc->sc_semsr[level] |= ipic_semsr(ivec);
-	intr_calculatemasks();
 
 	ih->ih_fun = ih_fun;
 	ih->ih_arg = ih_arg;
-	ih->ih_next = NULL;
 	ih->ih_level = level;
 	ih->ih_irq = ivec;
-	evcount_attach(&ih->ih_count, name, NULL, &evcount_intr);
-	*p = ih;
+
+	evcount_attach(&ih->ih_count, name, (void *)&ih->ih_irq,
+	    &evcount_intr);
+
+	/*
+	 * Append handler to end of list
+	 */
+	s = ppc_intr_disable();
+
+	TAILQ_INSERT_TAIL(&iq->iq_list, ih, ih_list);
+	ipic_calc_masks();
+
+	ppc_intr_enable(s);
 
 	/* Unmask the interrupt. */
 	mask = ipic_read(sc, IPIC_SIMSR_H);
@@ -273,31 +281,19 @@ ext_intr(void)
 	struct cpu_info *ci = curcpu();
 	struct ipic_softc *sc = ipic_sc;
 	struct intrhand *ih;
-	uint32_t simsr_h, simsr_l, semsr;
-	int pcpl, ocpl;
+	struct intrq *iq;
+	int pcpl;
 	int ivec;
 
 	pcpl = ci->ci_cpl;
 	ivec = ipic_read(sc, IPIC_SIVCR) & 0x7f;
 
-	simsr_h = ipic_read(sc, IPIC_SIMSR_H);
-	simsr_l = ipic_read(sc, IPIC_SIMSR_L);
-	semsr = ipic_read(sc, IPIC_SEMSR);
-	ipic_write(sc, IPIC_SIMSR_H, simsr_h & ~ipic_simsr_h(ivec));
-	ipic_write(sc, IPIC_SIMSR_L, simsr_l & ~ipic_simsr_l(ivec));
-	ipic_write(sc, IPIC_SEMSR, semsr & ~ipic_semsr(ivec));
-
-	ih = ipic_intrhand[ivec];
-	while (ih) {
-		if (ci->ci_cpl & (1 << ih->ih_level)) {
-			ci->ci_ipending |= (1 << ih->ih_level);
-			return;
-		}
+	iq = &ipic_handler[ivec];
+	TAILQ_FOREACH(ih, &iq->iq_list, ih_list) {
+		if (ih->ih_level < pcpl)
+			continue;
 
-		ipic_write(sc, IPIC_SIMSR_H, sc->sc_simsr_h[ih->ih_level]);
-		ipic_write(sc, IPIC_SIMSR_L, sc->sc_simsr_l[ih->ih_level]);
-		ipic_write(sc, IPIC_SEMSR, sc->sc_semsr[ih->ih_level]);
-		ocpl = splraise(imask[ih->ih_level]);
+		ipic_splraise(ih->ih_level);
 		ppc_intr_enable(1);
 
 		KERNEL_LOCK();
@@ -306,40 +302,111 @@ ext_intr(void)
 		KERNEL_UNLOCK();
 
 		ppc_intr_disable();
-		ci->ci_cpl = ocpl;
-		ih = ih->ih_next;
 	}
 
-	ipic_write(sc, IPIC_SIMSR_H, simsr_h);
-	ipic_write(sc, IPIC_SIMSR_L, simsr_l);
-	ipic_write(sc, IPIC_SEMSR, semsr);
 	splx(pcpl);
 }
 
-static __inline int
-cntlzw(int x)
+int
+ipic_splraise(int newcpl)
+{
+	struct cpu_info *ci = curcpu();
+	int ocpl = ci->ci_cpl;
+
+	if (ocpl > newcpl)
+		newcpl = ocpl;
+
+	ipic_setipl(newcpl);
+
+	return (ocpl);
+}
+
+int
+ipic_spllower(int newcpl)
 {
-	int a;
+	struct cpu_info *ci = curcpu();
+	int ocpl = ci->ci_cpl;
+
+	ipic_splx(newcpl);
+
+	return (ocpl);
+}
 
-	__asm __volatile("cntlzw %0,%1" : "=r"(a) : "r"(x));
+void
+ipic_splx(int newcpl)
+{
+	struct cpu_info *ci = curcpu();
 
-	return a;
+	ipic_setipl(newcpl);
+	if (ci->ci_ipending & ppc_smask[newcpl])
+		ipic_do_pending(newcpl);
 }
 
 void
-ipic_do_pending_int(void)
+ipic_setipl(int ipl)
 {
 	struct cpu_info *ci = curcpu();
 	struct ipic_softc *sc = ipic_sc;
 	uint32_t mask;
-	int level;
+	int s;
 
-	ci->ci_ipending &= SINT_MASK;
-	level = cntlzw(31 - (ci->ci_cpl & ~(SPL_CLOCK|SINT_MASK)));
-	mask = sc->sc_simsr_h[IPL_HIGH] & ~sc->sc_simsr_h[level];
+	s = ppc_intr_disable();
+	ci->ci_cpl = ipl;
+	mask = sc->sc_simsr_h[IPL_HIGH] & ~sc->sc_simsr_h[ipl];
 	ipic_write(sc, IPIC_SIMSR_H, mask);
-	mask = sc->sc_simsr_l[IPL_HIGH] & ~sc->sc_simsr_l[level];
+	mask = sc->sc_simsr_l[IPL_HIGH] & ~sc->sc_simsr_l[ipl];
 	ipic_write(sc, IPIC_SIMSR_L, mask);
-	mask = sc->sc_semsr[IPL_HIGH] & ~sc->sc_semsr[level];
+	mask = sc->sc_semsr[IPL_HIGH] & ~sc->sc_semsr[ipl];
 	ipic_write(sc, IPIC_SEMSR, mask);
+	ppc_intr_enable(s);
+}
+
+void
+ipic_do_pending(int pcpl)
+{
+	struct cpu_info *ci = curcpu();
+	int s;
+
+	s = ppc_intr_disable();
+	if (ci->ci_iactive & CI_IACTIVE_PROCESSING_SOFT) {
+		ppc_intr_enable(s);
+		return;
+	}
+
+	atomic_setbits_int(&ci->ci_iactive, CI_IACTIVE_PROCESSING_SOFT);
+
+	do {
+		if ((ci->ci_ipending & SI_TO_IRQBIT(SI_SOFTNET)) &&
+		    (pcpl < IPL_SOFTNET)) {
+			extern int netisr;
+			int pisr;
+		       
+			ci->ci_ipending &= ~SI_TO_IRQBIT(SI_SOFTNET);
+			ci->ci_cpl = IPL_SOFTNET;
+			ppc_intr_enable(s);
+			KERNEL_LOCK();
+			while ((pisr = netisr) != 0) {
+				atomic_clearbits_int(&netisr, pisr);
+				softnet(pisr);
+			}
+			KERNEL_UNLOCK();
+			ppc_intr_disable();
+			continue;
+		}
+		if ((ci->ci_ipending & SI_TO_IRQBIT(SI_SOFTCLOCK)) &&
+		    (pcpl < IPL_SOFTCLOCK)) {
+			ci->ci_ipending &= ~SI_TO_IRQBIT(SI_SOFTCLOCK);
+			ci->ci_cpl = IPL_SOFTCLOCK;
+			ppc_intr_enable(s);
+			KERNEL_LOCK();
+			softclock();
+			KERNEL_UNLOCK();
+			ppc_intr_disable();
+			continue;
+		}
+	} while (ci->ci_ipending & ppc_smask[pcpl]);
+	ipic_setipl(pcpl);	/* Don't use splx... we are here already! */
+
+	atomic_clearbits_int(&ci->ci_iactive, CI_IACTIVE_PROCESSING_SOFT);
+	ppc_intr_enable(s);
 }
diff --git a/sys/arch/socppc/socppc/machdep.c b/sys/arch/socppc/socppc/machdep.c
index b8a19db2ca2..42291ee77ef 100644
--- a/sys/arch/socppc/socppc/machdep.c
+++ b/sys/arch/socppc/socppc/machdep.c
@@ -1,4 +1,4 @@
-/*	$OpenBSD: machdep.c,v 1.5 2008/05/24 09:49:55 kettenis Exp $	*/
+/*	$OpenBSD: machdep.c,v 1.6 2008/10/12 11:50:19 kettenis Exp $	*/
 /*	$NetBSD: machdep.c,v 1.4 1996/10/16 19:33:11 ws Exp $	*/
 
 /*
@@ -1094,67 +1094,9 @@ boot(int howto)
 	while(1) /* forever */;
 }
 
-extern void ipic_do_pending_int(void);
-
 void
 do_pending_int(void)
 {
-	struct cpu_info *ci = curcpu();
-	int pcpl, s;
-
-	if (ci->ci_iactive)
-		return;
-
-	ci->ci_iactive = 1;
-	s = ppc_intr_disable();
-	pcpl = ci->ci_cpl;
-
-	ipic_do_pending_int();
-
-	do {
-		if((ci->ci_ipending & SINT_CLOCK) & ~pcpl) {
-			ci->ci_ipending &= ~SINT_CLOCK;
-			ci->ci_cpl = SINT_CLOCK|SINT_NET|SINT_TTY;
-			ppc_intr_enable(1);
-			KERNEL_LOCK();
-			softclock();
-			KERNEL_UNLOCK();
-			ppc_intr_disable();
-			continue;
-		}
-		if((ci->ci_ipending & SINT_NET) & ~pcpl) {
-			extern int netisr;
-			int pisr;
-		       
-			ci->ci_ipending &= ~SINT_NET;
-			ci->ci_cpl = SINT_NET|SINT_TTY;
-			while ((pisr = netisr) != 0) {
-				atomic_clearbits_int(&netisr, pisr);
-				ppc_intr_enable(1);
-				KERNEL_LOCK();
-				softnet(pisr);
-				KERNEL_UNLOCK();
-				ppc_intr_disable();
-			}
-			continue;
-		}
-#if 0
-		if((ci->ci_ipending & SINT_TTY) & ~pcpl) {
-			ci->ci_ipending &= ~SINT_TTY;
-			ci->ci_cpl = SINT_TTY;
-			ppc_intr_enable(1);
-			KERNEL_LOCK();
-			softtty();
-			KERNEL_UNLOCK();
-			ppc_intr_disable();
-			continue;
-		}
-#endif
-	} while ((ci->ci_ipending & SINT_MASK) & ~pcpl);
-	ci->ci_cpl = pcpl;	/* Don't use splx... we are here already! */
-
-	ci->ci_iactive = 0;
-	ppc_intr_enable(s);
 }
 
 /*