source: rtems/c/src/lib/libbsp/powerpc/motorola_powerpc/irq/irq_init.c @ ba46ffa6

/* irq_init.c
 *
 *  This file contains the implementation of rtems initialization
 *  related to interrupt handling.
 *
 *  CopyRight (C) 1999 valette@crf.canon.fr
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.OARcorp.com/rtems/license.html.
 *
 *  $Id$
 */
#include <bsp/consoleIo.h>
#include <libcpu/io.h>
#include <libcpu/spr.h>
#include <bsp/pci.h>
#include <bsp/residual.h>
#include <bsp/openpic.h>
#include <bsp/irq.h>
#include <bsp.h>
#include <libcpu/raw_exception.h>

typedef struct {
  unsigned char bus;    /* few chance the PCI/ISA bridge is not on first bus but ... */
  unsigned char device;
  unsigned char function;
} pci_isa_bridge_device;

pci_isa_bridge_device* via_82c586 = 0;
static pci_isa_bridge_device bridge;

extern unsigned int external_exception_vector_prolog_code_size;
extern void external_exception_vector_prolog_code();
extern unsigned int decrementer_exception_vector_prolog_code_size;
extern void decrementer_exception_vector_prolog_code();

/*
 * default on/off function
 */
static void nop_func(){}
/*
 * default isOn function
 */
static int not_connected() {return 0;}
/*
 * default possible isOn function
 */
static int connected() {return 1;}

static rtems_irq_connect_data           rtemsIrq[BSP_IRQ_NUMBER];
static rtems_irq_global_settings        initial_config;
static rtems_irq_connect_data           defaultIrq = {
  /* vectorIdex,         hdl            , on            , off           , isOn */
  0,                     nop_func       , nop_func      , nop_func      , not_connected
};
static rtems_irq_prio irqPrioTable[BSP_IRQ_NUMBER]={
  /*
   * actual rpiorities for interrupt :
   *    0   means that only current interrupt is masked
   *    255 means all other interrupts are masked
   */
  /*
   * ISA interrupts.
   * The second entry has a priority of 255 because
   * it is the slave pic entry and is should always remain
   * unmasked.
   */
  0,0,
  255,
  0, 0, 0, 0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  /*
   * PCI Interrupts
   */
  1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, /* for raven prio 0 means unactive... */
  /*
   * Processor exceptions handled as interrupts
   */
  0
};

static unsigned char mcp750_openpic_initsenses[] = {
    1,  /* MCP750_INT_PCB(8259) */
    0,  /* MCP750_INT_FALCON_ECC_ERR */
    1,  /* MCP750_INT_PCI_ETHERNET */
    1,  /* MCP750_INT_PCI_PMC */
    1,  /* MCP750_INT_PCI_WATCHDOG_TIMER1 */
    1,  /* MCP750_INT_PCI_PRST_SIGNAL */
    1,  /* MCP750_INT_PCI_FALL_SIGNAL */
    1,  /* MCP750_INT_PCI_DEG_SIGNAL */
    1,  /* MCP750_INT_PCI_BUS1_INTA */
    1,  /* MCP750_INT_PCI_BUS1_INTB */
    1,  /* MCP750_INT_PCI_BUS1_INTC */
    1,  /* MCP750_INT_PCI_BUS1_INTD */
    1,  /* MCP750_INT_PCI_BUS2_INTA */
    1,  /* MCP750_INT_PCI_BUS2_INTB */
    1,  /* MCP750_INT_PCI_BUS2_INTC */
    1,  /* MCP750_INT_PCI_BUS2_INTD */
};

