/******************** (C) COPYRIGHT 2003 STMicroelectronics ********************
* File Name          : eic.c
* Author             : MCD Application Team
* Date First Issued  : 06/25/2003
* Description        : This file provides all the EIC software functions
********************************************************************************
* History:
*  01/01/2004 : V1.2
*  14/07/2004 : V1.3
*******************************************************************************/

#include "eic.h"

/*******************************************************************************
* Function Name  : EIC_Init
* Description    : Initialise the EIC using the load PC instruction
*                  (PC = PC +offset)
* Input          : None
* Output         : None
* Return         : None
*******************************************************************************/
void EIC_Init(void)
{
  extern u32 T0TIMI_Addr;
  u8 bCounter;
  u32 * p = (u32 *)& T0TIMI_Addr;  
//  u32 dOffset=((u32)&T0TIMI_Addr);
  u32 offset;
  EIC->ICR = 0x00000000; 
  EIC->IER = 0x00000000; 
  EIC->IPR = 0xFFFFFFFF; 
  EIC->FIR = 0x0000000C; 
  EIC->CIPR = 0x00000000; 
  
  EIC->IVR  = 0xEA000000; // IVR = high half of "B offset" instruction

  for (bCounter=0;bCounter<32;bCounter++)
    {
      offset = (((*p)&0xffff)+0x7E0) >> 2;
      p++;
      EIC->SIR[bCounter] = offset << 16;
    }
  }


void EIC_Init1(void)
{
  extern u32 T0TIMI_Addr;
  u8 bCounter; 
  u32 dOffset=((u32)&T0TIMI_Addr);
//  u32 offset;


  EIC->ICR = 0x00000000; // Disable FIQ and IRQ interrupts
  EIC->IER = 0x00000000; // Disable all channels interrupts
  EIC->IPR = 0xFFFFFFFF; // Clear all pending bits
  EIC->FIR = 0x0000000C; // Disable all FIQ channels interrupts and clear FIQ
                         // channels pending bits
  EIC->CIPR = 0x00000000; // Ste the current priority level to zero
  EIC->IVR  = 0xE59F0000; // IVR = high half of load PC instruction
  dOffset = (dOffset+0x00007E0)<<16;
  for(bCounter=0; bCounter<32; bCounter++) // Initialize SIRn registers
  {
    EIC->SIR[bCounter] = dOffset|0xF0000000;
    dOffset += 0x00000004 << 16;
  }
}

/*******************************************************************************
* Function Name  : EIC_CurrentPriorityLevelConfig
* Description    : Change the current priority level of the srved IRQ routine
* Input 1        : New priority
* Output         : None
* Return         : None
*******************************************************************************/
void EIC_CurrentPriorityLevelConfig(u8 NewPriorityLevel)
{
  u32 dVal;
  dVal = EIC->ICR;              // Save ICR content
  EIC->ICR &= ~0x0001;          // Disable IRQ interrupts.
  EIC->CIPR = NewPriorityLevel; // Change the current priority
  EIC->ICR = dVal;              // Restore ICR content
}

/******************* (C) COPYRIGHT 2003 STMicroelectronics *****END OF FILE****/