forked from Imagelibrary/rtems
2003-07-18 Till Straumann <strauman@slac.stanford.edu>
PR 288/rtems * irq/irq_asm.S, startup/bspstart.c: _ISR_Nest_level is now properly maintained and any BSP which does not do so will trip a panic in the shared code.
This commit is contained in:
@@ -1,3 +1,10 @@
|
|||||||
|
2003-07-18 Till Straumann <strauman@slac.stanford.edu>
|
||||||
|
|
||||||
|
PR 288/rtems
|
||||||
|
* irq/irq_asm.S, startup/bspstart.c: _ISR_Nest_level is now properly
|
||||||
|
maintained and any BSP which does not do so will trip a panic in the
|
||||||
|
shared code.
|
||||||
|
|
||||||
2003-07-18 Till Straumann <strauman@slac.stanford.edu>
|
2003-07-18 Till Straumann <strauman@slac.stanford.edu>
|
||||||
|
|
||||||
PR 415/bsps
|
PR 415/bsps
|
||||||
|
|||||||
@@ -9,6 +9,9 @@
|
|||||||
* Modified to support the MCP750.
|
* Modified to support the MCP750.
|
||||||
* Modifications Copyright (C) 1999 Eric Valette. valette@crf.canon.fr
|
* Modifications Copyright (C) 1999 Eric Valette. valette@crf.canon.fr
|
||||||
*
|
*
|
||||||
|
* Till Straumann <strauman@slac.stanford.edu>, 2003/7:
|
||||||
|
* - store isr nesting level in _ISR_Nest_level rather than
|
||||||
|
* SPRG0 - RTEMS relies on that variable.
|
||||||
*
|
*
|
||||||
* $Id$
|
* $Id$
|
||||||
*/
|
*/
|
||||||
@@ -140,10 +143,18 @@ SYM (shared_raw_irq_code_entry):
|
|||||||
* store part of _Thread_Dispatch_disable_level address in R15
|
* store part of _Thread_Dispatch_disable_level address in R15
|
||||||
*/
|
*/
|
||||||
addis r15,0, _Thread_Dispatch_disable_level@ha
|
addis r15,0, _Thread_Dispatch_disable_level@ha
|
||||||
|
#if BROKEN_ISR_NEST_LEVEL
|
||||||
/*
|
/*
|
||||||
* Get current nesting level in R3
|
* Get current nesting level in R3
|
||||||
*/
|
*/
|
||||||
mfspr r3, SPRG0
|
mfspr r3, SPRG0
|
||||||
|
#else
|
||||||
|
/*
|
||||||
|
* Retrieve current nesting level from _ISR_Nest_level
|
||||||
|
*/
|
||||||
|
lis r7, _ISR_Nest_level@ha
|
||||||
|
lwz r3, _ISR_Nest_level@l(r7)
|
||||||
|
#endif
|
||||||
/*
|
/*
|
||||||
* Check if stack switch is necessary
|
* Check if stack switch is necessary
|
||||||
*/
|
*/
|
||||||
@@ -160,10 +171,15 @@ nested:
|
|||||||
* Start Incrementing _Thread_Dispatch_disable_level R4 = _Thread_Dispatch_disable_level
|
* Start Incrementing _Thread_Dispatch_disable_level R4 = _Thread_Dispatch_disable_level
|
||||||
*/
|
*/
|
||||||
lwz r6,_Thread_Dispatch_disable_level@l(r15)
|
lwz r6,_Thread_Dispatch_disable_level@l(r15)
|
||||||
|
#if BROKEN_ISR_NEST_LEVEL
|
||||||
/*
|
/*
|
||||||
* store new nesting level in SPRG0
|
* Store new nesting level in SPRG0
|
||||||
*/
|
*/
|
||||||
mtspr SPRG0, r3
|
mtspr SPRG0, r3
|
||||||
|
#else
|
||||||
|
/* store new nesting level in _ISR_Nest_level */
|
||||||
|
stw r3, _ISR_Nest_level@l(r7)
|
||||||
|
#endif
|
||||||
|
|
||||||
addi r6, r6, 1
|
addi r6, r6, 1
|
||||||
mfmsr r5
|
mfmsr r5
|
||||||
@@ -187,14 +203,23 @@ nested:
|
|||||||
* value as an easy exit condition because if interrupt nesting level > 1
|
* value as an easy exit condition because if interrupt nesting level > 1
|
||||||
* then _Thread_Dispatch_disable_level > 1
|
* then _Thread_Dispatch_disable_level > 1
|
||||||
*/
|
*/
|
||||||
|
#if BROKEN_ISR_NEST_LEVEL
|
||||||
mfspr r4, SPRG0
|
mfspr r4, SPRG0
|
||||||
|
#else
|
||||||
|
lis r7, _ISR_Nest_level@ha
|
||||||
|
lwz r4, _ISR_Nest_level@l(r7)
|
||||||
|
#endif
|
||||||
/*
|
/*
|
||||||
* start decrementing _Thread_Dispatch_disable_level
|
* start decrementing _Thread_Dispatch_disable_level
|
||||||
*/
|
*/
|
||||||
lwz r3,_Thread_Dispatch_disable_level@l(r15)
|
lwz r3,_Thread_Dispatch_disable_level@l(r15)
|
||||||
addi r4, r4, -1 /* Continue decrementing nesting level */
|
addi r4, r4, -1 /* Continue decrementing nesting level */
|
||||||
addi r3, r3, -1 /* Continue decrementing _Thread_Dispatch_disable_level */
|
addi r3, r3, -1 /* Continue decrementing _Thread_Dispatch_disable_level */
|
||||||
|
#if BROKEN_ISR_NEST_LEVEL
|
||||||
mtspr SPRG0, r4 /* End decrementing nesting level */
|
mtspr SPRG0, r4 /* End decrementing nesting level */
|
||||||
|
#else
|
||||||
|
stw r4, _ISR_Nest_level@l(r7) /* End decrementing nesting level */
|
||||||
|
#endif
|
||||||
stw r3,_Thread_Dispatch_disable_level@l(r15) /* End decrementing _Thread_Dispatch_disable_level */
|
stw r3,_Thread_Dispatch_disable_level@l(r15) /* End decrementing _Thread_Dispatch_disable_level */
|
||||||
cmpwi r3, 0
|
cmpwi r3, 0
|
||||||
/*
|
/*
|
||||||
|
|||||||
@@ -45,8 +45,8 @@ extern Triv121PgTbl BSP_pgtbl_setup();
|
|||||||
extern void BSP_pgtbl_activate();
|
extern void BSP_pgtbl_activate();
|
||||||
extern void BSP_vme_config();
|
extern void BSP_vme_config();
|
||||||
|
|
||||||
SPR_RW(SPR0)
|
SPR_RW(SPRG0)
|
||||||
SPR_RW(SPR1)
|
SPR_RW(SPRG1)
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Copy of residuals passed by firmware
|
* Copy of residuals passed by firmware
|
||||||
@@ -179,7 +179,6 @@ void bsp_start( void )
|
|||||||
unsigned char *stack;
|
unsigned char *stack;
|
||||||
unsigned l2cr;
|
unsigned l2cr;
|
||||||
register unsigned char* intrStack;
|
register unsigned char* intrStack;
|
||||||
register unsigned int intrNestingLevel = 0;
|
|
||||||
unsigned char *work_space_start;
|
unsigned char *work_space_start;
|
||||||
ppc_cpu_id_t myCpu;
|
ppc_cpu_id_t myCpu;
|
||||||
ppc_cpu_revision_t myCpuRevision;
|
ppc_cpu_revision_t myCpuRevision;
|
||||||
@@ -219,7 +218,6 @@ void bsp_start( void )
|
|||||||
|
|
||||||
/*
|
/*
|
||||||
* Initialize the interrupt related settings
|
* Initialize the interrupt related settings
|
||||||
* SPRG0 = interrupt nesting level count
|
|
||||||
* SPRG1 = software managed IRQ stack
|
* SPRG1 = software managed IRQ stack
|
||||||
*
|
*
|
||||||
* This could be done latter (e.g in IRQ_INIT) but it helps to understand
|
* This could be done latter (e.g in IRQ_INIT) but it helps to understand
|
||||||
@@ -233,8 +231,11 @@ void bsp_start( void )
|
|||||||
/* tag the bottom (T. Straumann 6/36/2001 <strauman@slac.stanford.edu>) */
|
/* tag the bottom (T. Straumann 6/36/2001 <strauman@slac.stanford.edu>) */
|
||||||
*((unsigned32 *)intrStack) = 0;
|
*((unsigned32 *)intrStack) = 0;
|
||||||
|
|
||||||
_write_SPR1((unsigned int)intrStack);
|
_write_SPRG1((unsigned int)intrStack);
|
||||||
_write_SPR0(intrNestingLevel);
|
|
||||||
|
/* signal them that we have fixed PR288 - eventually, this should go away */
|
||||||
|
_write_SPRG0(PPC_BSP_HAS_FIXED_PR288);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Initialize default raw exception hanlders. See vectors/vectors_init.c
|
* Initialize default raw exception hanlders. See vectors/vectors_init.c
|
||||||
*/
|
*/
|
||||||
|
|||||||
Reference in New Issue
Block a user