source: rtems/bsps/powerpc/mvme3100/irq/irq_init.c

/* irq_init.c
 *
 *  This file contains the implementation of rtems initialization
 *  related to interrupt handling.
 *
 *  CopyRight (C) 1999 valette@crf.canon.fr
 *
 * Enhanced by Jay Kulpinski <jskulpin@eng01.gdds.com>
 * to make it valid for MVME2300 Motorola boards.
 *
 * Till Straumann <strauman@slac.stanford.edu>, 12/20/2001:
 * Use the new interface to openpic_init
 *
 * Adapted for the mvme3100 BSP by T. Straumann, 2007.
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.org/license/LICENSE.
 */

#include <libcpu/io.h>
#include <bsp/pci.h>
#include <bsp/openpic.h>
#include <bsp/irq.h>
#include <bsp.h>
#include <bsp/vectors.h>
#include <rtems/bspIo.h>

static void nop_func(void *unused)
{
        printk("Unhandled IRQ\n");
}

static rtems_irq_connect_data           rtemsIrq[BSP_IRQ_NUMBER];
static rtems_irq_global_settings    initial_config;
static rtems_irq_connect_data           defaultIrq = {
  /* vectorIdex,         hdl            , handle        , on            , off           , isOn */
  0,                     nop_func       , NULL          , 0     , 0     , 0
};

static rtems_irq_prio irqPrioTable[BSP_IRQ_NUMBER]={
  /*
   * actual priorities for interrupt :
   *    0   means that only current interrupt is masked
   *    255 means all other interrupts are masked
   */
  /*
   * PCI Interrupts
   */
  8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8,             /* for raven prio 0 means unactive... */
  8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, /* for raven prio 0 means unactive... */
  8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, /* for raven prio 0 means unactive... */
  /*
   * Processor exceptions handled as interrupts
   */
  0
};

  /*
   * 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 and many PPC processors
   * this means the decrementer exception and the external exception.
   */
void BSP_rtems_irq_mng_init(unsigned cpuId)
{
        /* We should really have a way to find the number of sources
         * the driver will use so that the size of the polarity-array
         * matches the driver's idea of it.
         */
        unsigned char pol[56];
        int i;

        /* Note: The openpic driver initializes only as many
         *       'pic-external' interrupt sources as reported
         *       by the feature register.
         *       The 8540's openpic supports 12 core-external
         *       and 23 core-internal (both of these groups
         *       are external to the PIC, i.e., 'pic-external')
         *       interrupts but between the corresponding
         *       banks of vector/priority registers there is
         *       a gap leaving space for 4 (unsupported) irqs.
         *       The driver, not knowing of this gap, would
         *       initialize the 12 core-external sources
         *       followed by 4 unsupported sources and 19
         *       core-internal sources thus leaving the last
         *       four core-internal sources uninitialized.
         *       Luckily, the feature register reports
         *       too many sources:
         *          - the 4 IPI plus 4 timer plus 4 messaging
         *            sources are included with the count
         *          - there are unused core-internal sources 24..32
         *            which are also supported by the pic
         *       bringing the reported number of sources to
         *       a count of 56 (12+32+4+4+4) which is enough
         *       so that all pic-external sources are covered
         *       and initialized.
         *
         *       NOTE: All core-internal sources are active-high.
         *             The manual says that setting the polarity
         *             to 'low/0' will disable the interrupt but
         *             I found this not to be true: on the device
         *             I tested the interrupt was asserted hard.
         */

        /* core-external sources on the mvme3100 are active-low,
         * core-internal sources are active high.
         */
        for (i=0; i<BSP_EXT_IRQ_NUMBER; i++)
                pol[i]=0;
        for (i=BSP_EXT_IRQ_NUMBER; i< BSP_EXT_IRQ_NUMBER + BSP_CORE_IRQ_NUMBER; i++)
                pol[i]=1;

        openpic_init(1, pol, 0, 0, 0, 0);

        /*
         * 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_LOWEST_OFFSET;
        initial_config.irqPrioTbl       = irqPrioTable;

        if (!BSP_rtems_irq_mngt_set(&initial_config)) {
                /*
                 * put something here that will show the failure...
                 */
                rtems_panic("Unable to initialize RTEMS interrupt Management!!! System locked\n");
        }
}