isr.c

ARM开发代码以及bootloader的初始化程序参考

#include <stdio.h>
#include <ctype.h>
#include <string.h>
#include "s3c4510.h"
#include "isr.h"
#include "uart.h"
//#include "pollio.h"
#include "sysconf.h"

volatile U32  IntOffSet;
/***************************************************************/
/* Dummy Function Prototype for Interrupt Service Vector Table */
/***************************************************************/
static void DummyIsr(void) {}

void (*InterruptHandlers[MAXHNDLRS])(void);

void ClrIntStatus(void)
{
    INTMASK = 0x3fffff;  // All interrupt disabled include global bit
    INTPEND = 0x1fffff;  // All clear pending
    INTMODE = 0x1fffff;  // All FIQ mode

    /* 
     * Interrupt Priority Reset value. Need to be changed priority,
     * Set interrupt priority register. In this case, Global interrupt
     * mask bit must be disabled.
     *
     */ 
    //INTPRI0 = 0x03020100;  
    //INTPRI1 = 0x07060504;
    //INTPRI2 = 0x0b0a0908;
    //INTPRI3 = 0x0f0e0d0c;
    //INTPRI4 = 0x13121110;
    //INTPRI5 = 0x00000014;
    //INTOFFSET =  Read Only Register
}


/******************************************/
/****    Exception Handler Function    ****/
/******************************************/
void	ISR_UndefHandler(REG32 *adr)
{
	//Print("\n** Trap : Undefined Handler\n") ;
	Print("\r\nUndefined Address : %08x ",adr);
	Print("\r\nUndefined Data : %08x ",*adr);
}

void	ISR_PrefetchHandler(REG32 *adr)
{
	//Print("\n** Trap : Prefetch Abort Handler\n") ;
	Print("\r\nPrefetch Abort Address : %08x ",adr);
	Print("\r\nPrefetch Abort Data : %08x ",*adr);
}

void	ISR_AbortHandler(REG32 *adr)
{
	//Print("\n** Trap : Data Abort Handler\n") ;
	Print("\r\nData Abort Address : %08x ",adr);
	Print("\r\nData Abort Data : %08x ",*adr);
}

void	ISR_SwiHandler(void)
{
	Print("\r\n** Trap : SWI Handler\n") ;
}


void	ISR_IrqHandler(void)
{
        IntOffSet = (U32)INTOFFSET;
// 	printf("\r\n** Trap INT_%d: IRQ Handler\n", IntOffSet>>2) ;
 	
 	Clear_PendingBit(IntOffSet>>2) ;
       (*InterruptHandlers[IntOffSet>>2])(); // Call interrupt service routine
	
}


void	ISR_FiqHandler(void)
{
	Print("\r\n** Trap : FIQ Handler\n") ;
       IntOffSet = (U32)INTOFFSET;
       Clear_PendingBit(IntOffSet>>2) ;
       (*InterruptHandlers[IntOffSet>>2])(); // Call interrupt service routine
}


/***********************************************************************/
/* InitIntHandlerTable: Initialize the interrupt handler table         */
/*     NOTE(S): This should be called during system initialization     */
/***********************************************************************/
void InitIntHandlerTable(void)
{
	REG32 i;
 
	for (i = 0; i < MAXHNDLRS; i++)
    		InterruptHandlers[i] = DummyIsr;
}

/*********************************************************/
/* SysSetInterrupt: Setup Interrupt Handler Vector Table */
/*********************************************************/
void SysSetInterrupt(REG32 vector, void (*handler)())
{
	InterruptHandlers[vector] = handler;

}

/*********************************************************/
/* InitInterrupt: Initialize Interrupt		 */
/*********************************************************/
void InitInterrupt(void) 
{
        ClrIntStatus();         // Clear All interrupt 
	InitIntHandlerTable() ;
}


/*  =================================================
 *  Monitoring the interrupt related system register
 *  =================================================
 */
void IntConfig(void)
{

        Print("\n========================================\r\n");
        Print(">>  Interrupt Status configurations. <<\r\n");
        Print("========================================\r\n");

        Print(">>INTMODE[0x%08x] = 0x%08x\r\n", &INTMODE,INTMODE);
        Print(">>INTPEND[0x%08x] = 0x%08x\r\n", &INTPEND,INTPEND);
        Print(">>INTMASK[0x%08x] = 0x%08x\r\n", &INTMASK,INTMASK);
        Print(">>INTPRI0[0x%08x] = 0x%08x\r\n", &INTPRI0,INTPRI0);
        Print(">>INTPRI1[0x%08x] = 0x%08x\r\n", &INTPRI1,INTPRI1);
        Print(">>INTPRI2[0x%08x] = 0x%08x\r\n", &INTPRI2,INTPRI2);
        Print(">>INTPRI3[0x%08x] = 0x%08x\r\n", &INTPRI3,INTPRI3);
        Print(">>INTPRI4[0x%08x] = 0x%08x\r\n", &INTPRI4,INTPRI4);
        Print(">>INTPRI5[0x%08x] = 0x%08x\r\n", &INTPRI5,INTPRI5);
        Print(">>INTOFFSET[0x%08x] = 0x%08x\r\n", &INTOFFSET,INTOFFSET);
        Print("========================================\r\n\r\n\r\n");
}


/*  =================================================
 *   Set interrupt priority function
 *  =================================================
 */

#define nPRIREG  6
void SetPriority(void)
{
     int pReg;
     int bCnt;
     int nPri;
     U32 rINTPRI;
     volatile unsigned int *pINTPRI[6] = {
                &INTPRI0,
                &INTPRI1,
                &INTPRI2,
                &INTPRI3,
                &INTPRI4,
                &INTPRI5
     };
     
     
     ClrIntStatus();  // Clear All interrupt 

     /* Clear Interrupt priority register */
     for(pReg=0;pReg<nPRIREG;pReg++) { 
          *pINTPRI[pReg] = 0x0;
     }

     Print("\r\n\r\nAssign Interrupt source to priority!");
     Print("\r\n>Interrupt source index is two hexdigit.\r\n\r\n");

     for(pReg=0,nPri=0;pReg<nPRIREG;pReg++) {
         for(bCnt=0;(bCnt<4)&&(nPri<MAXHNDLRS); bCnt++,nPri++) {
              Print("\r\nInterrupt Priority %d = ",nPri);
              rINTPRI = gethex2dec(2); get_byte();
              *pINTPRI[pReg] |= (rINTPRI <<(bCnt*8)); 
         }
     }
}


void SetIntMode(void)
{
    U32 rINTMASK;
    U32 rINTPEND;
    U32 rINTMODE;
    
    INTMASK = 0x3fffff;  // All interrupt disabled include global bit
    INTMODE = 0x1fffff;  // All FIQ mode

    Print("\r\n> Set INTMODE register[6 hexdigit]_");
    rINTMODE = gethex2dec(6); get_byte();
    Print("\r\n  - INTMODE input is 0x%08x\r\n",rINTMODE);

    Print("\r\n> Set INTMASK register[6 hexdigit]_");
    rINTMASK = gethex2dec(6); get_byte();
    Print("\r\n  - INTMASK input is 0x%08x\r\n",rINTMASK);

    INTMODE = rINTMODE;
    INTPEND = 0x1fffff;  // All clear pending
    INTMASK = rINTMASK;
    Print("\r\nAll interrupt pending cleared!!!\r\n\r\n");
}