static void enable_microdev_irq(struct irq_data *data) { unsigned int irq = data->irq; unsigned long priorityReg, priorities, pri; unsigned int fpgaIrq; if (unlikely(irq >= NUM_EXTERNAL_IRQS)) return; if (unlikely(!fpgaIrqTable[irq].mapped)) return; pri = 15 - irq; fpgaIrq = fpgaIrqTable[irq].fpgaIrq; priorityReg = MICRODEV_FPGA_INTPRI_REG(fpgaIrq); priorities = __raw_readl(priorityReg); priorities &= ~MICRODEV_FPGA_INTPRI_MASK(fpgaIrq); priorities |= MICRODEV_FPGA_INTPRI_LEVEL(fpgaIrq, pri); __raw_writel(priorities, priorityReg); __raw_writel(MICRODEV_FPGA_INTC_MASK(fpgaIrq), MICRODEV_FPGA_INTENB_REG); }
extern void microdev_print_fpga_intc_status(void) { volatile unsigned int * const intenb = (unsigned int*)MICRODEV_FPGA_INTENB_REG; volatile unsigned int * const intdsb = (unsigned int*)MICRODEV_FPGA_INTDSB_REG; volatile unsigned int * const intpria = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(0); volatile unsigned int * const intprib = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(8); volatile unsigned int * const intpric = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(16); volatile unsigned int * const intprid = (unsigned int*)MICRODEV_FPGA_INTPRI_REG(24); volatile unsigned int * const intsrc = (unsigned int*)MICRODEV_FPGA_INTSRC_REG; volatile unsigned int * const intreq = (unsigned int*)MICRODEV_FPGA_INTREQ_REG; printk("-------------------------- microdev_print_fpga_intc_status() ------------------\n"); printk("FPGA_INTENB = 0x%08x\n", *intenb); printk("FPGA_INTDSB = 0x%08x\n", *intdsb); printk("FPGA_INTSRC = 0x%08x\n", *intsrc); printk("FPGA_INTREQ = 0x%08x\n", *intreq); printk("FPGA_INTPRI[3..0] = %08x:%08x:%08x:%08x\n", *intprid, *intpric, *intprib, *intpria); printk("-------------------------------------------------------------------------------\n"); }
static void enable_microdev_irq(unsigned int irq) { unsigned long priorityReg, priorities, pri; unsigned int fpgaIrq; if (unlikely(irq >= NUM_EXTERNAL_IRQS)) return; if (unlikely(!fpgaIrqTable[irq].mapped)) return; pri = 15 - irq; fpgaIrq = fpgaIrqTable[irq].fpgaIrq; priorityReg = MICRODEV_FPGA_INTPRI_REG(fpgaIrq); /* set priority for the interrupt */ priorities = ctrl_inl(priorityReg); priorities &= ~MICRODEV_FPGA_INTPRI_MASK(fpgaIrq); priorities |= MICRODEV_FPGA_INTPRI_LEVEL(fpgaIrq, pri); ctrl_outl(priorities, priorityReg); /* enable interrupts on the FPGA INTC register */ ctrl_outl(MICRODEV_FPGA_INTC_MASK(fpgaIrq), MICRODEV_FPGA_INTENB_REG); }