forked from Imagelibrary/rtems
Remove (Abandoned).
This commit is contained in:
@@ -1,80 +0,0 @@
|
||||
#
|
||||
# $Id$
|
||||
#
|
||||
|
||||
There are various issues regarding this port:
|
||||
|
||||
|
||||
|
||||
1) Legal
|
||||
|
||||
This port is written by Andrew Bray <andy@i-cubed.co.uk>, and
|
||||
is copyright 1995 i-cubed ltd.
|
||||
|
||||
This port was later updated by Joel Sherrill <joel@OARcorp.com>
|
||||
to test the support for the PPC603, PPC603e, and MPC604. This
|
||||
was tested on the PowerPC simulator PSIM and a VMEbus single board
|
||||
computer.
|
||||
|
||||
2) CPU support.
|
||||
|
||||
This release fully supports the PPC403GA, PPC403GB, PPC603, PPC603e,
|
||||
MPC604, MPC750, and numerous MPC8xx processors. A good faith attempt
|
||||
has been made to include support other models based upon available
|
||||
documentation including the MPC5xx. There are two interrupt structures
|
||||
supported by the PowerPC port. The newer structure is supported by
|
||||
all the MPC750 and MPC604 BSPs. This structure is required to use
|
||||
the RDBG remote debugging support.
|
||||
|
||||
This port was originally written and tested on the PPC403GA (using
|
||||
software floating point). Current ports are tested primarily on
|
||||
60x CPUs using the PowerPC simulator PSIM.
|
||||
|
||||
Andrew Bray received assistance during the initial porting effort
|
||||
from IBM and Blue Micro and we would like to gratefully acknowledge
|
||||
that help.
|
||||
|
||||
The support for the PPC602 processor is incomplete as only sketchy
|
||||
data is currently available. Perhaps this model has been dropped.
|
||||
|
||||
3) Application Binary Interface
|
||||
|
||||
In the context of RTEMS, the ABI is of interest for the following
|
||||
aspects:
|
||||
|
||||
a) Register usage. Which registers are used to provide static variable
|
||||
linkage, stack pointer etc.
|
||||
|
||||
b) Function calling convention. How parameters are passed, how function
|
||||
variables should be invoked, how values are returned, etc.
|
||||
|
||||
c) Stack frame layout.
|
||||
|
||||
I am aware of a number of ABIs for the PowerPC:
|
||||
|
||||
a) The PowerOpen ABI. This is the original Power ABI used on the RS/6000.
|
||||
This is the only ABI supported by versions of GCC before 2.7.0.
|
||||
|
||||
b) The SVR4 ABI. This is the ABI defined by SunSoft for the Solaris port
|
||||
to the PowerPC.
|
||||
|
||||
c) The Embedded ABI. This is an embedded ABI for PowerPC use, which has no
|
||||
operating system interface defined. It is promoted by SunSoft, Motorola,
|
||||
and Cygnus Support. Cygnus are porting the GNU toolchain to this ABI.
|
||||
|
||||
d) GCC 2.7.0. This compiler is partway along the road to supporting the EABI,
|
||||
but is currently halfway in between.
|
||||
|
||||
This port was built and tested using the PowerOpen ABI, with the following
|
||||
caveat: we used an ELF assembler and linker. So some attention may be
|
||||
required on the assembler files to get them through a traditional (XCOFF)
|
||||
PowerOpen assembler.
|
||||
|
||||
This port contains support for the other ABIs, but this may prove to be
|
||||
incomplete as it is untested.
|
||||
|
||||
The RTEMS PowerPC port supports EABI as the primary ABI. The powerpc-rtems
|
||||
GNU toolset configuration is EABI.
|
||||
|
||||
Andrew Bray, 4 December 1995
|
||||
Joel Sherrill, 16 July 1997
|
||||
@@ -1,8 +0,0 @@
|
||||
#
|
||||
# $Id$
|
||||
#
|
||||
|
||||
Todo list:
|
||||
|
||||
Maybe decode external interrupts like the HPPA does.
|
||||
See c/src/lib/libcpu/powerpc/ppc403/ictrl/* for implementation on ppc403
|
||||
@@ -1,860 +0,0 @@
|
||||
/*
|
||||
* PowerPC CPU Dependent Source
|
||||
*
|
||||
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
||||
*
|
||||
* COPYRIGHT (c) 1995 by i-cubed ltd.
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of i-cubed limited not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* i-cubed limited makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* Derived from c/src/exec/cpu/no_cpu/cpu.c:
|
||||
*
|
||||
* COPYRIGHT (c) 1989-2007.
|
||||
* On-Line Applications Research Corporation (OAR).
|
||||
*
|
||||
* The license and distribution terms for this file may be found in
|
||||
* the file LICENSE in this distribution or at
|
||||
* http://www.rtems.com/license/LICENSE.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
#include <bsp.h>
|
||||
#include <rtems/system.h>
|
||||
#include <rtems/score/isr.h>
|
||||
#include <rtems/score/context.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/score/interr.h>
|
||||
|
||||
#include <rtems/powerpc/cache.h>
|
||||
#include <rtems/powerpc/powerpc.h>
|
||||
|
||||
/*
|
||||
* These are for testing purposes.
|
||||
*/
|
||||
|
||||
/* _CPU_Initialize
|
||||
*
|
||||
* This routine performs processor dependent initialization.
|
||||
*
|
||||
* INPUT PARAMETERS:
|
||||
* cpu_table - CPU table to initialize
|
||||
* thread_dispatch - address of disptaching routine
|
||||
*/
|
||||
|
||||
static void ppc_spurious(int, CPU_Interrupt_frame *);
|
||||
|
||||
int _CPU_spurious_count = 0;
|
||||
int _CPU_last_spurious = 0;
|
||||
|
||||
/* This variable is initialized to 'TRUE' by default;
|
||||
* BSPs which have their vectors in ROM should set it
|
||||
* to FALSE prior to initializing raw exceptions.
|
||||
*
|
||||
* I suspect the only candidate is the simulator.
|
||||
* After all, the value of this variable is used to
|
||||
* determine where to install the prologue code and
|
||||
* installing to ROM on anyting that's real ROM
|
||||
* will fail anyways.
|
||||
*
|
||||
* This should probably go away... (T.S. 2007/11/30)
|
||||
*/
|
||||
boolean bsp_exceptions_in_RAM = TRUE;
|
||||
|
||||
void _CPU_Initialize(
|
||||
void (*thread_dispatch) /* ignored on this CPU */
|
||||
)
|
||||
{
|
||||
#if (PPC_USE_SPRG)
|
||||
int i;
|
||||
#endif
|
||||
register uint32_t r2 = 0;
|
||||
register uint32_t r13 = 0;
|
||||
|
||||
asm ("mr %0,13" : "=r" ((r13)) : "0" ((r13)));
|
||||
_CPU_IRQ_info.Default_r13 = r13;
|
||||
|
||||
asm ("mr %0,2" : "=r" ((r2)) : "0" ((r2)));
|
||||
_CPU_IRQ_info.Default_r2 = r2;
|
||||
|
||||
_CPU_IRQ_info.Nest_level = &_ISR_Nest_level;
|
||||
_CPU_IRQ_info.Disable_level = &_Thread_Dispatch_disable_level;
|
||||
/* fill in _CPU_IRQ_info.Vector_table later */
|
||||
_CPU_IRQ_info.Switch_necessary = &_Context_Switch_necessary;
|
||||
_CPU_IRQ_info.Signal = &_ISR_Signals_to_thread_executing;
|
||||
|
||||
#if (PPC_USE_SPRG)
|
||||
i = (int)&_CPU_IRQ_info;
|
||||
asm volatile("mtspr 0x113, %0" : "=r" (i) : "0" (i)); /* SPRG 3 */
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Store Msr Value in the IRQ info structure.
|
||||
*/
|
||||
_CPU_MSR_GET(_CPU_IRQ_info.msr_initial);
|
||||
|
||||
#if (PPC_USE_SPRG)
|
||||
i = _CPU_IRQ_info.msr_initial;
|
||||
asm volatile("mtspr 0x112, %0" : "=r" (i) : "0" (i)); /* SPRG 2 */
|
||||
#endif
|
||||
}
|
||||
|
||||
/*
|
||||
* _CPU_Initialize_vectors()
|
||||
*
|
||||
* Support routine to initialize the RTEMS vector table after it is allocated.
|
||||
*
|
||||
* PowerPC Specific Information:
|
||||
*
|
||||
* Complete initialization since the table is now allocated.
|
||||
*/
|
||||
|
||||
void _CPU_Initialize_vectors(void)
|
||||
{
|
||||
int i;
|
||||
proc_ptr handler = (proc_ptr)ppc_spurious;
|
||||
extern void (*bsp_spurious_handler)(uint32_t vector, CPU_Interrupt_frame *);
|
||||
|
||||
_CPU_IRQ_info.Vector_table = _ISR_Vector_table;
|
||||
|
||||
if ( bsp_spurious_handler )
|
||||
handler = (proc_ptr)bsp_spurious_handler;
|
||||
|
||||
for (i = 0; i < PPC_INTERRUPT_MAX; i++)
|
||||
_ISR_Vector_table[i] = handler;
|
||||
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_ISR_Calculate_level
|
||||
*
|
||||
* The PowerPC puts its interrupt enable status in the MSR register
|
||||
* which also contains things like endianness control. To be more
|
||||
* awkward, the layout varies from processor to processor. This
|
||||
* is why it was necessary to adopt a scheme which allowed the user
|
||||
* to specify specifically which interrupt sources were enabled.
|
||||
*/
|
||||
|
||||
uint32_t _CPU_ISR_Calculate_level(
|
||||
uint32_t new_level
|
||||
)
|
||||
{
|
||||
register uint32_t new_msr = 0;
|
||||
|
||||
/*
|
||||
* Set the critical interrupt enable bit
|
||||
*/
|
||||
|
||||
#if (PPC_HAS_RFCI)
|
||||
if ( !(new_level & PPC_INTERRUPT_LEVEL_CE) )
|
||||
new_msr |= PPC_MSR_CE;
|
||||
#endif
|
||||
|
||||
if ( !(new_level & PPC_INTERRUPT_LEVEL_ME) )
|
||||
new_msr |= PPC_MSR_ME;
|
||||
|
||||
if ( !(new_level & PPC_INTERRUPT_LEVEL_EE) )
|
||||
new_msr |= PPC_MSR_EE;
|
||||
|
||||
return new_msr;
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_ISR_Set_level
|
||||
*
|
||||
* This routine sets the requested level in the MSR.
|
||||
*/
|
||||
|
||||
void _CPU_ISR_Set_level(
|
||||
uint32_t new_level
|
||||
)
|
||||
{
|
||||
register uint32_t tmp = 0;
|
||||
register uint32_t new_msr;
|
||||
|
||||
new_msr = _CPU_ISR_Calculate_level( new_level );
|
||||
|
||||
asm volatile (
|
||||
"mfmsr %0; andc %0,%0,%1; and %2, %2, %1; or %0, %0, %2; mtmsr %0" :
|
||||
"=&r" ((tmp)) :
|
||||
"r" ((PPC_MSR_DISABLE_MASK)), "r" ((new_msr)), "0" ((tmp))
|
||||
);
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_ISR_Get_level
|
||||
*
|
||||
* This routine gets the current interrupt level from the MSR and
|
||||
* converts it to an RTEMS interrupt level.
|
||||
*/
|
||||
|
||||
uint32_t _CPU_ISR_Get_level( void )
|
||||
{
|
||||
uint32_t level = 0;
|
||||
uint32_t msr;
|
||||
|
||||
asm volatile("mfmsr %0" : "=r" ((msr)));
|
||||
|
||||
msr &= PPC_MSR_DISABLE_MASK;
|
||||
|
||||
/*
|
||||
* Set the critical interrupt enable bit
|
||||
*/
|
||||
|
||||
#if (PPC_HAS_RFCI)
|
||||
if ( !(msr & PPC_MSR_CE) )
|
||||
level |= PPC_INTERRUPT_LEVEL_CE;
|
||||
#endif
|
||||
|
||||
if ( !(msr & PPC_MSR_ME) )
|
||||
level |= PPC_INTERRUPT_LEVEL_ME;
|
||||
|
||||
if ( !(msr & PPC_MSR_EE) )
|
||||
level |= PPC_INTERRUPT_LEVEL_EE;
|
||||
|
||||
return level;
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_Context_Initialize
|
||||
*/
|
||||
|
||||
void _CPU_Context_Initialize(
|
||||
Context_Control *the_context,
|
||||
uint32_t *stack_base,
|
||||
uint32_t size,
|
||||
uint32_t new_level,
|
||||
void *entry_point,
|
||||
boolean is_fp
|
||||
)
|
||||
{
|
||||
uint32_t msr_value;
|
||||
uint32_t sp;
|
||||
|
||||
sp = (uint32_t)stack_base + size - PPC_MINIMUM_STACK_FRAME_SIZE;
|
||||
*((uint32_t*)sp) = 0;
|
||||
the_context->gpr1 = sp;
|
||||
|
||||
the_context->msr = _CPU_ISR_Calculate_level( new_level );
|
||||
|
||||
/*
|
||||
* The FP bit of the MSR should only be enabled if this is a floating
|
||||
* point task. Unfortunately, the vfprintf_r routine in newlib
|
||||
* ends up pushing a floating point register regardless of whether or
|
||||
* not a floating point number is being printed. Serious restructuring
|
||||
* of vfprintf.c will be required to avoid this behavior. At this
|
||||
* time (7 July 1997), this restructuring is not being done.
|
||||
*/
|
||||
|
||||
/*if ( is_fp ) */
|
||||
the_context->msr |= PPC_MSR_FP;
|
||||
|
||||
/*
|
||||
* Calculate the task's MSR value:
|
||||
*
|
||||
* + Set the exception prefix bit to point to the exception table
|
||||
* + Force the RI bit
|
||||
* + Use the DR and IR bits
|
||||
*/
|
||||
_CPU_MSR_GET( msr_value );
|
||||
the_context->msr |= (msr_value & PPC_MSR_EP);
|
||||
#if defined(PPC_MSR_RI)
|
||||
the_context->msr |= PPC_MSR_RI;
|
||||
#endif
|
||||
the_context->msr |= msr_value & (PPC_MSR_DR|PPC_MSR_IR);
|
||||
|
||||
#if (PPC_ABI == PPC_ABI_SVR4)
|
||||
{ unsigned r13 = 0;
|
||||
asm volatile ("mr %0, 13" : "=r" ((r13)));
|
||||
|
||||
the_context->pc = (uint32_t)entry_point;
|
||||
the_context->gpr13 = r13;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if (PPC_ABI == PPC_ABI_EABI)
|
||||
{ uint32_t r2 = 0;
|
||||
unsigned r13 = 0;
|
||||
asm volatile ("mr %0,2; mr %1,13" : "=r" ((r2)), "=r" ((r13)));
|
||||
|
||||
the_context->pc = (uint32_t)entry_point;
|
||||
the_context->gpr2 = r2;
|
||||
the_context->gpr13 = r13;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
/* _CPU_ISR_install_vector
|
||||
*
|
||||
* This kernel routine installs the RTEMS handler for the
|
||||
* specified vector.
|
||||
*
|
||||
* Input parameters:
|
||||
* vector - interrupt vector number
|
||||
* old_handler - former ISR for this vector number
|
||||
* new_handler - replacement ISR for this vector number
|
||||
*
|
||||
* Output parameters: NONE
|
||||
*
|
||||
*/
|
||||
|
||||
void _CPU_ISR_install_vector(
|
||||
uint32_t vector,
|
||||
proc_ptr new_handler,
|
||||
proc_ptr *old_handler
|
||||
)
|
||||
{
|
||||
proc_ptr ignored;
|
||||
extern void (*bsp_spurious_handler)(uint32_t vector, CPU_Interrupt_frame *);
|
||||
|
||||
*old_handler = _ISR_Vector_table[ vector ];
|
||||
|
||||
/*
|
||||
* If the interrupt vector table is a table of pointer to isr entry
|
||||
* points, then we need to install the appropriate RTEMS interrupt
|
||||
* handler for this vector number.
|
||||
*/
|
||||
|
||||
/*
|
||||
* Install the wrapper so this ISR can be invoked properly.
|
||||
*/
|
||||
if (bsp_exceptions_in_RAM)
|
||||
_CPU_ISR_install_raw_handler( vector, _ISR_Handler, &ignored );
|
||||
|
||||
/*
|
||||
* We put the actual user ISR address in '_ISR_vector_table'. This will
|
||||
* be used by the _ISR_Handler so the user gets control.
|
||||
*/
|
||||
|
||||
_ISR_Vector_table[ vector ] = new_handler ? (ISR_Handler_entry)new_handler :
|
||||
bsp_spurious_handler ?
|
||||
(ISR_Handler_entry)bsp_spurious_handler :
|
||||
(ISR_Handler_entry)ppc_spurious;
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_Install_interrupt_stack
|
||||
*/
|
||||
|
||||
void _CPU_Install_interrupt_stack( void )
|
||||
{
|
||||
/* PPC_ABI_EABI */
|
||||
_CPU_IRQ_info.Stack = _CPU_Interrupt_stack_high - 8;
|
||||
}
|
||||
|
||||
/* Handle a spurious interrupt */
|
||||
static void ppc_spurious(int v, CPU_Interrupt_frame *i)
|
||||
{
|
||||
#if 0
|
||||
printf("Spurious interrupt on vector %d from %08.8x\n",
|
||||
v, i->pc);
|
||||
#endif
|
||||
#if defined(ppc403) || defined(ppc405)
|
||||
if (v == PPC_IRQ_EXTERNAL)
|
||||
{
|
||||
register int r = 0;
|
||||
|
||||
asm volatile("mtdcr 0x42, %0" :
|
||||
"=&r" ((r)) : "0" ((r))); /* EXIER */
|
||||
}
|
||||
else if (v == PPC_IRQ_PIT)
|
||||
{
|
||||
register int r = 0x08000000;
|
||||
|
||||
asm volatile("mtspr 0x3d8, %0" :
|
||||
"=&r" ((r)) : "0" ((r))); /* TSR */
|
||||
}
|
||||
else if (v == PPC_IRQ_FIT)
|
||||
{
|
||||
register int r = 0x04000000;
|
||||
|
||||
asm volatile("mtspr 0x3d8, %0" :
|
||||
"=&r" ((r)) : "0" ((r))); /* TSR */
|
||||
}
|
||||
#endif
|
||||
++_CPU_spurious_count;
|
||||
_CPU_last_spurious = v;
|
||||
}
|
||||
|
||||
void _CPU_Fatal_error(uint32_t _error)
|
||||
{
|
||||
asm volatile ("mr 3, %0" : : "r" ((_error)));
|
||||
asm volatile ("tweq 5,5");
|
||||
asm volatile ("li 0,0; mtmsr 0");
|
||||
while (1) ;
|
||||
}
|
||||
|
||||
#define PPC_SYNCHRONOUS_TRAP_BIT_MASK 0x100
|
||||
#define PPC_ASYNCHRONOUS_TRAP( _trap ) (_trap)
|
||||
#define PPC_SYNCHRONOUS_TRAP ( _trap ) ((_trap)+PPC_SYNCHRONOUS_TRAP_BIT_MASK)
|
||||
#define PPC_REAL_TRAP_NUMBER ( _trap ) ((_trap)%PPC_SYNCHRONOUS_TRAP_BIT_MASK)
|
||||
|
||||
const CPU_Trap_table_entry _CPU_Trap_slot_template = {
|
||||
|
||||
0x9421ff90, /* stwu r1, -(IP_END)(r1) */
|
||||
|
||||
0x90010008, /* stw %r0, IP_0(%r1) */
|
||||
0x38000000, /* li %r0, PPC_IRQ */
|
||||
0x48000002 /* ba PROC (_ISR_Handler) */
|
||||
};
|
||||
|
||||
#if defined(mpc860) || defined(mpc821)
|
||||
const CPU_Trap_table_entry _CPU_Trap_slot_template_m860 = {
|
||||
0x7c0803ac, /* mtlr %r0 */
|
||||
0x81210028, /* lwz %r9, IP_9(%r1) */
|
||||
0x38000000, /* li %r0, PPC_IRQ */
|
||||
0x48000002 /* b PROC (_ISR_Handler) */
|
||||
};
|
||||
#endif /* mpc860 */
|
||||
|
||||
uint32_t ppc_exception_vector_addr(
|
||||
uint32_t vector
|
||||
);
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* _CPU_ISR_install_raw_handler
|
||||
*
|
||||
* This routine installs the specified handler as a "raw" non-executive
|
||||
* supported trap handler (a.k.a. interrupt service routine).
|
||||
*
|
||||
* Input Parameters:
|
||||
* vector - trap table entry number plus synchronous
|
||||
* vs. asynchronous information
|
||||
* new_handler - address of the handler to be installed
|
||||
* old_handler - pointer to an address of the handler previously installed
|
||||
*
|
||||
* Output Parameters: NONE
|
||||
* *new_handler - address of the handler previously installed
|
||||
*
|
||||
* NOTE:
|
||||
*
|
||||
* This routine is based on the SPARC routine _CPU_ISR_install_raw_handler.
|
||||
* Install a software trap handler as an executive interrupt handler
|
||||
* (which is desirable since RTEMS takes care of window and register issues),
|
||||
* then the executive needs to know that the return address is to the trap
|
||||
* rather than the instruction following the trap.
|
||||
*
|
||||
*/
|
||||
|
||||
void _CPU_ISR_install_raw_handler(
|
||||
uint32_t vector,
|
||||
proc_ptr new_handler,
|
||||
proc_ptr *old_handler
|
||||
)
|
||||
{
|
||||
uint32_t real_vector;
|
||||
CPU_Trap_table_entry *slot;
|
||||
uint32_t u32_handler=0;
|
||||
|
||||
/*
|
||||
* Get the "real" trap number for this vector ignoring the synchronous
|
||||
* versus asynchronous indicator included with our vector numbers.
|
||||
*/
|
||||
|
||||
real_vector = vector;
|
||||
|
||||
/*
|
||||
* Get the current base address of the trap table and calculate a pointer
|
||||
* to the slot we are interested in.
|
||||
*/
|
||||
slot = (CPU_Trap_table_entry *)ppc_exception_vector_addr( real_vector );
|
||||
|
||||
/*
|
||||
* Get the address of the old_handler from the trap table.
|
||||
*
|
||||
* NOTE: The old_handler returned will be bogus if it does not follow
|
||||
* the RTEMS model.
|
||||
*/
|
||||
|
||||
#define HIGH_BITS_MASK 0xFFFFFC00
|
||||
#define HIGH_BITS_SHIFT 10
|
||||
#define LOW_BITS_MASK 0x000003FF
|
||||
|
||||
if (slot->stwu_r1 == _CPU_Trap_slot_template.stwu_r1) {
|
||||
/*
|
||||
* Set u32_handler = to target address
|
||||
*/
|
||||
u32_handler = slot->b_Handler & 0x03fffffc;
|
||||
|
||||
/* IMD FIX: sign extend address fragment... */
|
||||
if (u32_handler & 0x02000000) {
|
||||
u32_handler |= 0xfc000000;
|
||||
}
|
||||
|
||||
*old_handler = (proc_ptr) u32_handler;
|
||||
} else
|
||||
/* There are two kinds of handlers for the MPC860. One is the 'standard'
|
||||
* one like above. The other is for the cascaded interrupts from the SIU
|
||||
* and CPM. Therefore we must check for the alternate one if the standard
|
||||
* one is not present
|
||||
*/
|
||||
#if defined(mpc860) || defined(mpc821)
|
||||
if (slot->stwu_r1 == _CPU_Trap_slot_template_m860.stwu_r1) {
|
||||
/*
|
||||
* Set u32_handler = to target address
|
||||
*/
|
||||
u32_handler = slot->b_Handler & 0x03fffffc;
|
||||
*old_handler = (proc_ptr) u32_handler;
|
||||
} else
|
||||
#endif /* mpc860 */
|
||||
|
||||
*old_handler = 0;
|
||||
|
||||
/*
|
||||
* Copy the template to the slot and then fix it.
|
||||
*/
|
||||
#if defined(mpc860) || defined(mpc821)
|
||||
if (vector >= PPC_IRQ_IRQ0)
|
||||
*slot = _CPU_Trap_slot_template_m860;
|
||||
else
|
||||
#endif /* mpc860 */
|
||||
*slot = _CPU_Trap_slot_template;
|
||||
|
||||
u32_handler = (uint32_t) new_handler;
|
||||
|
||||
/*
|
||||
* IMD FIX: insert address fragment only (bits 6..29)
|
||||
* therefore check for proper address range
|
||||
* and remove unwanted bits
|
||||
*/
|
||||
if ((u32_handler & 0xfc000000) == 0xfc000000) {
|
||||
u32_handler &= ~0xfc000000;
|
||||
}
|
||||
else if ((u32_handler & 0xfc000000) != 0x00000000) {
|
||||
_Internal_error_Occurred(INTERNAL_ERROR_CORE,
|
||||
TRUE,
|
||||
u32_handler);
|
||||
}
|
||||
|
||||
slot->b_Handler |= u32_handler;
|
||||
|
||||
slot->li_r0_IRQ |= vector;
|
||||
|
||||
_CPU_Data_Cache_Block_Flush( slot );
|
||||
}
|
||||
|
||||
uint32_t ppc_exception_vector_addr(
|
||||
uint32_t vector
|
||||
)
|
||||
{
|
||||
#if (!PPC_HAS_EVPR)
|
||||
uint32_t Msr;
|
||||
#endif
|
||||
uint32_t Top = 0;
|
||||
uint32_t Offset = 0x000;
|
||||
|
||||
#if (PPC_HAS_EXCEPTION_PREFIX)
|
||||
_CPU_MSR_GET ( Msr );
|
||||
if ( ( Msr & PPC_MSR_EP) != 0 ) /* Vectors at FFFx_xxxx */
|
||||
Top = 0xfff00000;
|
||||
#elif (PPC_HAS_EVPR)
|
||||
asm volatile( "mfspr %0,0x3d6" : "=r" (Top)); /* EVPR */
|
||||
Top = Top & 0xffff0000;
|
||||
#endif
|
||||
|
||||
switch ( vector ) {
|
||||
case PPC_IRQ_SYSTEM_RESET: /* on 40x aka PPC_IRQ_CRIT */
|
||||
Offset = 0x00100;
|
||||
break;
|
||||
case PPC_IRQ_MCHECK:
|
||||
Offset = 0x00200;
|
||||
break;
|
||||
case PPC_IRQ_PROTECT:
|
||||
Offset = 0x00300;
|
||||
break;
|
||||
case PPC_IRQ_ISI:
|
||||
Offset = 0x00400;
|
||||
break;
|
||||
case PPC_IRQ_EXTERNAL:
|
||||
Offset = 0x00500;
|
||||
break;
|
||||
case PPC_IRQ_ALIGNMENT:
|
||||
Offset = 0x00600;
|
||||
break;
|
||||
case PPC_IRQ_PROGRAM:
|
||||
Offset = 0x00700;
|
||||
break;
|
||||
case PPC_IRQ_NOFP:
|
||||
Offset = 0x00800;
|
||||
break;
|
||||
case PPC_IRQ_DECREMENTER:
|
||||
Offset = 0x00900;
|
||||
break;
|
||||
case PPC_IRQ_RESERVED_A:
|
||||
Offset = 0x00a00;
|
||||
break;
|
||||
case PPC_IRQ_RESERVED_B:
|
||||
Offset = 0x00b00;
|
||||
break;
|
||||
case PPC_IRQ_SCALL:
|
||||
Offset = 0x00c00;
|
||||
break;
|
||||
case PPC_IRQ_TRACE:
|
||||
Offset = 0x00d00;
|
||||
break;
|
||||
case PPC_IRQ_FP_ASST:
|
||||
Offset = 0x00e00;
|
||||
break;
|
||||
|
||||
#if defined(ppc403) || defined(ppc405)
|
||||
|
||||
/* PPC_IRQ_CRIT is the same vector as PPC_IRQ_RESET
|
||||
case PPC_IRQ_CRIT:
|
||||
Offset = 0x00100;
|
||||
break;
|
||||
*/
|
||||
case PPC_IRQ_PIT:
|
||||
Offset = 0x01000;
|
||||
break;
|
||||
case PPC_IRQ_FIT:
|
||||
Offset = 0x01010;
|
||||
break;
|
||||
case PPC_IRQ_WATCHDOG:
|
||||
Offset = 0x01020;
|
||||
break;
|
||||
case PPC_IRQ_DEBUG:
|
||||
Offset = 0x02000;
|
||||
break;
|
||||
|
||||
#elif defined(ppc601)
|
||||
case PPC_IRQ_TRACE:
|
||||
Offset = 0x02000;
|
||||
break;
|
||||
|
||||
#elif defined(ppc603) || defined(ppc603e)
|
||||
case PPC_IRQ_TRANS_MISS:
|
||||
Offset = 0x1000;
|
||||
break;
|
||||
case PPC_IRQ_DATA_LOAD:
|
||||
Offset = 0x1100;
|
||||
break;
|
||||
case PPC_IRQ_DATA_STORE:
|
||||
Offset = 0x1200;
|
||||
break;
|
||||
case PPC_IRQ_ADDR_BRK:
|
||||
Offset = 0x1300;
|
||||
break;
|
||||
case PPC_IRQ_SYS_MGT:
|
||||
Offset = 0x1400;
|
||||
break;
|
||||
|
||||
#elif defined(mpc604)
|
||||
case PPC_IRQ_ADDR_BRK:
|
||||
Offset = 0x1300;
|
||||
break;
|
||||
case PPC_IRQ_SYS_MGT:
|
||||
Offset = 0x1400;
|
||||
break;
|
||||
|
||||
#elif defined(mpc860) || defined(mpc821)
|
||||
case PPC_IRQ_EMULATE:
|
||||
Offset = 0x1000;
|
||||
break;
|
||||
case PPC_IRQ_INST_MISS:
|
||||
Offset = 0x1100;
|
||||
break;
|
||||
case PPC_IRQ_DATA_MISS:
|
||||
Offset = 0x1200;
|
||||
break;
|
||||
case PPC_IRQ_INST_ERR:
|
||||
Offset = 0x1300;
|
||||
break;
|
||||
case PPC_IRQ_DATA_ERR:
|
||||
Offset = 0x1400;
|
||||
break;
|
||||
case PPC_IRQ_DATA_BPNT:
|
||||
Offset = 0x1c00;
|
||||
break;
|
||||
case PPC_IRQ_INST_BPNT:
|
||||
Offset = 0x1d00;
|
||||
break;
|
||||
case PPC_IRQ_IO_BPNT:
|
||||
Offset = 0x1e00;
|
||||
break;
|
||||
case PPC_IRQ_DEV_PORT:
|
||||
Offset = 0x1f00;
|
||||
break;
|
||||
case PPC_IRQ_IRQ0:
|
||||
Offset = 0x2000;
|
||||
break;
|
||||
case PPC_IRQ_LVL0:
|
||||
Offset = 0x2040;
|
||||
break;
|
||||
case PPC_IRQ_IRQ1:
|
||||
Offset = 0x2080;
|
||||
break;
|
||||
case PPC_IRQ_LVL1:
|
||||
Offset = 0x20c0;
|
||||
break;
|
||||
case PPC_IRQ_IRQ2:
|
||||
Offset = 0x2100;
|
||||
break;
|
||||
case PPC_IRQ_LVL2:
|
||||
Offset = 0x2140;
|
||||
break;
|
||||
case PPC_IRQ_IRQ3:
|
||||
Offset = 0x2180;
|
||||
break;
|
||||
case PPC_IRQ_LVL3:
|
||||
Offset = 0x21c0;
|
||||
break;
|
||||
case PPC_IRQ_IRQ4:
|
||||
Offset = 0x2200;
|
||||
break;
|
||||
case PPC_IRQ_LVL4:
|
||||
Offset = 0x2240;
|
||||
break;
|
||||
case PPC_IRQ_IRQ5:
|
||||
Offset = 0x2280;
|
||||
break;
|
||||
case PPC_IRQ_LVL5:
|
||||
Offset = 0x22c0;
|
||||
break;
|
||||
case PPC_IRQ_IRQ6:
|
||||
Offset = 0x2300;
|
||||
break;
|
||||
case PPC_IRQ_LVL6:
|
||||
Offset = 0x2340;
|
||||
break;
|
||||
case PPC_IRQ_IRQ7:
|
||||
Offset = 0x2380;
|
||||
break;
|
||||
case PPC_IRQ_LVL7:
|
||||
Offset = 0x23c0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_ERROR:
|
||||
Offset = 0x2400;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC4:
|
||||
Offset = 0x2410;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC5:
|
||||
Offset = 0x2420;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SMC2:
|
||||
Offset = 0x2430;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SMC1:
|
||||
Offset = 0x2440;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SPI:
|
||||
Offset = 0x2450;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC6:
|
||||
Offset = 0x2460;
|
||||
break;
|
||||
case PPC_IRQ_CPM_TIMER4:
|
||||
Offset = 0x2470;
|
||||
break;
|
||||
case PPC_IRQ_CPM_RESERVED_8:
|
||||
Offset = 0x2480;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC7:
|
||||
Offset = 0x2490;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC8:
|
||||
Offset = 0x24a0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC9:
|
||||
Offset = 0x24b0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_TIMER3:
|
||||
Offset = 0x24c0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_RESERVED_D:
|
||||
Offset = 0x24d0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC10:
|
||||
Offset = 0x24e0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC11:
|
||||
Offset = 0x24f0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_I2C:
|
||||
Offset = 0x2500;
|
||||
break;
|
||||
case PPC_IRQ_CPM_RISC_TIMER:
|
||||
Offset = 0x2510;
|
||||
break;
|
||||
case PPC_IRQ_CPM_TIMER2:
|
||||
Offset = 0x2520;
|
||||
break;
|
||||
case PPC_IRQ_CPM_RESERVED_13:
|
||||
Offset = 0x2530;
|
||||
break;
|
||||
case PPC_IRQ_CPM_IDMA2:
|
||||
Offset = 0x2540;
|
||||
break;
|
||||
case PPC_IRQ_CPM_IDMA1:
|
||||
Offset = 0x2550;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SDMA_ERROR:
|
||||
Offset = 0x2560;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC12:
|
||||
Offset = 0x2570;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC13:
|
||||
Offset = 0x2580;
|
||||
break;
|
||||
case PPC_IRQ_CPM_TIMER1:
|
||||
Offset = 0x2590;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC14:
|
||||
Offset = 0x25a0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SCC4:
|
||||
Offset = 0x25b0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SCC3:
|
||||
Offset = 0x25c0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SCC2:
|
||||
Offset = 0x25d0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_SCC1:
|
||||
Offset = 0x25e0;
|
||||
break;
|
||||
case PPC_IRQ_CPM_PC15:
|
||||
Offset = 0x25f0;
|
||||
break;
|
||||
#endif
|
||||
|
||||
}
|
||||
Top += Offset;
|
||||
return Top;
|
||||
}
|
||||
|
||||
/*PAGE
|
||||
*
|
||||
* This is the PowerPC specific implementation of the routine which
|
||||
* returns TRUE if an interrupt is in progress.
|
||||
*
|
||||
* NOTE: This is the same as the generic version. But since the
|
||||
* PowerPC is still supporting old and new exception processing
|
||||
* models and the new exception processing model has a hardware
|
||||
* way of doing this, we have to provide this capability here
|
||||
* for symmetry.
|
||||
*/
|
||||
|
||||
boolean _ISR_Is_in_progress( void )
|
||||
{
|
||||
return (_ISR_Nest_level != 0);
|
||||
}
|
||||
|
||||
const unsigned int _PPC_MSR_DISABLE_MASK = PPC_MSR_DISABLE_MASK;
|
||||
@@ -1,631 +0,0 @@
|
||||
|
||||
/* cpu_asm.s 1.1 - 95/12/04
|
||||
*
|
||||
* This file contains the assembly code for the PowerPC implementation
|
||||
* of RTEMS.
|
||||
*
|
||||
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
||||
*
|
||||
* COPYRIGHT (c) 1995 by i-cubed ltd.
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of i-cubed limited not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* i-cubed limited makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* Derived from c/src/exec/cpu/no_cpu/cpu_asm.c:
|
||||
*
|
||||
* COPYRIGHT (c) 1989-1997.
|
||||
* On-Line Applications Research Corporation (OAR).
|
||||
*
|
||||
* The license and distribution terms for this file may in
|
||||
* the file LICENSE in this distribution or at
|
||||
* http://www.rtems.com/license/LICENSE.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
/*
|
||||
* FIXME: This file is bsp-dependent.
|
||||
*/
|
||||
#include <bspopts.h>
|
||||
|
||||
#include <rtems/asm.h>
|
||||
#include <rtems/score/ppc_offs.h>
|
||||
#include <rtems/powerpc/powerpc.h>
|
||||
|
||||
BEGIN_CODE
|
||||
/*
|
||||
* _CPU_Context_save_fp_context
|
||||
*
|
||||
* This routine is responsible for saving the FP context
|
||||
* at *fp_context_ptr. If the point to load the FP context
|
||||
* from is changed then the pointer is modified by this routine.
|
||||
*
|
||||
* Sometimes a macro implementation of this is in cpu.h which dereferences
|
||||
* the ** and a similarly named routine in this file is passed something
|
||||
* like a (Context_Control_fp *). The general rule on making this decision
|
||||
* is to avoid writing assembly language.
|
||||
*/
|
||||
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_CPU_Context_save_fp)
|
||||
PROC (_CPU_Context_save_fp):
|
||||
#if (PPC_HAS_FPU == 1)
|
||||
lwz r3, 0(r3)
|
||||
#if (PPC_HAS_DOUBLE == 1)
|
||||
stfd f0, FP_0(r3)
|
||||
stfd f1, FP_1(r3)
|
||||
stfd f2, FP_2(r3)
|
||||
stfd f3, FP_3(r3)
|
||||
stfd f4, FP_4(r3)
|
||||
stfd f5, FP_5(r3)
|
||||
stfd f6, FP_6(r3)
|
||||
stfd f7, FP_7(r3)
|
||||
stfd f8, FP_8(r3)
|
||||
stfd f9, FP_9(r3)
|
||||
stfd f10, FP_10(r3)
|
||||
stfd f11, FP_11(r3)
|
||||
stfd f12, FP_12(r3)
|
||||
stfd f13, FP_13(r3)
|
||||
stfd f14, FP_14(r3)
|
||||
stfd f15, FP_15(r3)
|
||||
stfd f16, FP_16(r3)
|
||||
stfd f17, FP_17(r3)
|
||||
stfd f18, FP_18(r3)
|
||||
stfd f19, FP_19(r3)
|
||||
stfd f20, FP_20(r3)
|
||||
stfd f21, FP_21(r3)
|
||||
stfd f22, FP_22(r3)
|
||||
stfd f23, FP_23(r3)
|
||||
stfd f24, FP_24(r3)
|
||||
stfd f25, FP_25(r3)
|
||||
stfd f26, FP_26(r3)
|
||||
stfd f27, FP_27(r3)
|
||||
stfd f28, FP_28(r3)
|
||||
stfd f29, FP_29(r3)
|
||||
stfd f30, FP_30(r3)
|
||||
stfd f31, FP_31(r3)
|
||||
mffs f2
|
||||
stfd f2, FP_FPSCR(r3)
|
||||
#else
|
||||
stfs f0, FP_0(r3)
|
||||
stfs f1, FP_1(r3)
|
||||
stfs f2, FP_2(r3)
|
||||
stfs f3, FP_3(r3)
|
||||
stfs f4, FP_4(r3)
|
||||
stfs f5, FP_5(r3)
|
||||
stfs f6, FP_6(r3)
|
||||
stfs f7, FP_7(r3)
|
||||
stfs f8, FP_8(r3)
|
||||
stfs f9, FP_9(r3)
|
||||
stfs f10, FP_10(r3)
|
||||
stfs f11, FP_11(r3)
|
||||
stfs f12, FP_12(r3)
|
||||
stfs f13, FP_13(r3)
|
||||
stfs f14, FP_14(r3)
|
||||
stfs f15, FP_15(r3)
|
||||
stfs f16, FP_16(r3)
|
||||
stfs f17, FP_17(r3)
|
||||
stfs f18, FP_18(r3)
|
||||
stfs f19, FP_19(r3)
|
||||
stfs f20, FP_20(r3)
|
||||
stfs f21, FP_21(r3)
|
||||
stfs f22, FP_22(r3)
|
||||
stfs f23, FP_23(r3)
|
||||
stfs f24, FP_24(r3)
|
||||
stfs f25, FP_25(r3)
|
||||
stfs f26, FP_26(r3)
|
||||
stfs f27, FP_27(r3)
|
||||
stfs f28, FP_28(r3)
|
||||
stfs f29, FP_29(r3)
|
||||
stfs f30, FP_30(r3)
|
||||
stfs f31, FP_31(r3)
|
||||
mffs f2
|
||||
stfs f2, FP_FPSCR(r3)
|
||||
#endif
|
||||
#endif
|
||||
blr
|
||||
|
||||
/*
|
||||
* _CPU_Context_restore_fp_context
|
||||
*
|
||||
* This routine is responsible for restoring the FP context
|
||||
* at *fp_context_ptr. If the point to load the FP context
|
||||
* from is changed then the pointer is modified by this routine.
|
||||
*
|
||||
* Sometimes a macro implementation of this is in cpu.h which dereferences
|
||||
* the ** and a similarly named routine in this file is passed something
|
||||
* like a (Context_Control_fp *). The general rule on making this decision
|
||||
* is to avoid writing assembly language.
|
||||
*/
|
||||
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_CPU_Context_restore_fp)
|
||||
PROC (_CPU_Context_restore_fp):
|
||||
#if (PPC_HAS_FPU == 1)
|
||||
lwz r3, 0(r3)
|
||||
#if (PPC_HAS_DOUBLE == 1)
|
||||
lfd f2, FP_FPSCR(r3)
|
||||
mtfsf 255, f2
|
||||
lfd f0, FP_0(r3)
|
||||
lfd f1, FP_1(r3)
|
||||
lfd f2, FP_2(r3)
|
||||
lfd f3, FP_3(r3)
|
||||
lfd f4, FP_4(r3)
|
||||
lfd f5, FP_5(r3)
|
||||
lfd f6, FP_6(r3)
|
||||
lfd f7, FP_7(r3)
|
||||
lfd f8, FP_8(r3)
|
||||
lfd f9, FP_9(r3)
|
||||
lfd f10, FP_10(r3)
|
||||
lfd f11, FP_11(r3)
|
||||
lfd f12, FP_12(r3)
|
||||
lfd f13, FP_13(r3)
|
||||
lfd f14, FP_14(r3)
|
||||
lfd f15, FP_15(r3)
|
||||
lfd f16, FP_16(r3)
|
||||
lfd f17, FP_17(r3)
|
||||
lfd f18, FP_18(r3)
|
||||
lfd f19, FP_19(r3)
|
||||
lfd f20, FP_20(r3)
|
||||
lfd f21, FP_21(r3)
|
||||
lfd f22, FP_22(r3)
|
||||
lfd f23, FP_23(r3)
|
||||
lfd f24, FP_24(r3)
|
||||
lfd f25, FP_25(r3)
|
||||
lfd f26, FP_26(r3)
|
||||
lfd f27, FP_27(r3)
|
||||
lfd f28, FP_28(r3)
|
||||
lfd f29, FP_29(r3)
|
||||
lfd f30, FP_30(r3)
|
||||
lfd f31, FP_31(r3)
|
||||
#else
|
||||
lfs f2, FP_FPSCR(r3)
|
||||
mtfsf 255, f2
|
||||
lfs f0, FP_0(r3)
|
||||
lfs f1, FP_1(r3)
|
||||
lfs f2, FP_2(r3)
|
||||
lfs f3, FP_3(r3)
|
||||
lfs f4, FP_4(r3)
|
||||
lfs f5, FP_5(r3)
|
||||
lfs f6, FP_6(r3)
|
||||
lfs f7, FP_7(r3)
|
||||
lfs f8, FP_8(r3)
|
||||
lfs f9, FP_9(r3)
|
||||
lfs f10, FP_10(r3)
|
||||
lfs f11, FP_11(r3)
|
||||
lfs f12, FP_12(r3)
|
||||
lfs f13, FP_13(r3)
|
||||
lfs f14, FP_14(r3)
|
||||
lfs f15, FP_15(r3)
|
||||
lfs f16, FP_16(r3)
|
||||
lfs f17, FP_17(r3)
|
||||
lfs f18, FP_18(r3)
|
||||
lfs f19, FP_19(r3)
|
||||
lfs f20, FP_20(r3)
|
||||
lfs f21, FP_21(r3)
|
||||
lfs f22, FP_22(r3)
|
||||
lfs f23, FP_23(r3)
|
||||
lfs f24, FP_24(r3)
|
||||
lfs f25, FP_25(r3)
|
||||
lfs f26, FP_26(r3)
|
||||
lfs f27, FP_27(r3)
|
||||
lfs f28, FP_28(r3)
|
||||
lfs f29, FP_29(r3)
|
||||
lfs f30, FP_30(r3)
|
||||
lfs f31, FP_31(r3)
|
||||
#endif
|
||||
#endif
|
||||
blr
|
||||
|
||||
/* _CPU_Context_switch
|
||||
*
|
||||
* This routine performs a normal non-FP context switch.
|
||||
*/
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_CPU_Context_switch)
|
||||
PROC (_CPU_Context_switch):
|
||||
sync
|
||||
isync
|
||||
#if (PPC_CACHE_ALIGNMENT == 4) /* No cache */
|
||||
stw r1, GP_1(r3)
|
||||
lwz r1, GP_1(r4)
|
||||
stw r2, GP_2(r3)
|
||||
lwz r2, GP_2(r4)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
stmw r13, GP_13(r3)
|
||||
lmw r13, GP_13(r4)
|
||||
#else
|
||||
stw r13, GP_13(r3)
|
||||
lwz r13, GP_13(r4)
|
||||
stw r14, GP_14(r3)
|
||||
lwz r14, GP_14(r4)
|
||||
stw r15, GP_15(r3)
|
||||
lwz r15, GP_15(r4)
|
||||
stw r16, GP_16(r3)
|
||||
lwz r16, GP_16(r4)
|
||||
stw r17, GP_17(r3)
|
||||
lwz r17, GP_17(r4)
|
||||
stw r18, GP_18(r3)
|
||||
lwz r18, GP_18(r4)
|
||||
stw r19, GP_19(r3)
|
||||
lwz r19, GP_19(r4)
|
||||
stw r20, GP_20(r3)
|
||||
lwz r20, GP_20(r4)
|
||||
stw r21, GP_21(r3)
|
||||
lwz r21, GP_21(r4)
|
||||
stw r22, GP_22(r3)
|
||||
lwz r22, GP_22(r4)
|
||||
stw r23, GP_23(r3)
|
||||
lwz r23, GP_23(r4)
|
||||
stw r24, GP_24(r3)
|
||||
lwz r24, GP_24(r4)
|
||||
stw r25, GP_25(r3)
|
||||
lwz r25, GP_25(r4)
|
||||
stw r26, GP_26(r3)
|
||||
lwz r26, GP_26(r4)
|
||||
stw r27, GP_27(r3)
|
||||
lwz r27, GP_27(r4)
|
||||
stw r28, GP_28(r3)
|
||||
lwz r28, GP_28(r4)
|
||||
stw r29, GP_29(r3)
|
||||
lwz r29, GP_29(r4)
|
||||
stw r30, GP_30(r3)
|
||||
lwz r30, GP_30(r4)
|
||||
stw r31, GP_31(r3)
|
||||
lwz r31, GP_31(r4)
|
||||
#endif
|
||||
mfcr r5
|
||||
stw r5, GP_CR(r3)
|
||||
lwz r5, GP_CR(r4)
|
||||
mflr r6
|
||||
mtcrf 255, r5
|
||||
stw r6, GP_PC(r3)
|
||||
lwz r6, GP_PC(r4)
|
||||
mfmsr r7
|
||||
mtlr r6
|
||||
stw r7, GP_MSR(r3)
|
||||
lwz r7, GP_MSR(r4)
|
||||
mtmsr r7
|
||||
#endif
|
||||
#if (PPC_CACHE_ALIGNMENT == 16)
|
||||
/* This assumes that all the registers are in the given order */
|
||||
li r5, 16
|
||||
addi r3,r3,-4
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r1, GP_1+4(r3)
|
||||
stw r2, GP_2+4(r3)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
addi r3, r3, GP_14+4
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
|
||||
addi r3, r3, GP_18-GP_14
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
addi r3, r3, GP_22-GP_18
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
addi r3, r3, GP_26-GP_22
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stmw r13, GP_13-GP_26(r3)
|
||||
#else
|
||||
stw r13, GP_13+4(r3)
|
||||
stwu r14, GP_14+4(r3)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r15, GP_15-GP_14(r3)
|
||||
stw r16, GP_16-GP_14(r3)
|
||||
stw r17, GP_17-GP_14(r3)
|
||||
stwu r18, GP_18-GP_14(r3)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r19, GP_19-GP_18(r3)
|
||||
stw r20, GP_20-GP_18(r3)
|
||||
stw r21, GP_21-GP_18(r3)
|
||||
stwu r22, GP_22-GP_18(r3)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r23, GP_23-GP_22(r3)
|
||||
stw r24, GP_24-GP_22(r3)
|
||||
stw r25, GP_25-GP_22(r3)
|
||||
stwu r26, GP_26-GP_22(r3)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r27, GP_27-GP_26(r3)
|
||||
stw r28, GP_28-GP_26(r3)
|
||||
stw r29, GP_29-GP_26(r3)
|
||||
stw r30, GP_30-GP_26(r3)
|
||||
stw r31, GP_31-GP_26(r3)
|
||||
#endif
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r0, r4
|
||||
#endif
|
||||
mfcr r6
|
||||
stw r6, GP_CR-GP_26(r3)
|
||||
mflr r7
|
||||
stw r7, GP_PC-GP_26(r3)
|
||||
mfmsr r8
|
||||
stw r8, GP_MSR-GP_26(r3)
|
||||
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r1, GP_1(r4)
|
||||
lwz r2, GP_2(r4)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
addi r4, r4, GP_15
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
addi r4, r4, GP_19-GP_15
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
addi r4, r4, GP_23-GP_19
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
addi r4, r4, GP_27-GP_23
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lmw r13, GP_13-GP_27(r4)
|
||||
#else
|
||||
lwz r13, GP_13(r4)
|
||||
lwz r14, GP_14(r4)
|
||||
lwzu r15, GP_15(r4)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r16, GP_16-GP_15(r4)
|
||||
lwz r17, GP_17-GP_15(r4)
|
||||
lwz r18, GP_18-GP_15(r4)
|
||||
lwzu r19, GP_19-GP_15(r4)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r20, GP_20-GP_19(r4)
|
||||
lwz r21, GP_21-GP_19(r4)
|
||||
lwz r22, GP_22-GP_19(r4)
|
||||
lwzu r23, GP_23-GP_19(r4)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r24, GP_24-GP_23(r4)
|
||||
lwz r25, GP_25-GP_23(r4)
|
||||
lwz r26, GP_26-GP_23(r4)
|
||||
lwzu r27, GP_27-GP_23(r4)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r28, GP_28-GP_27(r4)
|
||||
lwz r29, GP_29-GP_27(r4)
|
||||
lwz r30, GP_30-GP_27(r4)
|
||||
lwz r31, GP_31-GP_27(r4)
|
||||
#endif
|
||||
lwz r6, GP_CR-GP_27(r4)
|
||||
lwz r7, GP_PC-GP_27(r4)
|
||||
lwz r8, GP_MSR-GP_27(r4)
|
||||
mtcrf 255, r6
|
||||
mtlr r7
|
||||
mtmsr r8
|
||||
#endif
|
||||
#if (PPC_CACHE_ALIGNMENT == 32)
|
||||
/* This assumes that all the registers are in the given order */
|
||||
li r5, 32
|
||||
addi r3,r3,-4
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r1, GP_1+4(r3)
|
||||
stw r2, GP_2+4(r3)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
addi r3, r3, GP_18+4
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stmw r13, GP_13-GP_18(r3)
|
||||
#else
|
||||
stw r13, GP_13+4(r3)
|
||||
stw r14, GP_14+4(r3)
|
||||
stw r15, GP_15+4(r3)
|
||||
stw r16, GP_16+4(r3)
|
||||
stw r17, GP_17+4(r3)
|
||||
stwu r18, GP_18+4(r3)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbz r5, r3
|
||||
#endif
|
||||
stw r19, GP_19-GP_18(r3)
|
||||
stw r20, GP_20-GP_18(r3)
|
||||
stw r21, GP_21-GP_18(r3)
|
||||
stw r22, GP_22-GP_18(r3)
|
||||
stw r23, GP_23-GP_18(r3)
|
||||
stw r24, GP_24-GP_18(r3)
|
||||
stw r25, GP_25-GP_18(r3)
|
||||
stw r26, GP_26-GP_18(r3)
|
||||
stw r27, GP_27-GP_18(r3)
|
||||
stw r28, GP_28-GP_18(r3)
|
||||
stw r29, GP_29-GP_18(r3)
|
||||
stw r30, GP_30-GP_18(r3)
|
||||
stw r31, GP_31-GP_18(r3)
|
||||
#endif
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r0, r4
|
||||
#endif
|
||||
mfcr r6
|
||||
stw r6, GP_CR-GP_18(r3)
|
||||
mflr r7
|
||||
stw r7, GP_PC-GP_18(r3)
|
||||
mfmsr r8
|
||||
stw r8, GP_MSR-GP_18(r3)
|
||||
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r1, GP_1(r4)
|
||||
lwz r2, GP_2(r4)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
addi r4, r4, GP_19
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lmw r13, GP_13-GP_19(r4)
|
||||
#else
|
||||
lwz r13, GP_13(r4)
|
||||
lwz r14, GP_14(r4)
|
||||
lwz r15, GP_15(r4)
|
||||
lwz r16, GP_16(r4)
|
||||
lwz r17, GP_17(r4)
|
||||
lwz r18, GP_18(r4)
|
||||
lwzu r19, GP_19(r4)
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r5, r4
|
||||
#endif
|
||||
lwz r20, GP_20-GP_19(r4)
|
||||
lwz r21, GP_21-GP_19(r4)
|
||||
lwz r22, GP_22-GP_19(r4)
|
||||
lwz r23, GP_23-GP_19(r4)
|
||||
lwz r24, GP_24-GP_19(r4)
|
||||
lwz r25, GP_25-GP_19(r4)
|
||||
lwz r26, GP_26-GP_19(r4)
|
||||
lwz r27, GP_27-GP_19(r4)
|
||||
lwz r28, GP_28-GP_19(r4)
|
||||
lwz r29, GP_29-GP_19(r4)
|
||||
lwz r30, GP_30-GP_19(r4)
|
||||
lwz r31, GP_31-GP_19(r4)
|
||||
#endif
|
||||
lwz r6, GP_CR-GP_19(r4)
|
||||
lwz r7, GP_PC-GP_19(r4)
|
||||
lwz r8, GP_MSR-GP_19(r4)
|
||||
mtcrf 255, r6
|
||||
mtlr r7
|
||||
mtmsr r8
|
||||
#endif
|
||||
blr
|
||||
|
||||
/*
|
||||
* _CPU_Context_restore
|
||||
*
|
||||
* This routine is generallu used only to restart self in an
|
||||
* efficient manner. It may simply be a label in _CPU_Context_switch.
|
||||
*
|
||||
* NOTE: May be unnecessary to reload some registers.
|
||||
*/
|
||||
/*
|
||||
* ACB: Don't worry about cache optimisation here - this is not THAT critical.
|
||||
*/
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_CPU_Context_restore)
|
||||
PROC (_CPU_Context_restore):
|
||||
lwz r5, GP_CR(r3)
|
||||
lwz r6, GP_PC(r3)
|
||||
lwz r7, GP_MSR(r3)
|
||||
mtcrf 255, r5
|
||||
mtlr r6
|
||||
mtmsr r7
|
||||
lwz r1, GP_1(r3)
|
||||
lwz r2, GP_2(r3)
|
||||
#if (PPC_USE_MULTIPLE == 1)
|
||||
lmw r13, GP_13(r3)
|
||||
#else
|
||||
lwz r13, GP_13(r3)
|
||||
lwz r14, GP_14(r3)
|
||||
lwz r15, GP_15(r3)
|
||||
lwz r16, GP_16(r3)
|
||||
lwz r17, GP_17(r3)
|
||||
lwz r18, GP_18(r3)
|
||||
lwz r19, GP_19(r3)
|
||||
lwz r20, GP_20(r3)
|
||||
lwz r21, GP_21(r3)
|
||||
lwz r22, GP_22(r3)
|
||||
lwz r23, GP_23(r3)
|
||||
lwz r24, GP_24(r3)
|
||||
lwz r25, GP_25(r3)
|
||||
lwz r26, GP_26(r3)
|
||||
lwz r27, GP_27(r3)
|
||||
lwz r28, GP_28(r3)
|
||||
lwz r29, GP_29(r3)
|
||||
lwz r30, GP_30(r3)
|
||||
lwz r31, GP_31(r3)
|
||||
#endif
|
||||
|
||||
blr
|
||||
|
||||
/* Individual interrupt prologues look like this:
|
||||
* stwu r1, -(IP_END)(r1)
|
||||
* stw r0, IP_0(r1)
|
||||
*
|
||||
* li r0, vectornum
|
||||
* b PROC (_ISR_Handler{,C})
|
||||
*/
|
||||
|
||||
/* void __ISR_Handler()
|
||||
*
|
||||
* This routine provides the RTEMS interrupt management.
|
||||
* The vector number is in r0. R0 has already been stacked.
|
||||
*
|
||||
*/
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_ISR_Handler)
|
||||
PROC (_ISR_Handler):
|
||||
#define LABEL(x) x
|
||||
/* XXX ??
|
||||
#define MTSAVE(x) mtspr sprg0, x
|
||||
#define MFSAVE(x) mfspr x, sprg0
|
||||
*/
|
||||
#define MTPC(x) mtspr srr0, x
|
||||
#define MFPC(x) mfspr x, srr0
|
||||
#define MTMSR(x) mtspr srr1, x
|
||||
#define MFMSR(x) mfspr x, srr1
|
||||
|
||||
#include "irq_stub.S"
|
||||
rfi
|
||||
|
||||
#if (PPC_HAS_RFCI == 1)
|
||||
/* void __ISR_HandlerC()
|
||||
*
|
||||
* This routine provides the RTEMS interrupt management.
|
||||
* For critical interrupts
|
||||
*
|
||||
*/
|
||||
ALIGN (PPC_CACHE_ALIGNMENT, PPC_CACHE_ALIGN_POWER)
|
||||
PUBLIC_PROC (_ISR_HandlerC)
|
||||
PROC (_ISR_HandlerC):
|
||||
#undef LABEL
|
||||
#undef MTSAVE
|
||||
#undef MFSAVE
|
||||
#undef MTPC
|
||||
#undef MFPC
|
||||
#undef MTMSR
|
||||
#undef MFMSR
|
||||
#define LABEL(x) x##_C
|
||||
/* XXX??
|
||||
#define MTSAVE(x) mtspr sprg1, x
|
||||
#define MFSAVE(x) mfspr x, sprg1
|
||||
*/
|
||||
#define MTPC(x) mtspr srr2, x
|
||||
#define MFPC(x) mfspr x, srr2
|
||||
#define MTMSR(x) mtspr srr3, x
|
||||
#define MFMSR(x) mfspr x, srr3
|
||||
#include "irq_stub.S"
|
||||
rfci
|
||||
#endif
|
||||
@@ -1,261 +0,0 @@
|
||||
/*
|
||||
* This file contains the interrupt handler assembly code for the PowerPC
|
||||
* implementation of RTEMS. It is #included from cpu_asm.s.
|
||||
*
|
||||
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
||||
*
|
||||
* COPYRIGHT (c) 1995 by i-cubed ltd.
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of i-cubed limited not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* i-cubed limited makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
/*
|
||||
* FIXME: this file is bsp dependent.
|
||||
*/
|
||||
#include <bspopts.h>
|
||||
#include <rtems/powerpc/powerpc.h>
|
||||
|
||||
/* void __ISR_Handler()
|
||||
*
|
||||
* This routine provides the RTEMS interrupt management.
|
||||
* The vector number is in r0. R0 has already been stacked.
|
||||
*
|
||||
*/
|
||||
PUBLIC_VAR (_CPU_IRQ_info )
|
||||
|
||||
/* Finish off the interrupt frame */
|
||||
stw r2, IP_2(r1)
|
||||
stw r3, IP_3(r1)
|
||||
stw r4, IP_4(r1)
|
||||
stw r5, IP_5(r1)
|
||||
stw r6, IP_6(r1)
|
||||
stw r7, IP_7(r1)
|
||||
stw r8, IP_8(r1)
|
||||
stw r9, IP_9(r1)
|
||||
stw r10, IP_10(r1)
|
||||
stw r11, IP_11(r1)
|
||||
stw r12, IP_12(r1)
|
||||
stw r13, IP_13(r1)
|
||||
stmw r28, IP_28(r1)
|
||||
mfcr r5
|
||||
mfctr r6
|
||||
mfxer r7
|
||||
mflr r8
|
||||
MFPC (r9)
|
||||
MFMSR (r10)
|
||||
/* Establish addressing */
|
||||
#if (PPC_USE_SPRG)
|
||||
mfspr r11, sprg3
|
||||
#else
|
||||
lis r11,_CPU_IRQ_info@ha
|
||||
addi r11,r11,_CPU_IRQ_info@l
|
||||
#endif
|
||||
#if ( PPC_USE_DATA_CACHE )
|
||||
dcbt r0, r11
|
||||
#endif
|
||||
stw r5, IP_CR(r1)
|
||||
stw r6, IP_CTR(r1)
|
||||
stw r7, IP_XER(r1)
|
||||
stw r8, IP_LR(r1)
|
||||
stw r9, IP_PC(r1)
|
||||
stw r10, IP_MSR(r1)
|
||||
|
||||
lwz r30, Vector_table(r11)
|
||||
slwi r4,r0,2
|
||||
lwz r28, Nest_level(r11)
|
||||
add r4, r4, r30
|
||||
|
||||
lwz r30, 0(r28)
|
||||
mr r3, r0
|
||||
lwz r31, Stack(r11)
|
||||
/*
|
||||
* #if ( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE )
|
||||
* if ( _ISR_Nest_level == 0 )
|
||||
* switch to software interrupt stack
|
||||
* #endif
|
||||
*/
|
||||
/* Switch stacks, here we must prevent ALL interrupts */
|
||||
#if (PPC_USE_SPRG)
|
||||
mfmsr r5
|
||||
mfspr r6, sprg2
|
||||
#else
|
||||
lwz r6,msr_initial(r11)
|
||||
lis r5,~PPC_MSR_DISABLE_MASK@ha
|
||||
ori r5,r5,~PPC_MSR_DISABLE_MASK@l
|
||||
and r6,r6,r5
|
||||
mfmsr r5
|
||||
#endif
|
||||
mtmsr r6
|
||||
cmpwi r30, 0
|
||||
lwz r29, Disable_level(r11)
|
||||
subf r31,r1,r31
|
||||
bne LABEL (nested)
|
||||
stwux r1,r1,r31
|
||||
LABEL (nested):
|
||||
/*
|
||||
* _ISR_Nest_level++;
|
||||
*/
|
||||
lwz r31, 0(r29)
|
||||
addi r30,r30,1
|
||||
stw r30,0(r28)
|
||||
/* From here on out, interrupts can be re-enabled. RTEMS
|
||||
* convention says not.
|
||||
*/
|
||||
lwz r4,0(r4)
|
||||
/*
|
||||
* _Thread_Dispatch_disable_level++;
|
||||
*/
|
||||
addi r31,r31,1
|
||||
stw r31, 0(r29)
|
||||
/* SCE 980217
|
||||
*
|
||||
* We need address translation ON when we call our ISR routine
|
||||
|
||||
mtmsr r5
|
||||
|
||||
*/
|
||||
|
||||
/*
|
||||
* (*_ISR_Vector_table[ vector ])( vector );
|
||||
*/
|
||||
#if (PPC_ABI == PPC_ABI_SVR4 || PPC_ABI == PPC_ABI_EABI)
|
||||
mtlr r4
|
||||
lwz r2, Default_r2(r11)
|
||||
lwz r13, Default_r13(r11)
|
||||
#lwz r2, 0(r2)
|
||||
#lwz r13, 0(r13)
|
||||
#endif
|
||||
mr r4,r1
|
||||
blrl
|
||||
/* NOP marker for debuggers */
|
||||
or r6,r6,r6
|
||||
|
||||
/* We must re-disable the interrupts */
|
||||
#if (PPC_USE_SPRG)
|
||||
mfspr r11, sprg3
|
||||
mfspr r0, sprg2
|
||||
#else
|
||||
lis r11,_CPU_IRQ_info@ha
|
||||
addi r11,r11,_CPU_IRQ_info@l
|
||||
lwz r0,msr_initial(r11)
|
||||
lis r30,~PPC_MSR_DISABLE_MASK@ha
|
||||
ori r30,r30,~PPC_MSR_DISABLE_MASK@l
|
||||
and r0,r0,r30
|
||||
#endif
|
||||
mtmsr r0
|
||||
lwz r30, 0(r28)
|
||||
lwz r31, 0(r29)
|
||||
|
||||
/*
|
||||
* if (--Thread_Dispatch_disable,--_ISR_Nest_level)
|
||||
* goto easy_exit;
|
||||
*/
|
||||
addi r30, r30, -1
|
||||
cmpwi r30, 0
|
||||
addi r31, r31, -1
|
||||
stw r30, 0(r28)
|
||||
stw r31, 0(r29)
|
||||
bne LABEL (easy_exit)
|
||||
cmpwi r31, 0
|
||||
|
||||
lwz r30, Switch_necessary(r11)
|
||||
|
||||
/*
|
||||
* #if ( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE )
|
||||
* restore stack
|
||||
* #endif
|
||||
*/
|
||||
lwz r1,0(r1)
|
||||
bne LABEL (easy_exit)
|
||||
lwz r30, 0(r30)
|
||||
lwz r31, Signal(r11)
|
||||
|
||||
/*
|
||||
* if ( _Context_Switch_necessary )
|
||||
* goto switch
|
||||
*/
|
||||
cmpwi r30, 0
|
||||
lwz r28, 0(r31)
|
||||
li r6,0
|
||||
bne LABEL (switch)
|
||||
/*
|
||||
* if ( !_ISR_Signals_to_thread_executing )
|
||||
* goto easy_exit
|
||||
* _ISR_Signals_to_thread_executing = 0;
|
||||
*/
|
||||
cmpwi r28, 0
|
||||
beq LABEL (easy_exit)
|
||||
|
||||
/*
|
||||
* switch:
|
||||
* call _Thread_Dispatch() or prepare to return to _ISR_Dispatch
|
||||
*/
|
||||
LABEL (switch):
|
||||
stw r6, 0(r31)
|
||||
/* Re-enable interrupts */
|
||||
lwz r0, IP_MSR(r1)
|
||||
/* R2 and R13 still hold their values from the last call */
|
||||
mtmsr r0
|
||||
bl SYM (_Thread_Dispatch)
|
||||
/* NOP marker for debuggers */
|
||||
or r6,r6,r6
|
||||
/*
|
||||
* prepare to get out of interrupt
|
||||
*/
|
||||
/* Re-disable IRQs */
|
||||
#if (PPC_USE_SPRG)
|
||||
mfspr r0, sprg2
|
||||
#else
|
||||
lis r11,_CPU_IRQ_info@ha
|
||||
addi r11,r11,_CPU_IRQ_info@l
|
||||
lwz r0,msr_initial(r11)
|
||||
lis r5,~PPC_MSR_DISABLE_MASK@ha
|
||||
ori r5,r5,~PPC_MSR_DISABLE_MASK@l
|
||||
and r0,r0,r5
|
||||
#endif
|
||||
mtmsr r0
|
||||
|
||||
/*
|
||||
* easy_exit:
|
||||
* prepare to get out of interrupt
|
||||
* return from interrupt
|
||||
*/
|
||||
LABEL (easy_exit):
|
||||
lwz r5, IP_CR(r1)
|
||||
lwz r6, IP_CTR(r1)
|
||||
lwz r7, IP_XER(r1)
|
||||
lwz r8, IP_LR(r1)
|
||||
lwz r9, IP_PC(r1)
|
||||
lwz r10, IP_MSR(r1)
|
||||
mtcrf 255,r5
|
||||
mtctr r6
|
||||
mtxer r7
|
||||
mtlr r8
|
||||
MTPC (r9)
|
||||
MTMSR (r10)
|
||||
lwz r0, IP_0(r1)
|
||||
lwz r2, IP_2(r1)
|
||||
lwz r3, IP_3(r1)
|
||||
lwz r4, IP_4(r1)
|
||||
lwz r5, IP_5(r1)
|
||||
lwz r6, IP_6(r1)
|
||||
lwz r7, IP_7(r1)
|
||||
lwz r8, IP_8(r1)
|
||||
lwz r9, IP_9(r1)
|
||||
lwz r10, IP_10(r1)
|
||||
lwz r11, IP_11(r1)
|
||||
lwz r12, IP_12(r1)
|
||||
lwz r13, IP_13(r1)
|
||||
lmw r28, IP_28(r1)
|
||||
lwz r1, 0(r1)
|
||||
@@ -1,59 +0,0 @@
|
||||
/*
|
||||
* PowerPC Cache enable routines
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
#include <rtems/system.h>
|
||||
|
||||
#define PPC_Get_HID0( _value ) \
|
||||
do { \
|
||||
_value = 0; /* to avoid warnings */ \
|
||||
asm volatile( \
|
||||
"mfspr %0, 0x3f0;" /* get HID0 */ \
|
||||
"isync" \
|
||||
: "=r" (_value) \
|
||||
: "0" (_value) \
|
||||
); \
|
||||
} while (0)
|
||||
|
||||
#define PPC_Set_HID0( _value ) \
|
||||
do { \
|
||||
asm volatile( \
|
||||
"isync;" \
|
||||
"mtspr 0x3f0, %0;" /* load HID0 */ \
|
||||
"isync" \
|
||||
: "=r" (_value) \
|
||||
: "0" (_value) \
|
||||
); \
|
||||
} while (0)
|
||||
|
||||
void powerpc_instruction_cache_enable ()
|
||||
{
|
||||
uint32_t value;
|
||||
|
||||
/*
|
||||
* Enable the instruction cache
|
||||
*/
|
||||
|
||||
PPC_Get_HID0( value );
|
||||
|
||||
value |= 0x00008000; /* Set ICE bit */
|
||||
|
||||
PPC_Set_HID0( value );
|
||||
}
|
||||
|
||||
void powerpc_data_cache_enable ()
|
||||
{
|
||||
uint32_t value;
|
||||
|
||||
/*
|
||||
* enable data cache
|
||||
*/
|
||||
|
||||
PPC_Get_HID0( value );
|
||||
|
||||
value |= 0x00004000; /* set DCE bit */
|
||||
|
||||
PPC_Set_HID0( value );
|
||||
}
|
||||
@@ -1,156 +0,0 @@
|
||||
/* -*- asm -*- */
|
||||
#ifndef __PPC_OFFS_H
|
||||
#define __PPC_OFFS_H
|
||||
|
||||
/*
|
||||
* Offsets for various Contexts
|
||||
*/
|
||||
.set GP_1, 0
|
||||
.set GP_2, (GP_1 + 4)
|
||||
.set GP_13, (GP_2 + 4)
|
||||
.set GP_14, (GP_13 + 4)
|
||||
|
||||
.set GP_15, (GP_14 + 4)
|
||||
.set GP_16, (GP_15 + 4)
|
||||
.set GP_17, (GP_16 + 4)
|
||||
.set GP_18, (GP_17 + 4)
|
||||
|
||||
.set GP_19, (GP_18 + 4)
|
||||
.set GP_20, (GP_19 + 4)
|
||||
.set GP_21, (GP_20 + 4)
|
||||
.set GP_22, (GP_21 + 4)
|
||||
|
||||
.set GP_23, (GP_22 + 4)
|
||||
.set GP_24, (GP_23 + 4)
|
||||
.set GP_25, (GP_24 + 4)
|
||||
.set GP_26, (GP_25 + 4)
|
||||
|
||||
.set GP_27, (GP_26 + 4)
|
||||
.set GP_28, (GP_27 + 4)
|
||||
.set GP_29, (GP_28 + 4)
|
||||
.set GP_30, (GP_29 + 4)
|
||||
|
||||
.set GP_31, (GP_30 + 4)
|
||||
.set GP_CR, (GP_31 + 4)
|
||||
.set GP_PC, (GP_CR + 4)
|
||||
.set GP_MSR, (GP_PC + 4)
|
||||
|
||||
#if (PPC_HAS_DOUBLE == 1)
|
||||
.set FP_0, 0
|
||||
.set FP_1, (FP_0 + 8)
|
||||
.set FP_2, (FP_1 + 8)
|
||||
.set FP_3, (FP_2 + 8)
|
||||
.set FP_4, (FP_3 + 8)
|
||||
.set FP_5, (FP_4 + 8)
|
||||
.set FP_6, (FP_5 + 8)
|
||||
.set FP_7, (FP_6 + 8)
|
||||
.set FP_8, (FP_7 + 8)
|
||||
.set FP_9, (FP_8 + 8)
|
||||
.set FP_10, (FP_9 + 8)
|
||||
.set FP_11, (FP_10 + 8)
|
||||
.set FP_12, (FP_11 + 8)
|
||||
.set FP_13, (FP_12 + 8)
|
||||
.set FP_14, (FP_13 + 8)
|
||||
.set FP_15, (FP_14 + 8)
|
||||
.set FP_16, (FP_15 + 8)
|
||||
.set FP_17, (FP_16 + 8)
|
||||
.set FP_18, (FP_17 + 8)
|
||||
.set FP_19, (FP_18 + 8)
|
||||
.set FP_20, (FP_19 + 8)
|
||||
.set FP_21, (FP_20 + 8)
|
||||
.set FP_22, (FP_21 + 8)
|
||||
.set FP_23, (FP_22 + 8)
|
||||
.set FP_24, (FP_23 + 8)
|
||||
.set FP_25, (FP_24 + 8)
|
||||
.set FP_26, (FP_25 + 8)
|
||||
.set FP_27, (FP_26 + 8)
|
||||
.set FP_28, (FP_27 + 8)
|
||||
.set FP_29, (FP_28 + 8)
|
||||
.set FP_30, (FP_29 + 8)
|
||||
.set FP_31, (FP_30 + 8)
|
||||
.set FP_FPSCR, (FP_31 + 8)
|
||||
#else
|
||||
.set FP_0, 0
|
||||
.set FP_1, (FP_0 + 4)
|
||||
.set FP_2, (FP_1 + 4)
|
||||
.set FP_3, (FP_2 + 4)
|
||||
.set FP_4, (FP_3 + 4)
|
||||
.set FP_5, (FP_4 + 4)
|
||||
.set FP_6, (FP_5 + 4)
|
||||
.set FP_7, (FP_6 + 4)
|
||||
.set FP_8, (FP_7 + 4)
|
||||
.set FP_9, (FP_8 + 4)
|
||||
.set FP_10, (FP_9 + 4)
|
||||
.set FP_11, (FP_10 + 4)
|
||||
.set FP_12, (FP_11 + 4)
|
||||
.set FP_13, (FP_12 + 4)
|
||||
.set FP_14, (FP_13 + 4)
|
||||
.set FP_15, (FP_14 + 4)
|
||||
.set FP_16, (FP_15 + 4)
|
||||
.set FP_17, (FP_16 + 4)
|
||||
.set FP_18, (FP_17 + 4)
|
||||
.set FP_19, (FP_18 + 4)
|
||||
.set FP_20, (FP_19 + 4)
|
||||
.set FP_21, (FP_20 + 4)
|
||||
.set FP_22, (FP_21 + 4)
|
||||
.set FP_23, (FP_22 + 4)
|
||||
.set FP_24, (FP_23 + 4)
|
||||
.set FP_25, (FP_24 + 4)
|
||||
.set FP_26, (FP_25 + 4)
|
||||
.set FP_27, (FP_26 + 4)
|
||||
.set FP_28, (FP_27 + 4)
|
||||
.set FP_29, (FP_28 + 4)
|
||||
.set FP_30, (FP_29 + 4)
|
||||
.set FP_31, (FP_30 + 4)
|
||||
.set FP_FPSCR, (FP_31 + 4)
|
||||
#endif
|
||||
|
||||
.set IP_LINK, 0
|
||||
/* PPC_ABI_EABI */
|
||||
.set IP_0, (IP_LINK + 8)
|
||||
.set IP_2, (IP_0 + 4)
|
||||
|
||||
.set IP_3, (IP_2 + 4)
|
||||
.set IP_4, (IP_3 + 4)
|
||||
.set IP_5, (IP_4 + 4)
|
||||
.set IP_6, (IP_5 + 4)
|
||||
|
||||
.set IP_7, (IP_6 + 4)
|
||||
.set IP_8, (IP_7 + 4)
|
||||
.set IP_9, (IP_8 + 4)
|
||||
.set IP_10, (IP_9 + 4)
|
||||
|
||||
.set IP_11, (IP_10 + 4)
|
||||
.set IP_12, (IP_11 + 4)
|
||||
.set IP_13, (IP_12 + 4)
|
||||
.set IP_28, (IP_13 + 4)
|
||||
|
||||
.set IP_29, (IP_28 + 4)
|
||||
.set IP_30, (IP_29 + 4)
|
||||
.set IP_31, (IP_30 + 4)
|
||||
.set IP_CR, (IP_31 + 4)
|
||||
|
||||
.set IP_CTR, (IP_CR + 4)
|
||||
.set IP_XER, (IP_CTR + 4)
|
||||
.set IP_LR, (IP_XER + 4)
|
||||
.set IP_PC, (IP_LR + 4)
|
||||
|
||||
.set IP_MSR, (IP_PC + 4)
|
||||
.set IP_END, (IP_MSR + 16)
|
||||
|
||||
/* _CPU_IRQ_info offsets */
|
||||
|
||||
/* These must be in this order */
|
||||
.set Nest_level, 0
|
||||
.set Disable_level, 4
|
||||
.set Vector_table, 8
|
||||
.set Stack, 12
|
||||
/* PPC_ABI_EABI */
|
||||
.set Default_r2, 16
|
||||
.set Default_r13, 20
|
||||
.set Switch_necessary, 24
|
||||
|
||||
.set Signal, Switch_necessary + 4
|
||||
.set msr_initial, Signal + 4
|
||||
|
||||
#endif /* __PPC_OFFS_H */
|
||||
@@ -1,295 +0,0 @@
|
||||
/* ictrl.c
|
||||
*
|
||||
* This routine installs and handles external interrupt vectors for
|
||||
* PowerPC 403 CPU built-in external interrupt controller
|
||||
*
|
||||
* Author: Thomas Doerfler <td@imd.m.isar.de>
|
||||
*
|
||||
* COPYRIGHT (c) 1998 by IMD, Puchheim, Germany
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of IMD not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* IMD makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* Modifications for PPC405GP by Dennis Ehlin
|
||||
*
|
||||
*/
|
||||
|
||||
#include "ictrl.h"
|
||||
#include <rtems.h>
|
||||
#include <rtems/libio.h>
|
||||
|
||||
#include <stdlib.h> /* for atexit() */
|
||||
|
||||
/*
|
||||
* ISR vector table to dispatch external interrupts
|
||||
*/
|
||||
|
||||
rtems_isr_entry ictrl_vector_table[PPC_IRQ_EXT_MAX];
|
||||
|
||||
/*
|
||||
*
|
||||
* some utilities to access the EXI* registers
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* clear bits in EXISR that have a bit set in mask
|
||||
*/
|
||||
#if defined(ppc405)
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
clr_exisr(uint32_t mask)
|
||||
{
|
||||
asm volatile ("mtdcr 0xC0,%0"::"r" (mask));/*EXISR*/
|
||||
}
|
||||
|
||||
/*
|
||||
* get value of EXISR
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE uint32_t
|
||||
get_exisr(void)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
asm volatile ("mfdcr %0,0xC0":"=r" (val));/*EXISR*/
|
||||
return val;
|
||||
}
|
||||
|
||||
/*
|
||||
* get value of EXIER
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE uint32_t
|
||||
get_exier(void)
|
||||
{
|
||||
uint32_t val;
|
||||
asm volatile ("mfdcr %0,0xC2":"=r" (val));/*EXIER*/
|
||||
return val;
|
||||
}
|
||||
|
||||
/*
|
||||
* set value of EXIER
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
set_exier(uint32_t val)
|
||||
{
|
||||
asm volatile ("mtdcr 0xC2,%0"::"r" (val));/*EXIER*/
|
||||
}
|
||||
|
||||
#else /* not ppc405 */
|
||||
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
clr_exisr(uint32_t mask)
|
||||
{
|
||||
asm volatile ("mtdcr 0x40,%0"::"r" (mask));/*EXISR*/
|
||||
}
|
||||
|
||||
/*
|
||||
* get value of EXISR
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE uint32_t
|
||||
get_exisr(void)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
asm volatile ("mfdcr %0,0x40":"=r" (val));/*EXISR*/
|
||||
return val;
|
||||
}
|
||||
|
||||
/*
|
||||
* get value of EXIER
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE uint32_t
|
||||
get_exier(void)
|
||||
{
|
||||
uint32_t val;
|
||||
asm volatile ("mfdcr %0,0x42":"=r" (val));/*EXIER*/
|
||||
return val;
|
||||
}
|
||||
|
||||
/*
|
||||
* set value of EXIER
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
set_exier(uint32_t val)
|
||||
{
|
||||
asm volatile ("mtdcr 0x42,%0"::"r" (val));/*EXIER*/
|
||||
}
|
||||
#endif /* ppc405 */
|
||||
/*
|
||||
* enable an external interrupt, make this interrupt consistent
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
enable_ext_irq( uint32_t mask)
|
||||
{
|
||||
rtems_interrupt_level level;
|
||||
|
||||
rtems_interrupt_disable(level);
|
||||
set_exier(get_exier() | ((mask)&PPC_EXI_MASK));
|
||||
rtems_interrupt_enable(level);
|
||||
}
|
||||
|
||||
/*
|
||||
* disable an external interrupt, make this interrupt consistent
|
||||
*/
|
||||
RTEMS_INLINE_ROUTINE void
|
||||
disable_ext_irq( uint32_t mask)
|
||||
{
|
||||
rtems_interrupt_level level;
|
||||
|
||||
rtems_interrupt_disable(level);
|
||||
set_exier(get_exier() & ~(mask) & PPC_EXI_MASK);
|
||||
rtems_interrupt_enable(level);
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* this function is called, when a external interrupt is present and
|
||||
* enabled but there is no handler installed. It will clear
|
||||
* the corresponding enable bits and call the spurious handler
|
||||
* present in the CPU Configuration Table, if any.
|
||||
*
|
||||
*/
|
||||
void
|
||||
ictrl_spurious_handler(uint32_t spurious_mask,
|
||||
CPU_Interrupt_frame *cpu_frame)
|
||||
{
|
||||
int v;
|
||||
extern void (*bsp_spurious_handler)(uint32_t vector, CPU_Interrupt_frame *);
|
||||
|
||||
for (v=0; v < PPC_IRQ_EXT_MAX; v++) {
|
||||
if (VEC_TO_EXMSK(v) & spurious_mask) {
|
||||
clr_exisr(VEC_TO_EXMSK(v));
|
||||
disable_ext_irq(VEC_TO_EXMSK(v));
|
||||
#if 0
|
||||
printf("spurious external interrupt: %d at pc 0x%x; disabling\n",
|
||||
vector, cpu_frame->Interrupt.pcoqfront);
|
||||
#endif
|
||||
if (bsp_spurious_handler) {
|
||||
bsp_spurious_handler(v + PPC_IRQ_EXT_BASE,cpu_frame);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* ISR Handler: this is called from the primary exception dispatcher
|
||||
*/
|
||||
|
||||
void
|
||||
ictrl_isr(rtems_vector_number vector,CPU_Interrupt_frame *cpu_frame)
|
||||
{
|
||||
uint32_t istat,
|
||||
mask,
|
||||
global_vec;
|
||||
int exvec;
|
||||
rtems_isr_entry handler;
|
||||
|
||||
istat = get_exisr() & get_exier() & PPC_EXI_MASK;
|
||||
|
||||
/* FIXME: this may be speeded up using cntlzw instruction */
|
||||
for (exvec = 0;exvec < PPC_IRQ_EXT_MAX;exvec++) {
|
||||
mask = VEC_TO_EXMSK(exvec);
|
||||
if (0 != (istat & mask)) {
|
||||
/*clr_exisr(mask); too early to ack*/
|
||||
handler = ictrl_vector_table[exvec];
|
||||
if (handler) {
|
||||
istat &= ~mask;
|
||||
global_vec = exvec + PPC_IRQ_EXT_BASE;
|
||||
(handler)(global_vec);
|
||||
}
|
||||
clr_exisr(mask);/* now we can ack*/
|
||||
}
|
||||
}
|
||||
if (istat != 0) { /* anything left? then we have a spurious interrupt */
|
||||
ictrl_spurious_handler(istat,cpu_frame);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* the following functions form the user interface
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
*
|
||||
* install a user vector for one of the external interrupt sources
|
||||
*
|
||||
*/
|
||||
rtems_status_code
|
||||
ictrl_set_vector(rtems_isr_entry new_handler,
|
||||
uint32_t vector,
|
||||
rtems_isr_entry *old_handler
|
||||
)
|
||||
{
|
||||
/*
|
||||
* We put the actual user ISR address in 'ictrl_vector_table'. This will
|
||||
* be used by the _ictrl_isr so the user gets control.
|
||||
*/
|
||||
|
||||
/* check for valid vector range */
|
||||
if ((vector >= PPC_IRQ_EXT_BASE) &&
|
||||
(vector < PPC_IRQ_EXT_BASE + PPC_IRQ_EXT_MAX)) {
|
||||
/* return old handler entry */
|
||||
*old_handler = ictrl_vector_table[vector - PPC_IRQ_EXT_BASE];
|
||||
|
||||
if (new_handler != NULL) {
|
||||
/* store handler function... */
|
||||
ictrl_vector_table[vector - PPC_IRQ_EXT_BASE] = new_handler;
|
||||
/* then enable it in EXIER register */
|
||||
enable_ext_irq(VEC_TO_EXMSK(vector - PPC_IRQ_EXT_BASE));
|
||||
}
|
||||
else { /* new_handler == NULL */
|
||||
/* then disable it in EXIER register */
|
||||
disable_ext_irq(VEC_TO_EXMSK(vector - PPC_IRQ_EXT_BASE));
|
||||
ictrl_vector_table[vector - PPC_IRQ_EXT_BASE] = NULL;
|
||||
}
|
||||
return RTEMS_SUCCESSFUL;
|
||||
}
|
||||
else {
|
||||
return RTEMS_INVALID_NUMBER;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Called via atexit()
|
||||
* deactivate the interrupt controller
|
||||
*/
|
||||
|
||||
void
|
||||
ictrl_exit(void)
|
||||
{
|
||||
/* mark them all unused */
|
||||
disable_ext_irq(~0);
|
||||
clr_exisr(~0);
|
||||
|
||||
}
|
||||
|
||||
/*
|
||||
* activate the interrupt controller
|
||||
*/
|
||||
|
||||
rtems_status_code
|
||||
ictrl_init(void)
|
||||
{
|
||||
proc_ptr dummy;
|
||||
|
||||
/* mark them all unused */
|
||||
disable_ext_irq(~0);
|
||||
clr_exisr(~0);
|
||||
|
||||
/* install the external interrupt handler */
|
||||
_CPU_ISR_install_vector(PPC_IRQ_EXTERNAL,
|
||||
ictrl_isr,
|
||||
&dummy);
|
||||
atexit(ictrl_exit);
|
||||
return RTEMS_SUCCESSFUL;
|
||||
}
|
||||
@@ -1,95 +0,0 @@
|
||||
/* ictrl.h
|
||||
*
|
||||
* This file contains definitions and declarations for the
|
||||
* PowerPC 403 CPU built-in external interrupt controller
|
||||
*
|
||||
*
|
||||
* Author: Thomas Doerfler <td@imd.m.isar.de>
|
||||
*
|
||||
* COPYRIGHT (c) 1998 by IMD, Puchheim, Germany
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of IMD not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* IMD makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* Modifications for PPC405GP by Dennis Ehlin
|
||||
*
|
||||
*/
|
||||
|
||||
|
||||
#ifndef _ICTRL_H
|
||||
#define _ICTRL_H
|
||||
|
||||
#include <rtems.h>
|
||||
#include <rtems/system.h>
|
||||
#include <rtems/score/isr.h>
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/*
|
||||
* definitions for second level IRQ handler support
|
||||
* External Interrupts via EXTERNAL/EISR
|
||||
*/
|
||||
#define PPC_IRQ_EXT_BASE (PPC_IRQ_LAST+1)
|
||||
|
||||
/* mask for external interrupt status in EXIER/EXISR register */
|
||||
/* note: critical interrupt is in these registers aswell */
|
||||
#ifndef ppc405
|
||||
#define PPC_EXI_MASK 0x0FFFFFFF
|
||||
#else /* ppc405 */
|
||||
#define PPC_EXI_MASK 0xFFFFFFFF
|
||||
#endif /* ppc405 */
|
||||
|
||||
#ifndef ppc405
|
||||
#define PPC_IRQ_EXT_SPIR (PPC_IRQ_EXT_BASE+4)
|
||||
#define PPC_IRQ_EXT_SPIT (PPC_IRQ_EXT_BASE+5)
|
||||
#else /* ppc405 */
|
||||
#define PPC_IRQ_EXT_UART0 (PPC_IRQ_EXT_BASE+0)
|
||||
#define PPC_IRQ_EXT_UART1 (PPC_IRQ_EXT_BASE+1)
|
||||
#endif /* ppc405 */
|
||||
#define PPC_IRQ_EXT_JTAGR (PPC_IRQ_EXT_BASE+6)
|
||||
#define PPC_IRQ_EXT_JTAGT (PPC_IRQ_EXT_BASE+7)
|
||||
#define PPC_IRQ_EXT_DMA0 (PPC_IRQ_EXT_BASE+8)
|
||||
#define PPC_IRQ_EXT_DMA1 (PPC_IRQ_EXT_BASE+9)
|
||||
#define PPC_IRQ_EXT_DMA2 (PPC_IRQ_EXT_BASE+10)
|
||||
#define PPC_IRQ_EXT_DMA3 (PPC_IRQ_EXT_BASE+11)
|
||||
#define PPC_IRQ_EXT_0 (PPC_IRQ_EXT_BASE+27)
|
||||
#define PPC_IRQ_EXT_1 (PPC_IRQ_EXT_BASE+28)
|
||||
#define PPC_IRQ_EXT_2 (PPC_IRQ_EXT_BASE+29)
|
||||
#define PPC_IRQ_EXT_3 (PPC_IRQ_EXT_BASE+30)
|
||||
#define PPC_IRQ_EXT_4 (PPC_IRQ_EXT_BASE+31)
|
||||
|
||||
#define PPC_IRQ_EXT_MAX (32)
|
||||
|
||||
#define VEC_TO_EXMSK(v) (0x80000000 >> (v))
|
||||
|
||||
/*
|
||||
*
|
||||
* install a user vector for one of the external interrupt sources
|
||||
*
|
||||
*/
|
||||
rtems_status_code
|
||||
ictrl_set_vector(rtems_isr_entry new_handler,
|
||||
uint32_t vector,
|
||||
rtems_isr_entry *old_handler
|
||||
);
|
||||
/*
|
||||
* activate the interrupt controller
|
||||
*/
|
||||
rtems_status_code
|
||||
ictrl_init(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* _ICTRL_H */
|
||||
/* end of include file */
|
||||
@@ -1,435 +0,0 @@
|
||||
/* align_h.s 1.1 - 95/12/04
|
||||
*
|
||||
* This file contains the assembly code for the PowerPC 403
|
||||
* alignment exception handler for RTEMS.
|
||||
*
|
||||
* Based upon IBM provided code with the following release:
|
||||
*
|
||||
* This source code has been made available to you by IBM on an AS-IS
|
||||
* basis. Anyone receiving this source is licensed under IBM
|
||||
* copyrights to use it in any way he or she deems fit, including
|
||||
* copying it, modifying it, compiling it, and redistributing it either
|
||||
* with or without modifications. No license under IBM patents or
|
||||
* patent applications is to be implied by the copyright license.
|
||||
*
|
||||
* Any user of this software should understand that IBM cannot provide
|
||||
* technical support for this software and will not be responsible for
|
||||
* any consequences resulting from the use of this software.
|
||||
*
|
||||
* Any person who transfers this source code or any derivative work
|
||||
* must include the IBM copyright notice, this paragraph, and the
|
||||
* preceding two paragraphs in the transferred software.
|
||||
*
|
||||
* COPYRIGHT I B M CORPORATION 1995
|
||||
* LICENSED MATERIAL - PROGRAM PROPERTY OF I B M
|
||||
*
|
||||
* Modifications:
|
||||
*
|
||||
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
||||
*
|
||||
* COPYRIGHT (c) 1995 by i-cubed ltd.
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of i-cubed limited not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* i-cubed limited makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
#include <rtems/asm.h>
|
||||
#define ALIGN_REGS 0x0140
|
||||
|
||||
|
||||
.set CACHE_SIZE,16 # cache line size of 32 bytes
|
||||
.set CACHE_SIZE_L2,4 # cache line size, log 2
|
||||
|
||||
.set Open_gpr0,0
|
||||
.set Open_gpr1,4
|
||||
.set Open_gpr2,8
|
||||
.set Open_gpr3,12
|
||||
.set Open_gpr4,16
|
||||
.set Open_gpr5,20
|
||||
.set Open_gpr6,24
|
||||
.set Open_gpr7,28
|
||||
.set Open_gpr8,32
|
||||
.set Open_gpr9,36
|
||||
.set Open_gpr10,40
|
||||
.set Open_gpr11,44
|
||||
.set Open_gpr12,48
|
||||
.set Open_gpr13,52
|
||||
.set Open_gpr14,56
|
||||
.set Open_gpr15,60
|
||||
.set Open_gpr16,64
|
||||
.set Open_gpr17,68
|
||||
.set Open_gpr18,72
|
||||
.set Open_gpr19,76
|
||||
.set Open_gpr20,80
|
||||
.set Open_gpr21,84
|
||||
.set Open_gpr22,88
|
||||
.set Open_gpr23,92
|
||||
.set Open_gpr24,96
|
||||
.set Open_gpr25,100
|
||||
.set Open_gpr26,104
|
||||
.set Open_gpr27,108
|
||||
.set Open_gpr28,112
|
||||
.set Open_gpr29,116
|
||||
.set Open_gpr30,120
|
||||
.set Open_gpr31,124
|
||||
.set Open_xer,128
|
||||
.set Open_lr,132
|
||||
.set Open_ctr,136
|
||||
.set Open_cr,140
|
||||
.set Open_srr2,144
|
||||
.set Open_srr3,148
|
||||
.set Open_srr0,152
|
||||
.set Open_srr1,156
|
||||
|
||||
|
||||
/*
|
||||
* This code makes several assumptions for processing efficiency
|
||||
* * General purpose registers are continuous in the image, beginning with
|
||||
* Open_gpr0
|
||||
* * Hash table is highly dependent on opcodes - opcode changes *will*
|
||||
* require rework of the instruction decode mechanism.
|
||||
*/
|
||||
|
||||
.text
|
||||
.globl align_h
|
||||
|
||||
.align CACHE_SIZE_L2
|
||||
align_h:
|
||||
/*-----------------------------------------------------------------------
|
||||
* Store GPRs in Open Reg save area
|
||||
* Set up r2 as base reg, r1 pointing to Open Reg save area
|
||||
*----------------------------------------------------------------------*/
|
||||
stmw r0,ALIGN_REGS(r0)
|
||||
li r1,ALIGN_REGS
|
||||
/*-----------------------------------------------------------------------
|
||||
* Store special purpose registers in reg save area
|
||||
*----------------------------------------------------------------------*/
|
||||
mfxer r7
|
||||
mflr r8
|
||||
mfcr r9
|
||||
mfctr r10
|
||||
stw r7,Open_xer(r1)
|
||||
stw r8,Open_lr(r1)
|
||||
stw r9,Open_cr(r1)
|
||||
stw r10,Open_ctr(r1)
|
||||
mfspr r7, srr2 /* SRR 2 */
|
||||
mfspr r8, srr3 /* SRR 3 */
|
||||
mfspr r9, srr0 /* SRR 0 */
|
||||
mfspr r10, srr1 /* SRR 1 */
|
||||
stw r7,Open_srr2(r1)
|
||||
stw r8,Open_srr3(r1)
|
||||
stw r9,Open_srr0(r1)
|
||||
stw r10,Open_srr1(r1)
|
||||
|
||||
/* Set up common registers */
|
||||
mfspr r5, dear /* DEAR: R5 is data exception address */
|
||||
lwz r9,Open_srr0(r1) /* get faulting instruction */
|
||||
addi r7,r9,4 /* bump instruction */
|
||||
stw r7,Open_srr0(r1) /* restore to image */
|
||||
lwz r9, 0(r9) /* retrieve actual instruction */
|
||||
rlwinm r6,r9,18,25,29 /* r6 is RA * 4 field from instruction */
|
||||
rlwinm r7,r9,6,26,31 /* r7 is primary opcode */
|
||||
bl ref_point /* establish addressibility */
|
||||
ref_point:
|
||||
mflr r11 /* r11 is the anchor point for ref_point */
|
||||
addi r10, r7, -31 /* r10 = r7 - 31 */
|
||||
rlwinm r10,r10,2,2,31 /* r10 *= 4 */
|
||||
add r10, r10, r11 /* r10 += anchor point */
|
||||
lwz r10, primary_jt-ref_point(r10)
|
||||
mtlr r10
|
||||
rlwinm r8,r9,13,25,29 /* r8 is RD * 4 */
|
||||
la r7,Open_gpr0(r1) /* r7 is address of GPR 0 in list */
|
||||
blr
|
||||
primary_jt:
|
||||
.long xform
|
||||
.long lwz
|
||||
.long lwzu
|
||||
.long 0
|
||||
.long 0
|
||||
.long stw
|
||||
.long stwu
|
||||
.long 0
|
||||
.long 0
|
||||
.long lhz
|
||||
.long lhzu
|
||||
.long lha
|
||||
.long lhau
|
||||
.long sth
|
||||
.long sthu
|
||||
.long lmw
|
||||
.long stmw
|
||||
/*
|
||||
* handlers
|
||||
*/
|
||||
/*
|
||||
* xform instructions require an additional decode. Fortunately, a relatively
|
||||
* simple hash step breaks the instructions out with no collisions
|
||||
*/
|
||||
xform:
|
||||
rlwinm r7,r9,31,22,31 /* r7 is secondary opcode */
|
||||
rlwinm r10,r7,27,5,31 /* r10 = r7 >> 5 */
|
||||
add r10,r7,r10 /* r10 = r7 + r10 */
|
||||
rlwinm r10,r10,2,25,29 /* r10 = (r10 & 0x1F) * 4 */
|
||||
add r10,r10,r11 /* r10 += anchor point */
|
||||
lwz r10, secondary_ht-ref_point(r10)
|
||||
mtlr r10
|
||||
la r7,Open_gpr0(r1) /* r7 is address of GPR 0 in list */
|
||||
rlwinm r8,r9,13,25,29 /* r8 is RD * 4 */
|
||||
blrl
|
||||
|
||||
secondary_ht:
|
||||
.long lhzux /* b 0 0x137 */
|
||||
.long lhax /* b 1 0x157 */
|
||||
.long lhaux /* b 2 0x177 */
|
||||
.long sthx /* b 3 0x197 */
|
||||
.long sthux /* b 4 0x1b7 */
|
||||
.long 0 /* b 5 */
|
||||
.long lwbrx /* b 6 0x216 */
|
||||
.long 0 /* b 7 */
|
||||
.long 0 /* b 8 */
|
||||
.long 0 /* b 9 */
|
||||
.long stwbrx /* b A 0x296 */
|
||||
.long 0 /* b B */
|
||||
.long 0 /* b C */
|
||||
.long 0 /* b D */
|
||||
.long lhbrx /* b E 0x316 */
|
||||
.long 0 /* b F */
|
||||
.long 0 /* b 10 */
|
||||
.long 0 /* b 11 */
|
||||
.long sthbrx /* b 12 0x396 */
|
||||
.long 0 /* b 13 */
|
||||
.long lwarx /* b 14 0x014 */
|
||||
.long dcbz /* b 15 0x3f6 */
|
||||
.long 0 /* b 16 */
|
||||
.long lwzx /* b 17 0x017 */
|
||||
.long lwzux /* b 18 0x037 */
|
||||
.long 0 /* b 19 */
|
||||
.long stwcx /* b 1A 0x096 */
|
||||
.long stwx /* b 1B 0x097 */
|
||||
.long stwux /* b 1C 0x0B7 */
|
||||
.long 0 /* b 1D */
|
||||
.long 0 /* b 1E */
|
||||
.long lhzx /* b 1F 0x117 */
|
||||
|
||||
/*
|
||||
* for all handlers
|
||||
* r4 - Addressability to interrupt context
|
||||
* r5 - DEAR address (faulting data address)
|
||||
* r6 - RA field * 4
|
||||
* r7 - Address of GPR 0 in image
|
||||
* r8 - RD field * 4
|
||||
* r9 - Failing instruction
|
||||
*/
|
||||
|
||||
/* Load halfword algebraic with update */
|
||||
lhau:
|
||||
/* Load halfword algebraic with update indexed */
|
||||
lhaux:
|
||||
stwx r5,r7,r6 /* update RA with effective addr */
|
||||
|
||||
/* Load halfword algebraic */
|
||||
lha:
|
||||
/* Load halfword algebraic indexed */
|
||||
lhax:
|
||||
lswi r10,r5,2 /* load two bytes into r10 */
|
||||
srawi r10,r10,16 /* shift right 2 bytes, extending sign */
|
||||
stwx r10,r7,r8 /* update reg image */
|
||||
b align_complete /* return */
|
||||
|
||||
/* Load Half Word Byte-Reversed Indexed */
|
||||
lhbrx:
|
||||
lswi r10,r5,2 /* load two bytes from DEAR into r10 */
|
||||
rlwinm r10,r10,0,0,15 /* mask off lower 2 bytes */
|
||||
stwbrx r10,r7,r8 /* store reversed in reg image */
|
||||
b align_complete /* return */
|
||||
|
||||
/* Load Half Word and Zero with Update */
|
||||
lhzu:
|
||||
/* Load Half Word and Zero with Update Indexed */
|
||||
lhzux:
|
||||
stwx r5,r7,r6 /* update RA with effective addr */
|
||||
|
||||
/* Load Half Word and Zero */
|
||||
lhz:
|
||||
/* Load Half Word and Zero Indexed */
|
||||
lhzx:
|
||||
lswi r10,r5,2 /* load two bytes from DEAR into r10 */
|
||||
rlwinm r10,r10,16,16,31 /* shift right 2 bytes, with zero fill */
|
||||
stwx r10,r7,r8 /* update reg image */
|
||||
b align_complete /* return */
|
||||
|
||||
/*
|
||||
* Load Multiple Word
|
||||
*/
|
||||
lmw:
|
||||
lwzx r9,r6,r7 /* R9 contains saved value of RA */
|
||||
addi r10,r7,32*4 /* r10 points to r31 in image + 4 */
|
||||
rlwinm r8,r8,30,2,31 /* r8 >>= 2 (recovers RT) */
|
||||
subfic r8,r8,32 /* r8 is reg count to load */
|
||||
mtctr r8 /* load counter */
|
||||
addi r8,r8,-1 /* r8-- */
|
||||
rlwinm r8,r8,2,2,31 /* r8 *= 4 */
|
||||
add r5,r5,r8 /* update DEAR to point to last reg */
|
||||
lwmloop:
|
||||
lswi r11,r5,4 /* load r11 with 4 bytes from DEAR */
|
||||
stwu r11,-4(r10) /* load image and decrement pointer */
|
||||
addi r5,r5,-4 /* decrement effective address */
|
||||
bdnz lwmloop
|
||||
stwx r9,r6,r7 /* restore RA (in case it was trashed) */
|
||||
b align_complete /* return */
|
||||
|
||||
/*
|
||||
* Load Word and Reserve Indexed
|
||||
*/
|
||||
lwarx:
|
||||
lswi r10,r5,4 /* load four bytes from DEAR into r10 */
|
||||
stwx r10,r7,r8 /* update reg image */
|
||||
rlwinm r5,r5,0,0,29 /* Word align address */
|
||||
lwarx r10,0,r5 /* Set reservation */
|
||||
b align_complete /* return */
|
||||
|
||||
/*
|
||||
* Load Word Byte-Reversed Indexed
|
||||
*/
|
||||
lwbrx:
|
||||
lswi r10,r5,4 /* load four bytes from DEAR into r10 */
|
||||
stwbrx r10,r7,r8 /* store reversed in reg image */
|
||||
b align_complete /* return */
|
||||
|
||||
/* Load Word and Zero with Update */
|
||||
lwzu:
|
||||
/* Load Word and Zero with Update Indexed */
|
||||
lwzux:
|
||||
stwx r5,r7,r6 /* update RA with effective addr */
|
||||
|
||||
/* Load Word and Zero */
|
||||
lwz:
|
||||
/* Load Word and Zero Indexed */
|
||||
lwzx:
|
||||
lswi r10,r5,4 /* load four bytes from DEAR into r10 */
|
||||
stwx r10,r7,r8 /* update reg image */
|
||||
b align_complete /* return */
|
||||
|
||||
/* Store instructions */
|
||||
|
||||
/* */
|
||||
/* Store Half Word and Update */
|
||||
sthu:
|
||||
/* Store Half Word and Update Indexed */
|
||||
sthux:
|
||||
stwx r5,r7,r6 /* Update RA with effective address */
|
||||
|
||||
/* Store Half Word */
|
||||
sth:
|
||||
/* Store Half Word Indexed */
|
||||
sthx:
|
||||
lwzx r10,r8,r7 /* retrieve source register value */
|
||||
rlwinm r10,r10,16,0,15 /* move two bytes to high end of reg */
|
||||
stswi r10,r5,2 /* store bytes to DEAR address */
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Store Half Word Byte-Reversed Indexed */
|
||||
sthbrx:
|
||||
lwbrx r10,r8,r7 /* retrieve src reg value byte reversed */
|
||||
stswi r10,r5,2 /* move two bytes to DEAR address */
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Store Multiple Word */
|
||||
stmw:
|
||||
addi r10,r7,32*4 /* r10 points to r31 in image + 4 */
|
||||
rlwinm r8,r8,30,2,31 /* r8 >>= 2 (recovers RT) */
|
||||
subfic r8,r8,32 /* r8 is reg count to load */
|
||||
mtctr r8 /* load counter */
|
||||
addi r8,r8,-1 /* r8-- */
|
||||
rlwinm r8,r8,2,2,31 /* r8 *= 4 */
|
||||
add r5,r5,r8 /* update DEAR to point to last reg */
|
||||
stmloop:
|
||||
lwzu r11,-4(r10) /* get register value */
|
||||
stswi r11,r5,4 /* output to DEAR address */
|
||||
addi r5,r5,-4 /* decrement effective address */
|
||||
bdnz stmloop
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Store Word and Update */
|
||||
stwu:
|
||||
/* Store Word and Update Indexed */
|
||||
stwux:
|
||||
stwx r5,r7,r6 /* Update RA with effective address */
|
||||
|
||||
/* Store Word */
|
||||
stw:
|
||||
/* Store Word Indexed */
|
||||
stwx:
|
||||
lwzx r10,r8,r7 /* retrieve source register value */
|
||||
stswi r10,r5,4 /* store bytes to DEAR address */
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Store Word Byte-Reversed Indexed */
|
||||
stwbrx:
|
||||
lwbrx r10,r8,r7 /* retrieve src reg value byte reversed */
|
||||
stswi r10,r5,4 /* move two bytes to DEAR address */
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Store Word Conditional Indexed */
|
||||
stwcx:
|
||||
rlwinm r10,r5,0,0,29 /* r10 = word aligned DEAR */
|
||||
lwz r11,0(r10) /* save original value of store */
|
||||
stwcx. r11,r0,r10 /* attempt store to address */
|
||||
bne stwcx_moveon /* store failed, move on */
|
||||
stw r11,0(r10) /* repair damage */
|
||||
lwzx r9,r7,r8 /* get register value */
|
||||
stswi r10,r5,4 /* store bytes to DEAR address */
|
||||
stwcx_moveon:
|
||||
mfcr r11 /* get condition reg */
|
||||
lwz r9,Open_cr(r1) /* get condition reg image */
|
||||
rlwimi r9,r11,0,0,2 /* insert 3 CR bits into cr image */
|
||||
lwz r11,Open_xer(r1) /* get XER reg */
|
||||
rlwimi r9,r11,29,2,2 /* insert XER SO bit into cr image */
|
||||
stw r9,Open_cr(r1) /* store cr image */
|
||||
b align_complete /* return */
|
||||
|
||||
/* */
|
||||
/* Data Cache Block Zero */
|
||||
dcbz:
|
||||
rlwinm r5,r5,0,0,31-CACHE_SIZE_L2
|
||||
/* get address to nearest Cache line */
|
||||
addi r5,r5,-4 /* adjust by a word */
|
||||
addi r10,r0,CACHE_SIZE/4 /* set counter value */
|
||||
mtctr r10
|
||||
addi r11,r0,0 /* r11 = 0 */
|
||||
dcbz_loop:
|
||||
stwu r11,4(r5) /* store a word and update EA */
|
||||
bdnz dcbz_loop
|
||||
b align_complete /* return */
|
||||
|
||||
align_complete:
|
||||
/*-----------------------------------------------------------------------
|
||||
* Restore regs and return from the interrupt
|
||||
*----------------------------------------------------------------------*/
|
||||
lmw r24,Open_xer+ALIGN_REGS(r0)
|
||||
mtxer r24
|
||||
mtlr r25
|
||||
mtctr r26
|
||||
mtcrf 0xFF, r27
|
||||
mtspr srr2, r28 /* SRR 2 */
|
||||
mtspr srr3, r29 /* SRR 3 */
|
||||
mtspr srr0, r30 /* SRR 0 */
|
||||
mtspr srr1, r31 /* SRR 1 */
|
||||
lmw r1,Open_gpr1+ALIGN_REGS(r0)
|
||||
lwz r0,Open_gpr0+ALIGN_REGS(r0)
|
||||
rfi
|
||||
@@ -1,203 +0,0 @@
|
||||
/* vectors.s 1.1 - 95/12/04
|
||||
*
|
||||
* This file contains the assembly code for the PowerPC 403
|
||||
* interrupt veneers for RTEMS.
|
||||
*
|
||||
* Author: Andrew Bray <andy@i-cubed.co.uk>
|
||||
*
|
||||
* COPYRIGHT (c) 1995 by i-cubed ltd.
|
||||
*
|
||||
* To anyone who acknowledges that this file is provided "AS IS"
|
||||
* without any express or implied warranty:
|
||||
* permission to use, copy, modify, and distribute this file
|
||||
* for any purpose is hereby granted without fee, provided that
|
||||
* the above copyright notice and this notice appears in all
|
||||
* copies, and that the name of i-cubed limited not be used in
|
||||
* advertising or publicity pertaining to distribution of the
|
||||
* software without specific, written prior permission.
|
||||
* i-cubed limited makes no representations about the suitability
|
||||
* of this software for any purpose.
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* The issue with this file is getting it loaded at the right place.
|
||||
* The first vector MUST be at address 0x????0100.
|
||||
* How this is achieved is dependant on the tool chain.
|
||||
*
|
||||
* However the basic mechanism for ELF assemblers is to create a
|
||||
* section called ".vectors", which will be loaded to an address
|
||||
* between 0x????0000 and 0x????0100 (inclusive) via a link script.
|
||||
*
|
||||
* The variable 'PPC_VECTOR_FILE_BASE' must be defined to be the
|
||||
* offset from 0x????0000 to the first location in the file. This
|
||||
* will usually be 0x0000 or 0x0100.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
#include <bsp.h> /* PPC_VECTOR_FILE_BASE */
|
||||
#include <rtems/asm.h>
|
||||
|
||||
#ifndef PPC_VECTOR_FILE_BASE
|
||||
#error "PPC_VECTOR_FILE_BASE is not defined."
|
||||
#endif
|
||||
|
||||
/* Where this file will be loaded */
|
||||
.set file_base, PPC_VECTOR_FILE_BASE
|
||||
|
||||
/* Offset to store reg 0 */
|
||||
|
||||
.set IP_LINK, 0
|
||||
/* PPC_ABI_EABI */
|
||||
.set IP_0, (IP_LINK + 8)
|
||||
.set IP_2, (IP_0 + 4)
|
||||
|
||||
.set IP_3, (IP_2 + 4)
|
||||
.set IP_4, (IP_3 + 4)
|
||||
.set IP_5, (IP_4 + 4)
|
||||
.set IP_6, (IP_5 + 4)
|
||||
|
||||
.set IP_7, (IP_6 + 4)
|
||||
.set IP_8, (IP_7 + 4)
|
||||
.set IP_9, (IP_8 + 4)
|
||||
.set IP_10, (IP_9 + 4)
|
||||
|
||||
.set IP_11, (IP_10 + 4)
|
||||
.set IP_12, (IP_11 + 4)
|
||||
.set IP_13, (IP_12 + 4)
|
||||
.set IP_28, (IP_13 + 4)
|
||||
|
||||
.set IP_29, (IP_28 + 4)
|
||||
.set IP_30, (IP_29 + 4)
|
||||
.set IP_31, (IP_30 + 4)
|
||||
.set IP_CR, (IP_31 + 4)
|
||||
|
||||
.set IP_CTR, (IP_CR + 4)
|
||||
.set IP_XER, (IP_CTR + 4)
|
||||
.set IP_LR, (IP_XER + 4)
|
||||
.set IP_PC, (IP_LR + 4)
|
||||
|
||||
.set IP_MSR, (IP_PC + 4)
|
||||
|
||||
.set IP_END, (IP_MSR + 16)
|
||||
|
||||
/* Vector offsets */
|
||||
.set begin_vector,0x0000
|
||||
.set crit_vector,0x0100
|
||||
.set mach_vector,0x0200
|
||||
.set prot_vector,0x0300
|
||||
.set ext_vector,0x0500
|
||||
.set align_vector,0x0600
|
||||
.set prog_vector,0x0700
|
||||
.set dec_vector,0x0900
|
||||
.set sys_vector,0x0C00
|
||||
.set pit_vector,0x1000
|
||||
.set fit_vector,0x1010
|
||||
.set wadt_vector,0x1020
|
||||
.set debug_vector,0x2000
|
||||
|
||||
/* Go to the right section */
|
||||
#if PPC_ASM == PPC_ASM_ELF
|
||||
.section .vectors,"awx",@progbits
|
||||
#endif
|
||||
|
||||
PUBLIC_VAR (__vectors)
|
||||
SYM (__vectors):
|
||||
|
||||
/* Critical error handling */
|
||||
.org crit_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_CRIT
|
||||
b PROC (_ISR_HandlerC)
|
||||
|
||||
/* Machine check exception */
|
||||
.org mach_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_MCHECK
|
||||
b PROC (_ISR_HandlerC)
|
||||
|
||||
/* Protection exception */
|
||||
.org prot_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_PROTECT
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* External interrupt */
|
||||
.org ext_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_EXTERNAL
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* Align exception */
|
||||
.org align_vector - file_base
|
||||
.extern align_h
|
||||
b align_h
|
||||
|
||||
/* Program exception */
|
||||
.org prog_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_PROGRAM
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* Decrementer exception */
|
||||
.org dec_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_PROGRAM
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* System call */
|
||||
.org sys_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_SCALL
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* PIT interrupt */
|
||||
.org pit_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_PIT
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* FIT interrupt */
|
||||
.org fit_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_FIT
|
||||
b PROC (_ISR_Handler)
|
||||
|
||||
/* Watchdog interrupt */
|
||||
.org wadt_vector - file_base
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_WATCHDOG
|
||||
b PROC (_ISR_HandlerC)
|
||||
|
||||
/* Debug exception */
|
||||
debug:
|
||||
stwu r1, -(IP_END)(r1)
|
||||
stw r0, IP_0(r1)
|
||||
|
||||
li r0, PPC_IRQ_DEBUG
|
||||
b PROC (_ISR_HandlerC)
|
||||
|
||||
/* Debug exception */
|
||||
.org debug_vector - file_base
|
||||
b debug
|
||||
Reference in New Issue
Block a user