diff options
Diffstat (limited to 'c/src/lib/libbsp/powerpc/mvme2307/pci/interrupts.c')
-rw-r--r-- | c/src/lib/libbsp/powerpc/mvme2307/pci/interrupts.c | 353 |
1 files changed, 0 insertions, 353 deletions
diff --git a/c/src/lib/libbsp/powerpc/mvme2307/pci/interrupts.c b/c/src/lib/libbsp/powerpc/mvme2307/pci/interrupts.c deleted file mode 100644 index b3873fbe01..0000000000 --- a/c/src/lib/libbsp/powerpc/mvme2307/pci/interrupts.c +++ /dev/null @@ -1,353 +0,0 @@ -#include <rtems.h> -#include <rtems/error.h> -#include <bsp.h> - -#define NUMBER_INTERRUPTS (IRQ_RAVEN_ERROR + 1) - -#define DISABLE_IRQ 0x80000000 - -static rtems_isr raven_interrupt_handler(rtems_vector_number vector); -static rtems_isr default_interrupt_handler(rtems_vector_number vector); -static rtems_isr spurious_interrupt_handler(rtems_vector_number vector); - - -static rtems_isr_entry handlers[NUMBER_INTERRUPTS]; -static int *vec_prio_reg_addresses[NUMBER_INTERRUPTS] = {0}; -static void *raven_base = 0; -static int timer_frequency = 0; - -rtems_status_code interrupt_controller_init(void) { - int i; - int raven_config = pci_find_by_devid(RAVEN_VENDOR_ID, RAVEN_DEVICE_ID, 0); - rtems_isr_entry old_handler; - rtems_status_code sc; - - /* get base address of raven registers in LOCAL space */ - raven_base = - (void *)PCI_TO_LOCAL(pci_conf_read32(raven_config, PCI_BASE_ADDRESS_1)); - - /* set cascade mode in global configuration register */ - st_le32(raven_base + 0x01020, 0x20000000); - - /* set spurious interrupt vector */ - st_le32(raven_base + 0x010e0, IRQ_SPURIOUS); - - /* get the timer frequency */ - timer_frequency = ld_le32(raven_base + 0x010f0); - - /* fill in vector/priority register addresses */ - vec_prio_reg_addresses[IRQ_PIC_CASCADE] = raven_base + 0x10000; - vec_prio_reg_addresses[IRQ_FALCON_ECC] = raven_base + 0x10020; - vec_prio_reg_addresses[IRQ_ETHERNET] = raven_base + 0x10040; - vec_prio_reg_addresses[IRQ_VME_LINT0] = raven_base + 0x100a0; - vec_prio_reg_addresses[IRQ_VME_LINT1] = raven_base + 0x100c0; - vec_prio_reg_addresses[IRQ_VME_LINT2] = raven_base + 0x100e0; - vec_prio_reg_addresses[IRQ_VME_LINT3] = raven_base + 0x10100; - vec_prio_reg_addresses[IRQ_PMC1A_PMC2B] = raven_base + 0x10120; - vec_prio_reg_addresses[IRQ_PMC1B_PMC2C] = raven_base + 0x10140; - vec_prio_reg_addresses[IRQ_PMC1C_PMC2D] = raven_base + 0x10160; - vec_prio_reg_addresses[IRQ_PMC1D_PMC2A] = raven_base + 0x10180; - vec_prio_reg_addresses[IRQ_LM_SIG_0] = raven_base + 0x101a0; - vec_prio_reg_addresses[IRQ_LM_SIG_1] = raven_base + 0x101c0; - vec_prio_reg_addresses[IRQ_TIMER_0] = raven_base + 0x01120; - vec_prio_reg_addresses[IRQ_TIMER_1] = raven_base + 0x01160; - vec_prio_reg_addresses[IRQ_TIMER_2] = raven_base + 0x011a0; - vec_prio_reg_addresses[IRQ_TIMER_3] = raven_base + 0x011e0; - vec_prio_reg_addresses[IRQ_IPI_0] = raven_base + 0x010a0; - vec_prio_reg_addresses[IRQ_IPI_1] = raven_base + 0x010b0; - vec_prio_reg_addresses[IRQ_IPI_2] = raven_base + 0x010c0; - vec_prio_reg_addresses[IRQ_IPI_3] = raven_base + 0x010d0; - vec_prio_reg_addresses[IRQ_RAVEN_ERROR] = raven_base + 0x10200; - - /* initialize all vector/priority registers to level 0, disabled */ - for (i = 0; i < NUMBER_INTERRUPTS; i++) { - if (vec_prio_reg_addresses[i]) { - st_le32(vec_prio_reg_addresses[i], DISABLE_IRQ | i); - } - } - - /* initialize all interrupt destination registers to processor 0 */ - st_le32(raven_base + 0x01130, 1); - st_le32(raven_base + 0x01170, 1); - st_le32(raven_base + 0x011b0, 1); - st_le32(raven_base + 0x011f0, 1); - st_le32(raven_base + 0x10010, 1); - st_le32(raven_base + 0x10030, 1); - st_le32(raven_base + 0x10050, 1); - st_le32(raven_base + 0x10070, 1); - st_le32(raven_base + 0x10090, 1); - st_le32(raven_base + 0x100b0, 1); - st_le32(raven_base + 0x100d0, 1); - st_le32(raven_base + 0x100f0, 1); - st_le32(raven_base + 0x10110, 1); - st_le32(raven_base + 0x10130, 1); - st_le32(raven_base + 0x10150, 1); - st_le32(raven_base + 0x10170, 1); - st_le32(raven_base + 0x10190, 1); - st_le32(raven_base + 0x101b0, 1); - st_le32(raven_base + 0x101d0, 1); - st_le32(raven_base + 0x101f0, 1); - st_le32(raven_base + 0x10210, 1); - - /* set up default interrupt handlers */ - for (i = 0; i < NUMBER_INTERRUPTS; i++) { - handlers[i] = default_interrupt_handler; - } - handlers[IRQ_SPURIOUS] = spurious_interrupt_handler; - - /* enable 8259 PIC interrupt at level 8 */ - st_le32(vec_prio_reg_addresses[IRQ_PIC_CASCADE], - 0x00c00000 | (PRIORITY_ISA_INT << 16) | IRQ_PIC_CASCADE); - - /* attach interrupt handler and enable interrupts */ - sc = rtems_interrupt_catch(raven_interrupt_handler, PPC_IRQ_EXTERNAL, - &old_handler); - if (sc != RTEMS_SUCCESSFUL) { - rtems_panic("can't catch interrupt for raven pic\n"); - } - return set_interrupt_task_priority(0); -} - -#define PCI_Interrupt_Ack_Addr ((unsigned32 *) 0xFEFF0030) -#define NonspecificEOI 0x20 -#define PIC1_OCW2 (*(volatile char *)IO_TO_LOCAL(0x20)) -#define PIC2_OCW2 (*(volatile char *)IO_TO_LOCAL(0xA0)) - -static rtems_isr raven_interrupt_handler(rtems_vector_number vector) { - int raven_vector; - int msr_value; - - /* read Raven interrupt acknowledge register */ - raven_vector = ld_le32(raven_base + 0x200a0); - - if (raven_vector == IRQ_PIC_CASCADE) { - /* read PCI interrupt acknowledge register */ - int piack_image = ld_le32(PCI_Interrupt_Ack_Addr); - int isa_vector = piack_image & 0x07; - int pic_id = (piack_image >> 3) & 0x1f; - - if (pic_id == 0x10) { - isa_vector += 8; - } else if (pic_id != 0x01) { - rtems_panic("unrecognized PIACK value: %08x\n", piack_image); - } - - /* set MSRee = 1 */ - _CPU_MSR_Value(msr_value); - msr_value |= PPC_MSR_EE; - _CPU_MSR_SET(msr_value); - - /* signal EOI to Raven */ - st_le32(raven_base + 0x200b0, 0); - - /* call handler */ - handlers[isa_vector](isa_vector); - - /* signal EOI to 8259 PIC */ - PIC1_OCW2 = NonspecificEOI; - if (isa_vector >= 8) { - PIC2_OCW2 = NonspecificEOI; - } - } else { - /* set MSRee = 1 */ - _CPU_MSR_Value(msr_value); - msr_value |= PPC_MSR_EE; - _CPU_MSR_SET(msr_value); - - /* call handler */ - handlers[raven_vector](raven_vector); - - /* signal EOI to Raven */ - st_le32(raven_base + 0x200b0, 0); - - } -} - -static rtems_isr default_interrupt_handler(rtems_vector_number vector) { - rtems_panic("unhandled interrupt: %d\n", vector); -} - -static rtems_isr spurious_interrupt_handler(rtems_vector_number vector) { - rtems_panic("spurious interrupt\n"); -} - -rtems_status_code bsp_interrupt_catch(rtems_isr_entry new_isr_handler, - rtems_vector_number vector, - rtems_isr_entry *old_isr_handler) { - if (!old_isr_handler || ((int)new_isr_handler & 3) != 0) { - return RTEMS_INVALID_ADDRESS; - } - switch (vector) { - case IRQ_ISA_TIMER: case IRQ_UART: case IRQ_ISA_LM_SIG: - case IRQ_ABORT_SWITCH: case IRQ_ISA_ETHERNET: case IRQ_ISA_UNIVERSE: - case IRQ_ISA_PMC_PCIX: case IRQ_FALCON_ECC: case IRQ_ETHERNET: - case IRQ_VME_LINT0: case IRQ_VME_LINT1: case IRQ_VME_LINT2: - case IRQ_VME_LINT3: case IRQ_PMC1A_PMC2B: case IRQ_PMC1B_PMC2C: - case IRQ_PMC1C_PMC2D: case IRQ_PMC1D_PMC2A: case IRQ_LM_SIG_0: - case IRQ_LM_SIG_1: case IRQ_TIMER_0: case IRQ_TIMER_1: - case IRQ_TIMER_2: case IRQ_TIMER_3: case IRQ_IPI_0: - case IRQ_IPI_1: case IRQ_IPI_2: case IRQ_IPI_3: - case IRQ_RAVEN_ERROR: - *old_isr_handler = handlers[vector]; - handlers[vector] = new_isr_handler; - return RTEMS_SUCCESSFUL; - default: - return RTEMS_INVALID_NUMBER; - } -} - -#define PIC1_Mask (*(unsigned8 *) IO_TO_LOCAL(0x21)) -#define PIC2_Mask (*(unsigned8 *) IO_TO_LOCAL(0xA1)) - - -rtems_status_code bsp_interrupt_enable(rtems_vector_number vector, - int priority) { - switch (vector) { - case IRQ_ISA_TIMER: case IRQ_UART: case IRQ_ISA_LM_SIG: - case IRQ_ABORT_SWITCH: case IRQ_ISA_ETHERNET: case IRQ_ISA_UNIVERSE: - case IRQ_ISA_PMC_PCIX: - if (priority != PRIORITY_ISA_INT) { - return RTEMS_INVALID_NUMBER; - } - if (vector < 8) { - PIC1_Mask &= ~ (1 << vector); - } else { - PIC2_Mask &= ~ (1 << (vector - 8)); - } - return RTEMS_SUCCESSFUL; - - case IRQ_ETHERNET: case IRQ_VME_LINT0: case IRQ_VME_LINT1: - case IRQ_VME_LINT2: case IRQ_VME_LINT3: case IRQ_PMC1A_PMC2B: - case IRQ_PMC1B_PMC2C: case IRQ_PMC1C_PMC2D: case IRQ_PMC1D_PMC2A: - case IRQ_LM_SIG_0: case IRQ_LM_SIG_1: - if (priority & ~15) { - return RTEMS_INVALID_NUMBER; - } - st_le32(vec_prio_reg_addresses[vector], - 0x00400000 | (priority << 16) | vector); - return RTEMS_SUCCESSFUL; - - case IRQ_FALCON_ECC: case IRQ_TIMER_0: case IRQ_TIMER_1: - case IRQ_TIMER_2: case IRQ_TIMER_3: case IRQ_IPI_0: - case IRQ_IPI_1: case IRQ_IPI_2: case IRQ_IPI_3: - case IRQ_RAVEN_ERROR: - if (priority & ~15) { - return RTEMS_INVALID_NUMBER; - } - st_le32(vec_prio_reg_addresses[vector], (priority << 16) | vector); - return RTEMS_SUCCESSFUL; - - default: - return RTEMS_INVALID_NUMBER; - } -} - -rtems_status_code bsp_interrupt_disable(rtems_vector_number vector) { - switch (vector) { - case IRQ_ISA_TIMER: case IRQ_UART: case IRQ_ISA_LM_SIG: - case IRQ_ABORT_SWITCH: case IRQ_ISA_ETHERNET: case IRQ_ISA_UNIVERSE: - case IRQ_ISA_PMC_PCIX: - if (vector < 8) { - PIC1_Mask |= (1 << vector); - } else { - PIC2_Mask |= (1 << (vector - 8)); - } - return RTEMS_SUCCESSFUL; - - case IRQ_FALCON_ECC: case IRQ_ETHERNET: case IRQ_VME_LINT0: - case IRQ_VME_LINT1: case IRQ_VME_LINT2: case IRQ_VME_LINT3: - case IRQ_PMC1A_PMC2B: case IRQ_PMC1B_PMC2C: case IRQ_PMC1C_PMC2D: - case IRQ_PMC1D_PMC2A: case IRQ_LM_SIG_0: case IRQ_LM_SIG_1: - case IRQ_TIMER_0: case IRQ_TIMER_1: case IRQ_TIMER_2: - case IRQ_TIMER_3: case IRQ_IPI_0: case IRQ_IPI_1: - case IRQ_IPI_2: case IRQ_IPI_3: case IRQ_RAVEN_ERROR: - st_le32(vec_prio_reg_addresses[vector], DISABLE_IRQ | vector); - return RTEMS_SUCCESSFUL; - - default: - return RTEMS_INVALID_NUMBER; - } -} - -rtems_status_code bsp_start_timer(int timer, int period_usec) { - double counts = (double)period_usec * timer_frequency / 1.0e6 + 0.5; - if (counts < 1.0 || counts > (double)0x7fffffff) { - return RTEMS_INVALID_NUMBER; - } - switch (timer) { - case 0: - st_le32(raven_base + 0x01110, (int)counts); - break; - case 1: - st_le32(raven_base + 0x01150, (int)counts); - break; - case 2: - st_le32(raven_base + 0x01190, (int)counts); - break; - case 3: - st_le32(raven_base + 0x011d0, (int)counts); - break; - default: - return RTEMS_INVALID_NUMBER; - } - return RTEMS_SUCCESSFUL; -} - -rtems_status_code bsp_stop_timer(int timer) { - switch (timer) { - case 0: - st_le32(raven_base + 0x01110, 0x80000000); - break; - case 1: - st_le32(raven_base + 0x01150, 0x80000000); - break; - case 2: - st_le32(raven_base + 0x01190, 0x80000000); - break; - case 3: - st_le32(raven_base + 0x011d0, 0x80000000); - break; - default: - return RTEMS_INVALID_NUMBER; - } - return RTEMS_SUCCESSFUL; -} - -rtems_status_code bsp_read_timer(int timer, int *value) { - switch (timer) { - case 0: - *value = ld_le32(raven_base + 0x01100) & 0x7fffffff; - break; - case 1: - *value = ld_le32(raven_base + 0x01140) & 0x7fffffff; - break; - case 2: - *value = ld_le32(raven_base + 0x01180) & 0x7fffffff; - break; - case 3: - *value = ld_le32(raven_base + 0x011c0) & 0x7fffffff; - break; - default: - return RTEMS_INVALID_NUMBER; - } - return RTEMS_SUCCESSFUL; -} - -rtems_status_code generate_interprocessor_interrupt(int interrupt) { - int *dispatch_reg = raven_base + 0x20040; - - if (interrupt & ~3) { - return RTEMS_INVALID_NUMBER; - } - dispatch_reg[interrupt << 2] = 1; - return RTEMS_SUCCESSFUL; -} - -rtems_status_code set_interrupt_task_priority(int priority) { - if (priority & ~15) { - return RTEMS_INVALID_NUMBER; - } - st_le32(raven_base + 0x20080, priority); - return RTEMS_SUCCESSFUL; -} - |