/* $OpenBSD: openpic.c,v 1.50 2008/09/19 01:49:54 drahn Exp $ */ /*- * Copyright (c) 2008 Dale Rahn * Copyright (c) 1995 Per Fogelstrom * Copyright (c) 1993, 1994 Charles M. Hannum. * Copyright (c) 1990 The Regents of the University of California. * All rights reserved. * * This code is derived from software contributed to Berkeley by * William Jolitz and Don Ahn. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the University nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * @(#)isa.c 7.2 (Berkeley) 5/12/91 */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define ICU_LEN 128 int openpic_numirq = ICU_LEN; #define LEGAL_IRQ(x) ((x >= 0) && (x < ICU_LEN)) int openpic_pri_share[IPL_NUM]; struct intrq openpic_handler[ICU_LEN]; void openpic_calc_mask(void); int openpic_prog_button(void *arg); ppc_splraise_t openpic_splraise; ppc_spllower_t openpic_spllower; ppc_splx_t openpic_splx; /* IRQ vector used for inter-processor interrupts. */ #define IPI_VECTOR_NOP 64 #define IPI_VECTOR_DDB 65 #ifdef MULTIPROCESSOR static struct evcount ipi_ddb[PPC_MAXPROCS]; static struct evcount ipi_nop[PPC_MAXPROCS]; static int ipi_nopirq = IPI_VECTOR_NOP; static int ipi_ddbirq = IPI_VECTOR_DDB; #endif struct evcount openpic_spurious; int openpic_spurious_irq = 255; void openpic_enable_irq(int, int); void openpic_disable_irq(int); void openpic_init(void); void openpic_set_priority(int); void openpic_ipi_ddb(void); typedef void (void_f) (void); extern void_f *pending_int_f; vaddr_t openpic_base; void * openpic_intr_establish( void * lcv, int irq, int type, int level, int (*ih_fun)(void *), void *ih_arg, char *name); void openpic_intr_disestablish( void *lcp, void *arg); void openpic_collect_preconf_intr(void); int openpic_big_endian; #ifdef MULTIPROCESSOR intr_send_ipi_t openpic_send_ipi; #endif u_int openpic_read(int reg); void openpic_write(int reg, u_int val); struct openpic_softc { struct device sc_dev; }; int openpic_match(struct device *parent, void *cf, void *aux); void openpic_attach(struct device *, struct device *, void *); void openpic_do_pending_int(int pcpl); void openpic_collect_preconf_intr(void); void openpic_ext_intr(void); struct cfattach openpic_ca = { sizeof(struct openpic_softc), openpic_match, openpic_attach }; struct cfdriver openpic_cd = { NULL, "openpic", DV_DULL }; u_int openpic_read(int reg) { char *addr = (void *)(openpic_base + reg); asm volatile("eieio"); if (openpic_big_endian) return in32(addr); else return in32rb(addr); } void openpic_write(int reg, u_int val) { char *addr = (void *)(openpic_base + reg); if (openpic_big_endian) out32(addr, val); else out32rb(addr, val); asm volatile("eieio"); } static inline int openpic_read_irq(int cpu) { return openpic_read(OPENPIC_IACK(cpu)) & OPENPIC_VECTOR_MASK; } static inline void openpic_eoi(int cpu) { openpic_write(OPENPIC_EOI(cpu), 0); } int openpic_match(struct device *parent, void *cf, void *aux) { char type[40]; int pirq; struct confargs *ca = aux; bzero (type, sizeof(type)); if (OF_getprop(ca->ca_node, "interrupt-parent", &pirq, sizeof(pirq)) == sizeof(pirq)) return 0; /* XXX */ if (strcmp(ca->ca_name, "interrupt-controller") != 0 && strcmp(ca->ca_name, "mpic") != 0) return 0; OF_getprop(ca->ca_node, "device_type", type, sizeof(type)); if (strcmp(type, "open-pic") != 0) return 0; if (ca->ca_nreg < 8) return 0; return 1; } void openpic_attach(struct device *parent, struct device *self, void *aux) { struct cpu_info *ci = curcpu(); struct confargs *ca = aux; u_int32_t reg; reg = 0; if (OF_getprop(ca->ca_node, "big-endian", ®, sizeof reg) == 0) openpic_big_endian = 1; openpic_base = (vaddr_t) mapiodev (ca->ca_baseaddr + ca->ca_reg[0], 0x40000); /* openpic may support more than 128 interupts but driver doesn't */ openpic_numirq = ((openpic_read(OPENPIC_FEATURE) >> 16) & 0x7f)+1; printf(": version 0x%x feature %x %s", openpic_read(OPENPIC_VENDOR_ID), openpic_read(OPENPIC_FEATURE), openpic_big_endian ? "BE" : "LE" ); openpic_init(); intr_establish_func = openpic_intr_establish; intr_disestablish_func = openpic_intr_disestablish; mac_intr_establish_func = openpic_intr_establish; mac_intr_disestablish_func = openpic_intr_disestablish; #ifdef MULTIPROCESSOR intr_send_ipi_func = openpic_send_ipi; #endif ppc_smask_init(); openpic_collect_preconf_intr(); evcount_attach(&openpic_spurious, "spurious", (void *)&openpic_spurious_irq, &evcount_intr); #if 1 mac_intr_establish(parent, 0x37, IST_LEVEL, IPL_HIGH, openpic_prog_button, (void *)0x37, "progbutton"); #endif ppc_intr_func.raise = openpic_splraise; ppc_intr_func.lower = openpic_spllower; ppc_intr_func.x = openpic_splx; openpic_set_priority(ci->ci_cpl); ppc_intr_enable(1); printf("\n"); } static inline void openpic_setipl(int newcpl) { struct cpu_info *ci = curcpu(); int s; /* XXX - try do to this without the disable */ s = ppc_intr_disable(); ci->ci_cpl = newcpl; openpic_set_priority(newcpl); ppc_intr_enable(s); } int openpic_splraise(int newcpl) { struct cpu_info *ci = curcpu(); newcpl = openpic_pri_share[newcpl]; int ocpl = ci->ci_cpl; if (ocpl > newcpl) newcpl = ocpl; openpic_setipl(newcpl); return ocpl; } int openpic_spllower(int newcpl) { struct cpu_info *ci = curcpu(); int ocpl = ci->ci_cpl; openpic_splx(newcpl); return ocpl; } void openpic_splx(int newcpl) { openpic_do_pending_int(newcpl); } void openpic_collect_preconf_intr() { int i; for (i = 0; i < ppc_configed_intr_cnt; i++) { #ifdef DEBUG printf("\n\t%s irq %d level %d fun %x arg %x", ppc_configed_intr[i].ih_what, ppc_configed_intr[i].ih_irq, ppc_configed_intr[i].ih_level, ppc_configed_intr[i].ih_fun, ppc_configed_intr[i].ih_arg); #endif openpic_intr_establish(NULL, ppc_configed_intr[i].ih_irq, IST_LEVEL, ppc_configed_intr[i].ih_level, ppc_configed_intr[i].ih_fun, ppc_configed_intr[i].ih_arg, ppc_configed_intr[i].ih_what); } } /* * Register an interrupt handler. */ void * openpic_intr_establish(void *lcv, int irq, int type, int level, int (*ih_fun)(void *), void *ih_arg, char *name) { struct intrhand *ih; struct intrq *iq; int s; /* no point in sleeping unless someone can free memory. */ ih = malloc(sizeof *ih, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK); if (ih == NULL) panic("intr_establish: can't malloc handler info"); iq = &openpic_handler[irq]; if (!LEGAL_IRQ(irq) || type == IST_NONE) panic("intr_establish: bogus irq or type"); switch (iq->iq_ist) { case IST_NONE: iq->iq_ist = type; break; case IST_EDGE: case IST_LEVEL: if (type == iq->iq_ist) break; case IST_PULSE: if (type != IST_NONE) panic("intr_establish: can't share %s with %s", ppc_intr_typename(iq->iq_ist), ppc_intr_typename(type)); break; } ih->ih_fun = ih_fun; ih->ih_arg = ih_arg; ih->ih_level = level; ih->ih_irq = irq; 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); openpic_calc_mask(); ppc_intr_enable(s); return (ih); } /* * Deregister an interrupt handler. */ void openpic_intr_disestablish(void *lcp, void *arg) { struct intrhand *ih = arg; int irq = ih->ih_irq; struct intrq *iq = &openpic_handler[irq]; int s; if (!LEGAL_IRQ(irq)) panic("intr_disestablish: bogus irq"); /* * Remove the handler from the chain. */ s = ppc_intr_disable(); TAILQ_REMOVE(&iq->iq_list, ih, ih_list); openpic_calc_mask(); ppc_intr_enable(s); evcount_detach(&ih->ih_count); free((void *)ih, M_DEVBUF); if (TAILQ_EMPTY(&iq->iq_list)) iq->iq_ist = IST_NONE; } /* * Recalculate the interrupt masks from scratch. * We could code special registry and deregistry versions of this function that * would be faster, but the code would be nastier, and we don't expect this to * happen very much anyway. */ void openpic_calc_mask() { struct cpu_info *ci = curcpu(); int irq; struct intrhand *ih; int i; /* disable all openpic interrupts */ openpic_set_priority(15); for (i = IPL_NONE; i < IPL_NUM; i++) { openpic_pri_share[i] = i; } for (irq = 0; irq < openpic_numirq; irq++) { int maxipl = IPL_NONE; int minipl = IPL_HIGH; struct intrq *iq = &openpic_handler[irq]; TAILQ_FOREACH(ih, &iq->iq_list, ih_list) { if (ih->ih_level > maxipl) maxipl = ih->ih_level; if (ih->ih_level < minipl) minipl = ih->ih_level; } if (maxipl == IPL_NONE) { minipl = IPL_NONE; /* Interrupt not enabled */ openpic_disable_irq(irq); } else { for (i = minipl; i <= maxipl; i++) { openpic_pri_share[i] = maxipl; } openpic_enable_irq(irq, maxipl); } iq->iq_ipl = maxipl; } /* restore interrupts */ openpic_set_priority(ci->ci_cpl); } void openpic_do_pending_int(int pcpl) { struct cpu_info *ci = curcpu(); int s; int loopcount = 0; 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 { loopcount ++; if (loopcount > 50) printf("do_pending looping %d pcpl %x %x\n", loopcount, pcpl, ci->ci_cpl); if((ci->ci_ipending & SI_TO_IRQBIT(SI_SOFTTTY)) && (pcpl < IPL_SOFTTTY)) { ci->ci_ipending &= ~SI_TO_IRQBIT(SI_SOFTTTY); openpic_setipl(IPL_SOFTTTY); ppc_intr_enable(s); KERNEL_LOCK(); softtty(); KERNEL_UNLOCK(); ppc_intr_disable(); continue; } 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); openpic_setipl(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); openpic_setipl(IPL_SOFTCLOCK); ppc_intr_enable(s); KERNEL_LOCK(); softclock(); KERNEL_UNLOCK(); ppc_intr_disable(); continue; } break; } while (ci->ci_ipending & ppc_smask[pcpl]); openpic_setipl(pcpl); /* Don't use splx... we are here already! */ atomic_clearbits_int(&ci->ci_iactive, CI_IACTIVE_PROCESSING_SOFT); ppc_intr_enable(s); } void openpic_enable_irq(int irq, int pri) { u_int x; struct intrq *iq = &openpic_handler[irq]; x = irq; if (iq->iq_ist == IST_LEVEL) x |= OPENPIC_SENSE_LEVEL; else x |= OPENPIC_SENSE_EDGE; x |= OPENPIC_POLARITY_POSITIVE; x |= pri << OPENPIC_PRIORITY_SHIFT; openpic_write(OPENPIC_SRC_VECTOR(irq), x); } void openpic_disable_irq(int irq) { u_int x; x = openpic_read(OPENPIC_SRC_VECTOR(irq)); x |= OPENPIC_IMASK; openpic_write(OPENPIC_SRC_VECTOR(irq), x); } void openpic_set_priority(int pri) { struct cpu_info *ci = curcpu(); openpic_write(OPENPIC_CPU_PRIORITY(ci->ci_cpuid), pri); } #ifdef MULTIPROCESSOR void openpic_send_ipi(struct cpu_info *ci, int id) { switch (id) { case PPC_IPI_NOP: id = 0; break; case PPC_IPI_DDB: id = 1; break; default: panic("invalid ipi send to cpu %d %d\n", ci->ci_cpuid, id); } openpic_write(OPENPIC_IPI(curcpu()->ci_cpuid, id), 1 << ci->ci_cpuid); } #endif void openpic_ext_intr() { struct cpu_info *ci = curcpu(); int irq; int pcpl; struct intrhand *ih; struct intrq *iq; int irqloop = 0; static int irqnest = 0; int spurious; pcpl = ci->ci_cpl; irq = openpic_read_irq(ci->ci_cpuid); irqnest++; while (irq != 255) { irqloop++; if (irqloop > 20 || irqnest > 3) { printf("irqloop %d irqnest %d\n", irqloop, irqnest); } #ifdef MULTIPROCESSOR if (irq == IPI_VECTOR_NOP) { ipi_nop[ci->ci_cpuid].ec_count++; openpic_eoi(ci->ci_cpuid); irq = openpic_read_irq(ci->ci_cpuid); continue; } if (irq == IPI_VECTOR_DDB) { ipi_ddb[ci->ci_cpuid].ec_count++; openpic_eoi(ci->ci_cpuid); openpic_ipi_ddb(); irq = openpic_read_irq(ci->ci_cpuid); continue; } #endif iq = &openpic_handler[irq]; if (iq->iq_ipl <= ci->ci_cpl) printf("invalid interrupt %d lvl %d at %d hw %d\n", irq, iq->iq_ipl, ci->ci_cpl, openpic_read(OPENPIC_CPU_PRIORITY(ci->ci_cpuid))); splraise(iq->iq_ipl); openpic_eoi(ci->ci_cpuid); spurious = 1; TAILQ_FOREACH(ih, &iq->iq_list, ih_list) { ppc_intr_enable(1); KERNEL_LOCK(); if ((*ih->ih_fun)(ih->ih_arg)) { ih->ih_count.ec_count++; spurious = 0; } KERNEL_UNLOCK(); (void)ppc_intr_disable(); } if (spurious) { openpic_spurious.ec_count++; #ifdef OPENPIC_NOISY printf("spurious intr %d\n", irq); #endif } uvmexp.intrs++; openpic_setipl(pcpl); irq = openpic_read_irq(ci->ci_cpuid); } irqnest--; ppc_intr_enable(1); splx(pcpl); /* Process pendings. */ } void openpic_init() { struct cpu_info *ci = curcpu(); struct intrq *iq; int irq; u_int x; int i; openpic_set_priority(15); /* disable all interrupts */ for (irq = 0; irq < openpic_numirq; irq++) openpic_write(OPENPIC_SRC_VECTOR(irq), OPENPIC_IMASK); for (i = 0; i < openpic_numirq; i++) { iq = &openpic_handler[i]; TAILQ_INIT(&iq->iq_list); } /* we don't need 8259 pass through mode */ x = openpic_read(OPENPIC_CONFIG); x |= OPENPIC_CONFIG_8259_PASSTHRU_DISABLE; openpic_write(OPENPIC_CONFIG, x); /* initialize all vectors to something sane */ for (irq = 0; irq < ICU_LEN; irq++) { x = irq; x |= OPENPIC_IMASK; x |= OPENPIC_POLARITY_POSITIVE; x |= OPENPIC_SENSE_LEVEL; x |= 8 << OPENPIC_PRIORITY_SHIFT; openpic_write(OPENPIC_SRC_VECTOR(irq), x); } /* send all interrupts to cpu 0 */ for (irq = 0; irq < openpic_numirq; irq++) openpic_write(OPENPIC_IDEST(irq), 1 << 0); /* clear all pending interrunts */ for (irq = 0; irq < ICU_LEN; irq++) { openpic_read_irq(ci->ci_cpuid); openpic_eoi(ci->ci_cpuid); } #ifdef MULTIPROCESSOR /* Set up inter-processor interrupts. */ /* IPI0 - NOP */ x = openpic_read(OPENPIC_IPI_VECTOR(0)); x &= ~(OPENPIC_IMASK | OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK); x |= (15 << OPENPIC_PRIORITY_SHIFT) | IPI_VECTOR_NOP; openpic_write(OPENPIC_IPI_VECTOR(0), x); /* IPI1 - DDB */ x = openpic_read(OPENPIC_IPI_VECTOR(1)); x &= ~(OPENPIC_IMASK | OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK); x |= (15 << OPENPIC_PRIORITY_SHIFT) | IPI_VECTOR_DDB; openpic_write(OPENPIC_IPI_VECTOR(1), x); /* XXX - ncpus */ evcount_attach(&ipi_nop[0], "ipi_nop0", (void *)&ipi_nopirq, &evcount_intr); evcount_attach(&ipi_nop[1], "ipi_nop1", (void *)&ipi_nopirq, &evcount_intr); evcount_attach(&ipi_ddb[0], "ipi_ddb0", (void *)&ipi_ddbirq, &evcount_intr); evcount_attach(&ipi_ddb[1], "ipi_ddb1", (void *)&ipi_ddbirq, &evcount_intr); #endif /* clear all pending interrunts */ for (irq = 0; irq < ICU_LEN; irq++) { openpic_read_irq(0); openpic_eoi(0); } #if 0 openpic_write(OPENPIC_SPURIOUS_VECTOR, 255); #endif install_extint(openpic_ext_intr); openpic_set_priority(0); } /* * programmer_button function to fix args to Debugger. * deal with any enables/disables, if necessary. */ int openpic_prog_button (void *arg) { #ifdef DDB if (db_console) Debugger(); #else printf("programmer button pressed, debugger not available\n"); #endif return 1; } void openpic_ipi_ddb() { #ifdef OPENPIC_NOISY printf("ipi_ddb() called\n"); #endif Debugger(); }