void isa_bridge_interrupts_setup(void)
{
  pci_isa_bridge_device pci_dev;
  unsigned long temp;
  unsigned char tmp;
  unsigned char maxBus;
  unsigned found = 0;

  maxBus = BusCountPCI();
  pci_dev.function      = 0; /* Assumes the bidge is the first function */
     
  for (pci_dev.bus = 0; pci_dev.bus < maxBus; pci_dev.bus++) {
#ifdef SCAN_PCI_PRINT       
    printk("isa_bridge_interrupts_setup: Scanning bus %d\n", pci_dev.bus);
#endif       
    for (pci_dev.device = 0; pci_dev.device < PCI_MAX_DEVICES; pci_dev.device++) {
#ifdef SCAN_PCI_PRINT       
      printk("isa_bridge_interrupts_setup: Scanning device %d\n", pci_dev.device);
#endif       
      pci_read_config_dword(pci_dev.bus, pci_dev.device,  pci_dev.function,
                               PCI_VENDOR_ID, &temp);
#ifdef SCAN_PCI_PRINT       
      printk("Vendor/device = %x\n", temp);
#endif
      if ( (temp == (((unsigned short) PCI_VENDOR_ID_VIA) | (PCI_DEVICE_ID_VIA_82C586_1 << 16)))
           ||
           (temp == (((unsigned short) PCI_VENDOR_ID_VIA) | (PCI_DEVICE_ID_VIA_82C586_0 << 16)))
         ) {
        bridge = pci_dev;
        via_82c586 = &bridge;
        /*
         * Should print : bus = 0, device = 11, function = 0 on a MCP750.
         */
        printk("Via PCI/ISA bridge found at bus = %d, device = %d, function = %d\n",
               via_82c586->bus,
               via_82c586->device,
               via_82c586->function);
        found = 1;
        goto loop_exit;
           
      }
    }
  }
loop_exit:
  if (!found) BSP_panic("VIA_82C586 PCI/ISA bridge not found!n");
     
  tmp = inb(0x810);
  if  ( !(tmp & 0x2)) {
    printk("This is a second generation MCP750 board\n");
    printk("We must reprogram the PCI/ISA bridge...\n");
    pci_read_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                         0x47,  &tmp);
    printk(" PCI ISA bridge control2 = %x\n", (unsigned) tmp);
    /*
     * Enable 4D0/4D1 ISA interrupt level/edge config registers
     */
    tmp |= 0x20;
    pci_write_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                          0x47, tmp);
    /*
     * Now program the ISA interrupt edge/level
     */
    tmp = ELCRS_INT9_LVL | ELCRS_INT10_LVL | ELCRS_INT11_LVL;
    outb(tmp, ISA8259_S_ELCR);
    tmp = ELCRM_INT5_LVL;
    outb(tmp, ISA8259_M_ELCR);;
    /*
     * Set the Interrupt inputs to non-inverting level interrupt
     */
    pci_read_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                            0x54, &tmp);
    printk(" PCI ISA bridge PCI/IRQ Edge/Level Select = %x\n", (unsigned) tmp);
    tmp = 0;
    pci_write_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                          0x54, tmp);
  }
  else {
    printk("This is a first generation MCP750 board\n");
    printk("We just show the actual value used by PCI/ISA bridge\n");
    pci_read_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                         0x47,  &tmp);
    printk(" PCI ISA bridge control2 = %x\n", (unsigned) tmp);
    /*
     * Enable 4D0/4D1 ISA interrupt level/edge config registers
     */
    tmp |= 0x20;
    pci_write_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                          0x47, tmp);
    tmp = inb(ISA8259_S_ELCR);
    printk(" PCI ISA bridge slave edge/level control bit = %x\n", (unsigned) tmp);
    tmp = inb(ISA8259_M_ELCR);;
    printk(" PCI ISA bridge master edge/level control bit = %x\n", (unsigned) tmp);
    /*
     * Must disable the 4D0/4D1 ISA interrupt level/edge config registers
     * or the card will die a soon as we we will enable external interrupts
     */
    pci_read_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                         0x47,  &tmp);
    tmp &= ~(0x20);
    pci_write_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                          0x47, tmp);
    /*
     * Show the Interrupt inputs inverting/non-inverting level status
     */
    pci_read_config_byte(via_82c586->bus, via_82c586->device, via_82c586->function,
                         0x54, &tmp);
    printk(" PCI ISA bridge PCI/IRQ Edge/Level Select = %x\n", (unsigned) tmp);
  }
}

  /*
   * This code assumes the exceptions management setup has already
   * been done. We just need to replace the exceptions that will
   * be handled like interrupt. On mcp750/mpc750 this means the
   * decrementer exception and the external exception.
   */
void BSP_rtems_irq_mng_init(unsigned cpuId)
{
  rtems_raw_except_connect_data vectorDesc;
  int i;
  register unsigned int msr;
  
  /*
   * First initialize the Interrupt management hardware
   */
  OpenPIC_InitSenses = mcp750_openpic_initsenses;
  OpenPIC_NumInitSenses = sizeof(mcp750_openpic_initsenses) / sizeof(char);
  printk("Going to initialize raven interrupt controller (openpic compliant)\n");
  openpic_init(1);
  printk("Going to initialize the PCI/ISA bridge IRQ related setting (VIA 82C586)\n");
  isa_bridge_interrupts_setup();
  printk("Going to initialize the ISA PC legacy IRQ management hardware\n");
  BSP_i8259s_init();
  /*
   * Initialize Rtems management interrupt table
   */
    /*
     * re-init the rtemsIrq table
     */
    for (i = 0; i < BSP_IRQ_NUMBER; i++) {
      rtemsIrq[i]      = defaultIrq;
      rtemsIrq[i].name = i;
    }
    /*
     * Init initial Interrupt management config
     */
    initial_config.irqNb        = BSP_IRQ_NUMBER;
    initial_config.defaultEntry = defaultIrq;
    initial_config.irqHdlTbl    = rtemsIrq;
    initial_config.irqBase      = BSP_ASM_IRQ_VECTOR_BASE;
    initial_config.irqPrioTbl   = irqPrioTable;

    if (!BSP_rtems_irq_mngt_set(&initial_config)) {
      /*
       * put something here that will show the failure...
       */
      BSP_panic("Unable to initialize RTEMS interrupt Management!!! System locked\n");
    }
  
  /*
   * We must connect the raw irq handler for the two
   * expected interrupt sources : decrementer and external interrupts.
   */
    vectorDesc.exceptIndex      =       ASM_DEC_VECTOR;
    vectorDesc.hdl.vector       =       ASM_DEC_VECTOR;
    vectorDesc.hdl.raw_hdl      =       decrementer_exception_vector_prolog_code;
    vectorDesc.hdl.raw_hdl_size =       &decrementer_exception_vector_prolog_code_size;
    vectorDesc.on               =       nop_func;
    vectorDesc.off              =       nop_func;
    vectorDesc.isOn             =       connected;
    if (!mpc60x_set_exception (&vectorDesc)) {
      BSP_panic("Unable to initialize RTEMS decrementer raw exception\n");
    }
    vectorDesc.exceptIndex      =       ASM_EXT_VECTOR;
    vectorDesc.hdl.vector       =       ASM_EXT_VECTOR;
    vectorDesc.hdl.raw_hdl      =       external_exception_vector_prolog_code;
    vectorDesc.hdl.raw_hdl_size =       &external_exception_vector_prolog_code_size;
    if (!mpc60x_set_exception (&vectorDesc)) {
      BSP_panic("Unable to initialize RTEMS external raw exception\n");
    }
    printk("RTEMS IRQ management is now operationnal\n");
    printk("Going to enable interrupts at processor level\n");
    _CPU_MSR_GET(msr);
    msr = msr |= MSR_EE;
    _CPU_MSR_SET(msr);
    printk("Interrupts enabled\n");
}