Subversion Repositories openrisc

;******************** (C) COPYRIGHT 2005 STMicroelectronics ********************

;* File Name          : 91x_vect.s

;* Author             : MCD Application Team

;* Date First Issued  : 10/25/2005 :  Beta Version V0.1

;* Description        : This File used to initialize the exception and IRQ

;*                      vectors, and to enter/return to/from exceptions

;*                      handlers.

;*******************************************************************************

; History:

; 10/25/2005 :  Beta Version V0.1

;*******************************************************************************

; THE PRESENT SOFTWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS WITH

; CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME. AS

; A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT, INDIRECT

; OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE CONTENT

; OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING INFORMATION

; CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.

;******************************************************************************/

#include "FreeRTOSConfig.h"

#include "ISR_Support.h"

    MODULE      ?RESET

        COMMON  INTVEC:CODE(2)

        CODE32

    EXPORT LINK

VectorAddress                   EQU    0xFFFFF030  ; VIC Vector address register address.

VectorAddressDaisy              EQU    0xFC000030  ; Daisy VIC Vector address register

                                          ; address.

LINK                                    EQU    0x0

I_Bit                                   EQU    0x80 ; when I bit is set, IRQ is disabled

F_Bit                                   EQU    0x40 ; when F bit is set, FIQ is disabled

;*******************************************************************************

;                                  MACRO

;*******************************************************************************

;*******************************************************************************

;            Import  the __program_start address from 91x_init.s

;*******************************************************************************

        IMPORT  __program_start

;*******************************************************************************

;                      Import exception handlers

;*******************************************************************************

                IMPORT  vPortYieldProcessor             ; FreeRTOS SWI handler

;*******************************************************************************

;            Export Peripherals IRQ handlers table address

;*******************************************************************************

;*******************************************************************************

;                        Exception vectors

;*******************************************************************************

        LDR     PC, Reset_Addr

        LDR     PC, Undefined_Addr

        LDR     PC, SWI_Addr

        LDR     PC, Prefetch_Addr

        LDR     PC, Abort_Addr

        NOP                             ; Reserved vector

        LDR     PC, IRQ_Addr

        LDR     PC, FIQ_Addr

;*******************************************************************************

;               Exception handlers address table

;*******************************************************************************

Reset_Addr      DCD     __program_start

Undefined_Addr  DCD     UndefinedHandler

SWI_Addr        DCD     vPortYieldProcessor

Prefetch_Addr   DCD     PrefetchAbortHandler

Abort_Addr      DCD     DataAbortHandler

                DCD     0               ; Reserved vector

IRQ_Addr        DCD     IRQHandler

FIQ_Addr        DCD     FIQHandler

;*******************************************************************************

;                         Exception Handlers

;*******************************************************************************

; - NOTE -

; The IRQ and SWI handlers are the only managed exception.

UndefinedHandler

                b       UndefinedHandler

PrefetchAbortHandler

                b       PrefetchAbortHandler

DataAbortHandler

                b       DataAbortHandler

FIQHandler

                b       FIQHandler

DefaultISR

                b       DefaultISR

;*******************************************************************************

;* Function Name  : IRQHandler

;* Description    : This function called when IRQ exception is entered.

;* Input          : none

;* Output         : none

;*******************************************************************************

IRQHandler

        portSAVE_CONTEXT                                        ; Save the context of the current task.

        LDR    r0, = VectorAddress

        LDR    r0, [r0]                                         ; Read the routine address

        LDR    r1, = VectorAddressDaisy

        LDR    r1, [r1]

        MOV        lr, pc

        bx         r0

        LDR    r0, = VectorAddress                      ; Write to the VectorAddress to clear the

        STR    r0, [r0]                                         ; respective interrupt in the internal interrupt

        LDR    r1, = VectorAddressDaisy         ; Write to the VectorAddressDaisy to clear the

        STR    r1,[r1]                                          ; respective interrupt in the internal interrupt

        portRESTORE_CONTEXT                                     ; Restore the context of the selected task.

        LTORG

        END

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