Subversion Repositories or1k

/* bsp_irq_asm.S

 *

 *  This file contains the implementation of the IRQ handler

 *  for a specific BSP

 *

 *  CopyRight (C) 2000 Canon Research France SA.

 *  Emmanuel Raguet,  mailto:raguet@crf.canon.fr

 *

 *  The license and distribution terms for this file may be

 *  found in found in the file LICENSE in this distribution or at

 *  http://www.OARcorp.com/rtems/license.html.

 *

 */

#define __asm__

#include  

/*

 * Function to obtain, execute an IT handler and acknowledge the IT

 */

        .globl ExecuteITHandler

ExecuteITHandler :

  ldr   r0, =INTPHAI3            /* read the vector number */

  ldr   r0, [r0]

  ldr   r0, [r0]                /* extract the IT handler @ */

  /*

   * re-enable interrupts at processor level as the current

   * interrupt source is now masked via VEGA logic

   */

  mrs   r1, cpsr

  and   r1, r1, #0xFFFFFF3F

  msr   cpsr, r1

  stmdb   sp!,{lr}

  ldr     lr, =IRQ_return         /* prepare the return from handler  */

  mov     pc, r0                        /* EXECUTE INT HANDLER */

IRQ_return:

  ldmia sp!,{lr}

  ldr   r2, =INTSTAT3           /* Ack the interrupt */

  ldr   r2, [r2]

  ldr   r1, =INTACK3

  str   r2, [r1]

  /*

   * disable interrupts_again and switch back to SVC mode

   */

  mrs   r0, cpsr

  orr   r0, r0, #0xc3

  msr   cpsr, r0

  mov pc, lr

/*

 * Function to acknowledge the IT controller

 */

        .globl AckControler

#if 0

AckControler:

  ldr   r0, =INTEOI3

  mov   r1, #EOI

  str   r1, [r0]

  b     ReturnFromAck           /* return to ISR handler */

#endif