ctr_firmware/trunk/bootrom/build/libraries/init/common/crt0_excp.c

/*---------------------------------------------------------------------------*
  Project:  CtrBrom - library - init
  File:     crt0_excpHandler.c

  Copyright 2008 Nintendo.  All rights reserved.

  These coded instructions, statements, and computer programs contain
  proprietary information of Nintendo of America Inc. and/or Nintendo
  Company Ltd., and are protected by Federal copyright law.  They may
  not be disclosed to third parties or copied or duplicated in any form,
  in whole or in part, without the prior written consent of Nintendo.

  $Date::            $
  $Rev$
  $Author$
 *---------------------------------------------------------------------------*/
#include <brom/code32.h>
#include <brom/os.h>
#include <brom/swi.h>


/*---------------------------------------------------------------------------*
  Name:         stupInitExceptions

  Description:  Initialize Exceptions

  Arguments:    None

  Returns:      None
 *---------------------------------------------------------------------------*/
ASM void stupInitExceptions( void )
{
        ldr     r3, =HW_SWI_VENEER_BUF
        ldr     r2, =i_stupSwiVeneerCode
        ldm     r2, {r0-r1}
        stm     r3, {r0-r1}
        bx      lr

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_osIrqVeneer

  Description:  Interrupt Vevver

  Arguments:    None

  Returns:      None
 *---------------------------------------------------------------------------*/
ASM void i_stupSwiVeneerCode( void )
{
        ldr     pc, =i_stupSwiHandler
        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupDbgHandler

  Description:  Debug (FIQ, etc) handler

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupDbgHandler( void )
{
        mrs		sp, cpsr                        // IRQ/FIQ•s‹–‰Â
        orr		sp, sp, #HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
        msr		cpsr_cxsf, sp

dbg_m
        b       dbg_m

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupIrqVeneer

  Description:  IRQ veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupIrqVeneer( void )
{
        ldr     pc, =HW_INTR_VENEER_BUF

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupFiqVeneer

  Description:  FIQ veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupFiqVeneer( void )
{
        ldr     pc, =HW_FIQ_VENEER_BUF

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupPrefetchAbortVeneer

  Description:  Prefetch Abort veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupPrefetchAbortVeneer( void )
{
        ldr     pc, =HW_IABT_VENEER_BUF

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupDataAbortVeneer

  Description:  Data Abort veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupDataAbortVeneer( void )
{
        ldr     pc, =HW_DABT_VENEER_BUF

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupUndefInstVeneer

  Description:  Undefine Instruction veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupUndefInstVeneer( void )
{
        ldr     pc, =HW_UDEF_VENEER_BUF

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         i_stupSwiVeneer

  Description:  SWI veneer

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupSwiVeneer( void )
{
        ldr     pc, =HW_SWI_VENEER_BUF

        LTORG
}


/*---------------------------------------------------------------------------*
  Name:         i_stupSwiHandler

  Description:  SWI handler

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
ASM void i_stupSwiSemihosting( void )
{
        ldmfd	sp!, {r11, r12, lr}
semi_vector
        movs	pc, lr
}

ASM void i_stupSwiHandler( void )
{
        INASM_EXTERN( _start )

        stmfd	sp!, {r11, r12, lr}             // SVCƒ‚<C692>[ƒh ƒŒƒWƒXƒ^‘Þ”ð
        ldrh	r12, [lr, #-2]                  // ƒVƒXƒeƒ€ƒR<C692>[ƒ‹NoŽæ“¾<E2809C>iƒn<C692>[ƒtƒ<74><C692>[ƒhƒAƒNƒZƒX‘Ήž<E280B0>j
        mov     r12, r12, lsl #1
        and		r12, r12, #SVC_ID_PREMASK<<SVC_ID_SHIFT

        cmp     r12, #(SVC_ID_SEMIHOST_ARM   & SVC_ID_PREMASK)<<SVC_ID_SHIFT  // SVC_ID_SEMIHOST_ARM   = 0x12
        cmpne   r12, #(SVC_ID_SEMIHOST_THUMB & SVC_ID_PREMASK)<<SVC_ID_SHIFT  // SVC_ID_SEMIHOST_THUMB = 0xab
        beq     i_stupSwiSemihosting

        adr		r11, SWI_Table                  // ƒVƒXƒeƒ€ƒR<C692>[ƒ‹ƒAƒhƒŒƒX Žæ“¾
        ldrh	r12, [r11, r12]

        ldr     r11, =HW_BROM
        orr     r12, r12, r11

        mrs		r11, spsr                       // SVCƒ‚<C692>[ƒh SPSR‘Þ”ð<E2809D>i<EFBFBD>‡Œv4ƒ<34><C692>[ƒh<C692>j
        stmfd	sp!, {r11}

        and		r11, r11, #HW_PSR_IRQ_DISABLE   // IRQ‹–‰Â<E280B0>ó‘Ô ƒRƒs<C692>[
        orr		r11, r11, #HW_PSR_SYS_MODE      // ƒVƒXƒeƒ€ƒ‚<C692>[ƒh‚Ö<E2809A>؂芷‚¦ & FIQ‹–‰Â
        msr		cpsr_cxsf,r11

        stmfd	sp!, {r2, lr}                   // ƒVƒXƒeƒ€ƒ‚<C692>[ƒh ƒŒƒWƒXƒ^‘Þ”ð<E2809D>i2ƒ<32><C692>[ƒh<C692>j
        blx		r12

swi_return
        ldmfd	sp!, {r2, lr}                   // ƒVƒXƒeƒ€ƒ‚<C692>[ƒh Ú¼Þ½À•œ‹A
        mov		r12, #0xc0 | HW_PSR_SVC_MODE    // SVCƒ‚<C692>[ƒh‚Ö<E2809A>؂芷‚¦
        msr		cpsr_cxsf, r12                  //   & IRQ/FIQ•s‹–‰Â

        ldmfd	sp!, {r11}                      // SVCƒ‚<C692>[ƒh ƒŒƒWƒXƒ^•œ‹A
        msr		spsr_cxsf, r11

semi_return
        ldmfd	sp!, {r11, r12, lr}
        movs	pc, lr

        LTORG

#include <../build/libraries/swi/common/swi_table.c>
}