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:         STUPi_DbgHandler

  Description:  Debug (FIQ, etc) handler

  Arguments:    None

  Returns:      None.
 *---------------------------------------------------------------------------*/
asm void STUPi_DbgHandler( 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:         STUPi_IrqVeneer

  Description:  IRQ veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_FiqVeneer

  Description:  FIQ veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_PrefetchAbortVeneer

  Description:  Prefetch Abort veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_DataAbortVeneer

  Description:  Data Abort veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_UndefInstVeneer

  Description:  Undefine Instruction veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_SwiVeneer

  Description:  SWI veneer

  Arguments:    None

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

        LTORG
}

/*---------------------------------------------------------------------------*
  Name:         STUPi_SwiHandler

  Description:  SWI handler

  Arguments:    None

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

asm void STUPi_SwiHandler( 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     STUPi_SwiSemihosting

        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>
}