RTEMS 4.11Annotated Report
Sun Dec 23 00:08:42 2012
ffc0ee34 <TOD_MICROSECONDS_TO_TICKS>:
/**
* We should ensure the ticks not be truncated by integer division. We
* need to have it be greater than or equal to the requested time. It
* should not be shorter.
*/
microseconds_per_tick = rtems_configuration_get_microseconds_per_tick();
ffc0ee34: 3d 20 ff c2 lis r9,-62
ffc0ee38: 81 49 58 54 lwz r10,22612(r9)
ticks = microseconds / microseconds_per_tick;
ffc0ee3c: 7d 23 53 96 divwu r9,r3,r10
if ( (microseconds % microseconds_per_tick) != 0 )
ffc0ee40: 7d 49 51 d6 mullw r10,r9,r10
ffc0ee44: 7f 83 50 00 cmpw cr7,r3,r10
ffc0ee48: 41 9e 00 08 beq- cr7,ffc0ee50 <TOD_MICROSECONDS_TO_TICKS+0x1c><== ALWAYS TAKEN
ticks += 1;
ffc0ee4c: 39 29 00 01 addi r9,r9,1 <== NOT EXECUTED
return ticks;
}
ffc0ee50: 7d 23 4b 78 mr r3,r9
ffc0ee54: 4e 80 00 20 blr
ffc0a17c <TOD_MILLISECONDS_TO_TICKS>:
/**
* We should ensure the ticks not be truncated by integer division. We
* need to have it be greater than or equal to the requested time. It
* should not be shorter.
*/
milliseconds_per_tick = rtems_configuration_get_milliseconds_per_tick();
ffc0a17c: 3d 20 ff c2 lis r9,-62
ffc0a180: 81 49 d2 44 lwz r10,-11708(r9)
ffc0a184: 39 20 03 e8 li r9,1000
ffc0a188: 7d 4a 4b 96 divwu r10,r10,r9
ticks = milliseconds / milliseconds_per_tick;
ffc0a18c: 7d 23 53 96 divwu r9,r3,r10
if ( (milliseconds % milliseconds_per_tick) != 0 )
ffc0a190: 7d 49 51 d6 mullw r10,r9,r10
ffc0a194: 7f 83 50 00 cmpw cr7,r3,r10
ffc0a198: 41 9e 00 08 beq- cr7,ffc0a1a0 <TOD_MILLISECONDS_TO_TICKS+0x24><== ALWAYS TAKEN
ticks += 1;
ffc0a19c: 39 29 00 01 addi r9,r9,1 <== NOT EXECUTED
return ticks;
}
ffc0a1a0: 7d 23 4b 78 mr r3,r9
ffc0a1a4: 4e 80 00 20 blr
ffc0b874 <_CORE_RWLock_Release>:
#include <rtems/score/watchdog.h>
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
ffc0b874: 7c 2b 0b 78 mr r11,r1
ffc0b878: 7c 08 02 a6 mflr r0
ffc0b87c: 94 21 ff f0 stwu r1,-16(r1)
ISR_Level level;
Thread_Control *executing = _Thread_Executing;
ffc0b880: 3d 20 00 00 lis r9,0
#include <rtems/score/watchdog.h>
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
ffc0b884: 90 01 00 14 stw r0,20(r1)
ffc0b888: 48 00 c0 41 bl ffc178c8 <_savegpr_31>
ffc0b88c: 7c 7f 1b 78 mr r31,r3
ISR_Level level;
Thread_Control *executing = _Thread_Executing;
ffc0b890: 81 09 31 b0 lwz r8,12720(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0b894: 7d 20 00 a6 mfmsr r9
ffc0b898: 7d 50 42 a6 mfsprg r10,0
ffc0b89c: 7d 2a 50 78 andc r10,r9,r10
ffc0b8a0: 7d 40 01 24 mtmsr r10
* If locked for reading and no waiters, then OK to read.
* If any thread is waiting, then we wait.
*/
_ISR_Disable( level );
if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){
ffc0b8a4: 81 43 00 44 lwz r10,68(r3)
ffc0b8a8: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0b8ac: 40 be 00 14 bne+ cr7,ffc0b8c0 <_CORE_RWLock_Release+0x4c>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0b8b0: 7d 20 01 24 mtmsr r9
_ISR_Enable( level );
executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE;
ffc0b8b4: 39 20 00 02 li r9,2
ffc0b8b8: 91 28 00 34 stw r9,52(r8)
return CORE_RWLOCK_SUCCESSFUL;
ffc0b8bc: 48 00 00 a8 b ffc0b964 <_CORE_RWLock_Release+0xf0>
}
if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) {
ffc0b8c0: 2f 8a 00 01 cmpwi cr7,r10,1
ffc0b8c4: 40 9e 00 20 bne- cr7,ffc0b8e4 <_CORE_RWLock_Release+0x70>
the_rwlock->number_of_readers -= 1;
ffc0b8c8: 81 43 00 48 lwz r10,72(r3)
ffc0b8cc: 39 4a ff ff addi r10,r10,-1
if ( the_rwlock->number_of_readers != 0 ) {
ffc0b8d0: 2f 8a 00 00 cmpwi cr7,r10,0
_ISR_Enable( level );
executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE;
return CORE_RWLOCK_SUCCESSFUL;
}
if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) {
the_rwlock->number_of_readers -= 1;
ffc0b8d4: 91 43 00 48 stw r10,72(r3)
if ( the_rwlock->number_of_readers != 0 ) {
ffc0b8d8: 41 be 00 0c beq+ cr7,ffc0b8e4 <_CORE_RWLock_Release+0x70>
ffc0b8dc: 7d 20 01 24 mtmsr r9
/* must be unlocked again */
_ISR_Enable( level );
return CORE_RWLOCK_SUCCESSFUL;
ffc0b8e0: 48 00 00 84 b ffc0b964 <_CORE_RWLock_Release+0xf0>
}
}
/* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
ffc0b8e4: 39 40 00 00 li r10,0
ffc0b8e8: 91 48 00 34 stw r10,52(r8)
/*
* Implicitly transition to "unlocked" and find another thread interested
* in obtaining this rwlock.
*/
the_rwlock->current_state = CORE_RWLOCK_UNLOCKED;
ffc0b8ec: 91 5f 00 44 stw r10,68(r31)
ffc0b8f0: 7d 20 01 24 mtmsr r9
_ISR_Enable( level );
next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue );
ffc0b8f4: 7f e3 fb 78 mr r3,r31
ffc0b8f8: 48 00 1e 51 bl ffc0d748 <_Thread_queue_Dequeue>
if ( next ) {
ffc0b8fc: 2c 03 00 00 cmpwi r3,0
ffc0b900: 41 82 00 64 beq- ffc0b964 <_CORE_RWLock_Release+0xf0>
if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) {
ffc0b904: 81 23 00 30 lwz r9,48(r3)
ffc0b908: 2f 89 00 01 cmpwi cr7,r9,1
ffc0b90c: 40 be 00 10 bne+ cr7,ffc0b91c <_CORE_RWLock_Release+0xa8>
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING;
ffc0b910: 39 20 00 02 li r9,2
ffc0b914: 91 3f 00 44 stw r9,68(r31)
return CORE_RWLOCK_SUCCESSFUL;
ffc0b918: 48 00 00 4c b ffc0b964 <_CORE_RWLock_Release+0xf0>
}
/*
* Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING
*/
the_rwlock->number_of_readers += 1;
ffc0b91c: 81 3f 00 48 lwz r9,72(r31)
ffc0b920: 39 29 00 01 addi r9,r9,1
ffc0b924: 91 3f 00 48 stw r9,72(r31)
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING;
ffc0b928: 39 20 00 01 li r9,1
ffc0b92c: 91 3f 00 44 stw r9,68(r31)
/*
* Now see if more readers can be let go.
*/
while ( 1 ) {
next = _Thread_queue_First( &the_rwlock->Wait_queue );
ffc0b930: 7f e3 fb 78 mr r3,r31
ffc0b934: 48 00 23 6d bl ffc0dca0 <_Thread_queue_First>
if ( !next ||
ffc0b938: 7c 64 1b 79 mr. r4,r3
ffc0b93c: 41 82 00 28 beq- ffc0b964 <_CORE_RWLock_Release+0xf0>
ffc0b940: 81 24 00 30 lwz r9,48(r4)
ffc0b944: 2f 89 00 01 cmpwi cr7,r9,1
ffc0b948: 41 9e 00 1c beq- cr7,ffc0b964 <_CORE_RWLock_Release+0xf0><== NEVER TAKEN
next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE )
return CORE_RWLOCK_SUCCESSFUL;
the_rwlock->number_of_readers += 1;
ffc0b94c: 81 3f 00 48 lwz r9,72(r31)
_Thread_queue_Extract( &the_rwlock->Wait_queue, next );
ffc0b950: 7f e3 fb 78 mr r3,r31
while ( 1 ) {
next = _Thread_queue_First( &the_rwlock->Wait_queue );
if ( !next ||
next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE )
return CORE_RWLOCK_SUCCESSFUL;
the_rwlock->number_of_readers += 1;
ffc0b954: 39 29 00 01 addi r9,r9,1
ffc0b958: 91 3f 00 48 stw r9,72(r31)
_Thread_queue_Extract( &the_rwlock->Wait_queue, next );
ffc0b95c: 48 00 21 dd bl ffc0db38 <_Thread_queue_Extract>
}
ffc0b960: 4b ff ff d0 b ffc0b930 <_CORE_RWLock_Release+0xbc>
}
/* indentation is to match _ISR_Disable at top */
return CORE_RWLOCK_SUCCESSFUL;
}
ffc0b964: 39 61 00 10 addi r11,r1,16
ffc0b968: 38 60 00 00 li r3,0
ffc0b96c: 4b ff 63 50 b ffc01cbc <_restgpr_31_x>
ffc0b970 <_CORE_RWLock_Timeout>:
void _CORE_RWLock_Timeout(
Objects_Id id,
void *ignored
)
{
ffc0b970: 94 21 ff e8 stwu r1,-24(r1)
ffc0b974: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b978: 38 81 00 08 addi r4,r1,8
void _CORE_RWLock_Timeout(
Objects_Id id,
void *ignored
)
{
ffc0b97c: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b980: 48 00 1a 2d bl ffc0d3ac <_Thread_Get>
switch ( location ) {
ffc0b984: 81 21 00 08 lwz r9,8(r1)
ffc0b988: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b98c: 40 9e 00 18 bne- cr7,ffc0b9a4 <_CORE_RWLock_Timeout+0x34><== NEVER TAKEN
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_queue_Process_timeout( the_thread );
ffc0b990: 48 00 24 0d bl ffc0dd9c <_Thread_queue_Process_timeout>
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0b994: 3d 20 00 00 lis r9,0
ffc0b998: 81 49 28 90 lwz r10,10384(r9)
--level;
ffc0b99c: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc0b9a0: 91 49 28 90 stw r10,10384(r9)
_Thread_Unnest_dispatch();
break;
}
}
ffc0b9a4: 80 01 00 1c lwz r0,28(r1)
ffc0b9a8: 38 21 00 18 addi r1,r1,24
ffc0b9ac: 7c 08 03 a6 mtlr r0
ffc0b9b0: 4e 80 00 20 blr
ffc09854 <_CORE_semaphore_Surrender>:
CORE_semaphore_Status _CORE_semaphore_Surrender(
CORE_semaphore_Control *the_semaphore,
Objects_Id id,
CORE_semaphore_API_mp_support_callout api_semaphore_mp_support
)
{
ffc09854: 7c 2b 0b 78 mr r11,r1
ffc09858: 7c 08 02 a6 mflr r0
ffc0985c: 94 21 ff f0 stwu r1,-16(r1)
ffc09860: 48 01 15 5d bl ffc1adbc <_savegpr_31>
ffc09864: 90 01 00 14 stw r0,20(r1)
ffc09868: 7c 7f 1b 78 mr r31,r3
ISR_Level level;
CORE_semaphore_Status status;
status = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) {
ffc0986c: 48 00 1d 75 bl ffc0b5e0 <_Thread_queue_Dequeue>
ffc09870: 2f 83 00 00 cmpwi cr7,r3,0
ffc09874: 40 be 00 3c bne+ cr7,ffc098b0 <_CORE_semaphore_Surrender+0x5c>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc09878: 7d 00 00 a6 mfmsr r8
ffc0987c: 7d 30 42 a6 mfsprg r9,0
ffc09880: 7d 09 48 78 andc r9,r8,r9
ffc09884: 7d 20 01 24 mtmsr r9
(*api_semaphore_mp_support) ( the_thread, id );
#endif
} else {
_ISR_Disable( level );
if ( the_semaphore->count < the_semaphore->Attributes.maximum_count )
ffc09888: 81 3f 00 48 lwz r9,72(r31)
the_semaphore->count += 1;
else
status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED;
ffc0988c: 38 60 00 04 li r3,4
(*api_semaphore_mp_support) ( the_thread, id );
#endif
} else {
_ISR_Disable( level );
if ( the_semaphore->count < the_semaphore->Attributes.maximum_count )
ffc09890: 81 5f 00 40 lwz r10,64(r31)
ffc09894: 7f 89 50 40 cmplw cr7,r9,r10
ffc09898: 40 9c 00 10 bge- cr7,ffc098a8 <_CORE_semaphore_Surrender+0x54><== NEVER TAKEN
the_semaphore->count += 1;
ffc0989c: 39 29 00 01 addi r9,r9,1
ffc098a0: 91 3f 00 48 stw r9,72(r31)
{
Thread_Control *the_thread;
ISR_Level level;
CORE_semaphore_Status status;
status = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
ffc098a4: 38 60 00 00 li r3,0
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc098a8: 7d 00 01 24 mtmsr r8
ffc098ac: 48 00 00 08 b ffc098b4 <_CORE_semaphore_Surrender+0x60>
ffc098b0: 38 60 00 00 li r3,0
status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED;
_ISR_Enable( level );
}
return status;
}
ffc098b4: 39 61 00 10 addi r11,r1,16
ffc098b8: 4b ff 6d 0c b ffc005c4 <_restgpr_31_x>
ffc08454 <_Event_Surrender>:
rtems_event_set event_in,
Event_Control *event,
Thread_blocking_operation_States *sync_state,
States_Control wait_state
)
{
ffc08454: 7c 2b 0b 78 mr r11,r1
ffc08458: 7c 08 02 a6 mflr r0
ffc0845c: 94 21 ff f0 stwu r1,-16(r1)
ffc08460: 90 01 00 14 stw r0,20(r1)
ffc08464: 48 01 29 59 bl ffc1adbc <_savegpr_31>
ffc08468: 7c 7f 1b 78 mr r31,r3
rtems_event_set pending_events;
rtems_event_set event_condition;
rtems_event_set seized_events;
rtems_option option_set;
option_set = the_thread->Wait.option;
ffc0846c: 80 63 00 30 lwz r3,48(r3)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc08470: 7d 20 00 a6 mfmsr r9
ffc08474: 7d 50 42 a6 mfsprg r10,0
ffc08478: 7d 2a 50 78 andc r10,r9,r10
ffc0847c: 7d 40 01 24 mtmsr r10
RTEMS_INLINE_ROUTINE void _Event_sets_Post(
rtems_event_set the_new_events,
rtems_event_set *the_event_set
)
{
*the_event_set |= the_new_events;
ffc08480: 81 45 00 00 lwz r10,0(r5)
ffc08484: 7c 84 53 78 or r4,r4,r10
ffc08488: 90 85 00 00 stw r4,0(r5)
_ISR_Disable( level );
_Event_sets_Post( event_in, &event->pending_events );
pending_events = event->pending_events;
event_condition = the_thread->Wait.count;
ffc0848c: 81 1f 00 24 lwz r8,36(r31)
seized_events = _Event_sets_Get( pending_events, event_condition );
/*
* No events were seized in this operation
*/
if ( _Event_sets_Is_empty( seized_events ) ) {
ffc08490: 7c 8a 40 39 and. r10,r4,r8
ffc08494: 40 a2 00 08 bne+ ffc0849c <_Event_Surrender+0x48>
ffc08498: 48 00 00 f0 b ffc08588 <_Event_Surrender+0x134>
/*
* If we are in an ISR and sending to the current thread, then
* we have a critical section issue to deal with.
*/
if ( _ISR_Is_in_progress() &&
ffc0849c: 3d 60 00 00 lis r11,0
ffc084a0: 39 6b 31 a0 addi r11,r11,12704
ffc084a4: 80 0b 00 08 lwz r0,8(r11)
ffc084a8: 2f 80 00 00 cmpwi cr7,r0,0
ffc084ac: 41 9e 00 54 beq- cr7,ffc08500 <_Event_Surrender+0xac>
ffc084b0: 81 6b 00 10 lwz r11,16(r11)
ffc084b4: 7f 9f 58 00 cmpw cr7,r31,r11
ffc084b8: 40 be 00 48 bne+ cr7,ffc08500 <_Event_Surrender+0xac>
_Thread_Is_executing( the_thread ) &&
((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
ffc084bc: 81 66 00 00 lwz r11,0(r6)
ffc084c0: 39 6b ff ff addi r11,r11,-1
/*
* If we are in an ISR and sending to the current thread, then
* we have a critical section issue to deal with.
*/
if ( _ISR_Is_in_progress() &&
_Thread_Is_executing( the_thread ) &&
ffc084c4: 2b 8b 00 01 cmplwi cr7,r11,1
ffc084c8: 41 bd 00 38 bgt+ cr7,ffc08500 <_Event_Surrender+0xac>
((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(*sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
ffc084cc: 7f 8a 40 00 cmpw cr7,r10,r8
ffc084d0: 41 9e 00 0c beq- cr7,ffc084dc <_Event_Surrender+0x88>
ffc084d4: 70 68 00 02 andi. r8,r3,2
ffc084d8: 41 82 00 b0 beq- ffc08588 <_Event_Surrender+0x134> <== NEVER TAKEN
RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear(
rtems_event_set the_event_set,
rtems_event_set the_mask
)
{
return ( the_event_set & ~(the_mask) );
ffc084dc: 7c 84 50 78 andc r4,r4,r10
event->pending_events = _Event_sets_Clear(
pending_events,
seized_events
);
the_thread->Wait.count = 0;
ffc084e0: 39 00 00 00 li r8,0
if ( _ISR_Is_in_progress() &&
_Thread_Is_executing( the_thread ) &&
((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(*sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
event->pending_events = _Event_sets_Clear(
ffc084e4: 90 85 00 00 stw r4,0(r5)
pending_events,
seized_events
);
the_thread->Wait.count = 0;
ffc084e8: 91 1f 00 24 stw r8,36(r31)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
ffc084ec: 81 1f 00 28 lwz r8,40(r31)
ffc084f0: 91 48 00 00 stw r10,0(r8)
*sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
ffc084f4: 39 40 00 03 li r10,3
ffc084f8: 91 46 00 00 stw r10,0(r6)
ffc084fc: 48 00 00 8c b ffc08588 <_Event_Surrender+0x134>
RTEMS_INLINE_ROUTINE bool _States_Are_set (
States_Control the_states,
States_Control mask
)
{
return ( (the_states & mask) != STATES_READY);
ffc08500: 80 df 00 10 lwz r6,16(r31)
}
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Are_set( the_thread->current_state, wait_state ) ) {
ffc08504: 7c eb 30 39 and. r11,r7,r6
ffc08508: 41 82 00 80 beq- ffc08588 <_Event_Surrender+0x134>
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
ffc0850c: 7f 8a 40 00 cmpw cr7,r10,r8
ffc08510: 41 9e 00 0c beq- cr7,ffc0851c <_Event_Surrender+0xc8>
ffc08514: 70 68 00 02 andi. r8,r3,2
ffc08518: 41 82 00 70 beq- ffc08588 <_Event_Surrender+0x134> <== NEVER TAKEN
ffc0851c: 7c 84 50 78 andc r4,r4,r10
event->pending_events = _Event_sets_Clear(
pending_events,
seized_events
);
the_thread->Wait.count = 0;
ffc08520: 39 00 00 00 li r8,0
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Are_set( the_thread->current_state, wait_state ) ) {
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
event->pending_events = _Event_sets_Clear(
ffc08524: 90 85 00 00 stw r4,0(r5)
pending_events,
seized_events
);
the_thread->Wait.count = 0;
ffc08528: 91 1f 00 24 stw r8,36(r31)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
ffc0852c: 81 1f 00 28 lwz r8,40(r31)
ffc08530: 91 48 00 00 stw r10,0(r8)
static inline void ppc_interrupt_flash( uint32_t level )
{
uint32_t current_level;
__asm__ volatile (
ffc08534: 7d 40 00 a6 mfmsr r10
ffc08538: 7d 20 01 24 mtmsr r9
ffc0853c: 7d 40 01 24 mtmsr r10
_ISR_Flash( level );
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
ffc08540: 81 5f 00 50 lwz r10,80(r31)
ffc08544: 2f 8a 00 02 cmpwi cr7,r10,2
ffc08548: 41 9e 00 0c beq- cr7,ffc08554 <_Event_Surrender+0x100>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0854c: 7d 20 01 24 mtmsr r9
ffc08550: 48 00 00 18 b ffc08568 <_Event_Surrender+0x114>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
ffc08554: 39 40 00 03 li r10,3
ffc08558: 91 5f 00 50 stw r10,80(r31)
ffc0855c: 7d 20 01 24 mtmsr r9
_ISR_Enable( level );
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
(void) _Watchdog_Remove( &the_thread->Timer );
ffc08560: 38 7f 00 48 addi r3,r31,72
ffc08564: 48 00 3b 8d bl ffc0c0f0 <_Watchdog_Remove>
}
return;
}
}
_ISR_Enable( level );
}
ffc08568: 80 01 00 14 lwz r0,20(r1)
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc0856c: 7f e3 fb 78 mr r3,r31
ffc08570: 3c 80 10 07 lis r4,4103
ffc08574: 83 e1 00 0c lwz r31,12(r1)
ffc08578: 7c 08 03 a6 mtlr r0
ffc0857c: 60 84 ff f8 ori r4,r4,65528
ffc08580: 38 21 00 10 addi r1,r1,16
ffc08584: 48 00 28 84 b ffc0ae08 <_Thread_Clear_state>
ffc08588: 7d 20 01 24 mtmsr r9
ffc0858c: 39 61 00 10 addi r11,r1,16
ffc08590: 4b ff 80 34 b ffc005c4 <_restgpr_31_x>
ffc08594 <_Event_Timeout>:
void _Event_Timeout(
Objects_Id id,
void *arg
)
{
ffc08594: 7c 2b 0b 78 mr r11,r1
ffc08598: 94 21 ff e0 stwu r1,-32(r1)
ffc0859c: 7c 08 02 a6 mflr r0
ffc085a0: 48 01 28 1d bl ffc1adbc <_savegpr_31>
ffc085a4: 7c 9f 23 78 mr r31,r4
ISR_Level level;
Thread_blocking_operation_States *sync_state;
sync_state = arg;
the_thread = _Thread_Get( id, &location );
ffc085a8: 38 81 00 08 addi r4,r1,8
void _Event_Timeout(
Objects_Id id,
void *arg
)
{
ffc085ac: 90 01 00 24 stw r0,36(r1)
ISR_Level level;
Thread_blocking_operation_States *sync_state;
sync_state = arg;
the_thread = _Thread_Get( id, &location );
ffc085b0: 48 00 2c 95 bl ffc0b244 <_Thread_Get>
switch ( location ) {
ffc085b4: 81 21 00 08 lwz r9,8(r1)
ffc085b8: 2f 89 00 00 cmpwi cr7,r9,0
ffc085bc: 40 9e 00 64 bne- cr7,ffc08620 <_Event_Timeout+0x8c> <== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc085c0: 7d 40 00 a6 mfmsr r10
ffc085c4: 7d 10 42 a6 mfsprg r8,0
ffc085c8: 7d 48 40 78 andc r8,r10,r8
ffc085cc: 7d 00 01 24 mtmsr r8
_ISR_Enable( level );
return;
}
#endif
the_thread->Wait.count = 0;
ffc085d0: 91 23 00 24 stw r9,36(r3)
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc085d4: 3d 20 00 00 lis r9,0
if ( _Thread_Is_executing( the_thread ) ) {
ffc085d8: 81 29 31 b0 lwz r9,12720(r9)
ffc085dc: 7f 83 48 00 cmpw cr7,r3,r9
ffc085e0: 40 be 00 18 bne+ cr7,ffc085f8 <_Event_Timeout+0x64>
if ( *sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
ffc085e4: 81 3f 00 00 lwz r9,0(r31)
ffc085e8: 2f 89 00 01 cmpwi cr7,r9,1
ffc085ec: 40 be 00 0c bne+ cr7,ffc085f8 <_Event_Timeout+0x64>
*sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
ffc085f0: 39 20 00 02 li r9,2
ffc085f4: 91 3f 00 00 stw r9,0(r31)
}
the_thread->Wait.return_code = RTEMS_TIMEOUT;
ffc085f8: 39 20 00 06 li r9,6
ffc085fc: 91 23 00 34 stw r9,52(r3)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc08600: 7d 40 01 24 mtmsr r10
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc08604: 3c 80 10 07 lis r4,4103
ffc08608: 60 84 ff f8 ori r4,r4,65528
ffc0860c: 48 00 27 fd bl ffc0ae08 <_Thread_Clear_state>
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc08610: 3d 20 00 00 lis r9,0
ffc08614: 81 49 28 68 lwz r10,10344(r9)
--level;
ffc08618: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc0861c: 91 49 28 68 stw r10,10344(r9)
case OBJECTS_REMOTE: /* impossible */
#endif
case OBJECTS_ERROR:
break;
}
}
ffc08620: 39 61 00 20 addi r11,r1,32
ffc08624: 4b ff 7f a0 b ffc005c4 <_restgpr_31_x>
ffc0e5dc <_Heap_Free>:
/*
* If NULL return true so a free on NULL is considered a valid release. This
* is a special case that could be handled by the in heap check how-ever that
* would result in false being returned which is wrong.
*/
if ( alloc_begin_ptr == NULL ) {
ffc0e5dc: 2c 04 00 00 cmpwi r4,0
return do_free;
}
#endif
bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr )
{
ffc0e5e0: 7c 08 02 a6 mflr r0
ffc0e5e4: 7c 2b 0b 78 mr r11,r1
ffc0e5e8: 94 21 ff f0 stwu r1,-16(r1)
ffc0e5ec: 90 01 00 14 stw r0,20(r1)
ffc0e5f0: 48 00 c7 cd bl ffc1adbc <_savegpr_31>
/*
* If NULL return true so a free on NULL is considered a valid release. This
* is a special case that could be handled by the in heap check how-ever that
* would result in false being returned which is wrong.
*/
if ( alloc_begin_ptr == NULL ) {
ffc0e5f4: 41 82 01 e4 beq- ffc0e7d8 <_Heap_Free+0x1fc>
ffc0e5f8: 81 03 00 10 lwz r8,16(r3)
ffc0e5fc: 7c 69 1b 78 mr r9,r3
RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap(
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
ffc0e600: 81 63 00 20 lwz r11,32(r3)
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc0e604: 7d 44 43 96 divwu r10,r4,r8
ffc0e608: 7d 4a 41 d6 mullw r10,r10,r8
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0e60c: 39 00 00 00 li r8,0
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc0e610: 39 4a ff f8 addi r10,r10,-8
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0e614: 7f 8a 58 40 cmplw cr7,r10,r11
ffc0e618: 41 9c 00 14 blt- cr7,ffc0e62c <_Heap_Free+0x50>
ffc0e61c: 81 03 00 24 lwz r8,36(r3)
ffc0e620: 7d 0a 40 10 subfc r8,r10,r8
ffc0e624: 39 00 00 00 li r8,0
ffc0e628: 7d 08 41 14 adde r8,r8,r8
}
alloc_begin = (uintptr_t) alloc_begin_ptr;
block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc0e62c: 2f 88 00 00 cmpwi cr7,r8,0
return false;
ffc0e630: 38 60 00 00 li r3,0
}
alloc_begin = (uintptr_t) alloc_begin_ptr;
block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc0e634: 41 9e 01 a8 beq- cr7,ffc0e7dc <_Heap_Free+0x200>
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc0e638: 80 8a 00 04 lwz r4,4(r10)
ffc0e63c: 38 c0 00 00 li r6,0
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0e640: 54 87 00 3c rlwinm r7,r4,0,0,30
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc0e644: 7d 07 52 14 add r8,r7,r10
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0e648: 7f 88 58 40 cmplw cr7,r8,r11
ffc0e64c: 41 9c 00 14 blt- cr7,ffc0e660 <_Heap_Free+0x84> <== NEVER TAKEN
ffc0e650: 80 c9 00 24 lwz r6,36(r9)
ffc0e654: 7c c8 30 10 subfc r6,r8,r6
ffc0e658: 38 c0 00 00 li r6,0
ffc0e65c: 7c c6 31 14 adde r6,r6,r6
_Heap_Protection_block_check( heap, block );
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc0e660: 2f 86 00 00 cmpwi cr7,r6,0
alloc_begin = (uintptr_t) alloc_begin_ptr;
block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
return false;
ffc0e664: 38 60 00 00 li r3,0
_Heap_Protection_block_check( heap, block );
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc0e668: 41 9e 01 74 beq- cr7,ffc0e7dc <_Heap_Free+0x200> <== NEVER TAKEN
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc0e66c: 80 a8 00 04 lwz r5,4(r8)
return false;
}
_Heap_Protection_block_check( heap, next_block );
if ( !_Heap_Is_prev_used( next_block ) ) {
ffc0e670: 70 a6 00 01 andi. r6,r5,1
ffc0e674: 41 82 01 68 beq- ffc0e7dc <_Heap_Free+0x200>
if ( !_Heap_Protection_determine_block_free( heap, block ) ) {
return true;
}
next_block_size = _Heap_Block_size( next_block );
next_is_free = next_block != heap->last_block
ffc0e678: 80 69 00 24 lwz r3,36(r9)
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0e67c: 54 a5 00 3c rlwinm r5,r5,0,0,30
&& !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size ));
ffc0e680: 7f 88 18 00 cmpw cr7,r8,r3
ffc0e684: 41 9e 00 18 beq- cr7,ffc0e69c <_Heap_Free+0xc0>
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc0e688: 7c c8 2a 14 add r6,r8,r5
return true;
}
next_block_size = _Heap_Block_size( next_block );
next_is_free = next_block != heap->last_block
&& !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size ));
ffc0e68c: 80 06 00 04 lwz r0,4(r6)
ffc0e690: 68 00 00 01 xori r0,r0,1
ffc0e694: 54 00 07 fe clrlwi r0,r0,31
ffc0e698: 48 00 00 08 b ffc0e6a0 <_Heap_Free+0xc4>
ffc0e69c: 38 00 00 00 li r0,0
if ( !_Heap_Is_prev_used( block ) ) {
ffc0e6a0: 70 9f 00 01 andi. r31,r4,1
ffc0e6a4: 40 82 00 94 bne- ffc0e738 <_Heap_Free+0x15c>
uintptr_t const prev_size = block->prev_size;
ffc0e6a8: 80 8a 00 00 lwz r4,0(r10)
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0e6ac: 39 80 00 00 li r12,0
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc0e6b0: 7c c4 50 50 subf r6,r4,r10
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0e6b4: 7f 86 58 40 cmplw cr7,r6,r11
ffc0e6b8: 41 9c 00 10 blt- cr7,ffc0e6c8 <_Heap_Free+0xec> <== NEVER TAKEN
ffc0e6bc: 7d 86 18 10 subfc r12,r6,r3
ffc0e6c0: 39 80 00 00 li r12,0
ffc0e6c4: 7d 8c 61 14 adde r12,r12,r12
Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size );
if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) {
ffc0e6c8: 2f 8c 00 00 cmpwi cr7,r12,0
alloc_begin = (uintptr_t) alloc_begin_ptr;
block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
return false;
ffc0e6cc: 38 60 00 00 li r3,0
if ( !_Heap_Is_prev_used( block ) ) {
uintptr_t const prev_size = block->prev_size;
Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size );
if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) {
ffc0e6d0: 41 9e 01 0c beq- cr7,ffc0e7dc <_Heap_Free+0x200> <== NEVER TAKEN
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0e6d4: 81 66 00 04 lwz r11,4(r6)
return( false );
}
/* As we always coalesce free blocks, the block that preceedes prev_block
must have been used. */
if ( !_Heap_Is_prev_used ( prev_block) ) {
ffc0e6d8: 71 7f 00 01 andi. r31,r11,1
ffc0e6dc: 41 82 01 00 beq- ffc0e7dc <_Heap_Free+0x200> <== NEVER TAKEN
_HAssert( false );
return( false );
}
if ( next_is_free ) { /* coalesce both */
ffc0e6e0: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e6e4: 7c 87 22 14 add r4,r7,r4
ffc0e6e8: 41 be 00 34 beq+ cr7,ffc0e71c <_Heap_Free+0x140>
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
ffc0e6ec: 81 48 00 0c lwz r10,12(r8)
uintptr_t const size = block_size + prev_size + next_block_size;
ffc0e6f0: 7c a4 2a 14 add r5,r4,r5
return _Heap_Free_list_tail(heap)->prev;
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
ffc0e6f4: 80 88 00 08 lwz r4,8(r8)
Heap_Block *prev = block->prev;
prev->next = next;
ffc0e6f8: 90 8a 00 08 stw r4,8(r10)
next->prev = prev;
ffc0e6fc: 91 44 00 0c stw r10,12(r4)
_Heap_Free_list_remove( next_block );
stats->free_blocks -= 1;
ffc0e700: 81 49 00 38 lwz r10,56(r9)
ffc0e704: 39 4a ff ff addi r10,r10,-1
ffc0e708: 91 49 00 38 stw r10,56(r9)
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc0e70c: 60 aa 00 01 ori r10,r5,1
ffc0e710: 91 46 00 04 stw r10,4(r6)
next_block = _Heap_Block_at( prev_block, size );
_HAssert(!_Heap_Is_prev_used( next_block));
next_block->prev_size = size;
ffc0e714: 7c a5 31 2e stwx r5,r5,r6
ffc0e718: 48 00 00 9c b ffc0e7b4 <_Heap_Free+0x1d8>
} else { /* coalesce prev */
uintptr_t const size = block_size + prev_size;
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc0e71c: 60 85 00 01 ori r5,r4,1
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
next_block->prev_size = size;
ffc0e720: 7c 87 51 2e stwx r4,r7,r10
next_block = _Heap_Block_at( prev_block, size );
_HAssert(!_Heap_Is_prev_used( next_block));
next_block->prev_size = size;
} else { /* coalesce prev */
uintptr_t const size = block_size + prev_size;
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc0e724: 90 a6 00 04 stw r5,4(r6)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc0e728: 80 c8 00 04 lwz r6,4(r8)
ffc0e72c: 54 c6 00 3c rlwinm r6,r6,0,0,30
ffc0e730: 90 c8 00 04 stw r6,4(r8)
ffc0e734: 48 00 00 80 b ffc0e7b4 <_Heap_Free+0x1d8>
next_block->prev_size = size;
}
} else if ( next_is_free ) { /* coalesce next */
ffc0e738: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e73c: 41 be 00 30 beq+ cr7,ffc0e76c <_Heap_Free+0x190>
uintptr_t const size = block_size + next_block_size;
ffc0e740: 7c c5 3a 14 add r6,r5,r7
RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace(
Heap_Block *old_block,
Heap_Block *new_block
)
{
Heap_Block *next = old_block->next;
ffc0e744: 80 a8 00 08 lwz r5,8(r8)
Heap_Block *prev = old_block->prev;
ffc0e748: 81 08 00 0c lwz r8,12(r8)
new_block->next = next;
ffc0e74c: 90 aa 00 08 stw r5,8(r10)
new_block->prev = prev;
ffc0e750: 91 0a 00 0c stw r8,12(r10)
next->prev = new_block;
prev->next = new_block;
ffc0e754: 91 48 00 08 stw r10,8(r8)
_Heap_Free_list_replace( next_block, block );
block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc0e758: 60 c8 00 01 ori r8,r6,1
Heap_Block *prev = old_block->prev;
new_block->next = next;
new_block->prev = prev;
next->prev = new_block;
ffc0e75c: 91 45 00 0c stw r10,12(r5)
ffc0e760: 91 0a 00 04 stw r8,4(r10)
next_block = _Heap_Block_at( block, size );
next_block->prev_size = size;
ffc0e764: 7c c6 51 2e stwx r6,r6,r10
ffc0e768: 48 00 00 4c b ffc0e7b4 <_Heap_Free+0x1d8>
RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after(
Heap_Block *block_before,
Heap_Block *new_block
)
{
Heap_Block *next = block_before->next;
ffc0e76c: 80 c9 00 08 lwz r6,8(r9)
new_block->next = next;
new_block->prev = block_before;
ffc0e770: 91 2a 00 0c stw r9,12(r10)
Heap_Block *new_block
)
{
Heap_Block *next = block_before->next;
new_block->next = next;
ffc0e774: 90 ca 00 08 stw r6,8(r10)
new_block->prev = block_before;
block_before->next = new_block;
next->prev = new_block;
ffc0e778: 91 46 00 0c stw r10,12(r6)
} else { /* no coalesce */
/* Add 'block' to the head of the free blocks list as it tends to
produce less fragmentation than adding to the tail. */
_Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block );
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
ffc0e77c: 60 e6 00 01 ori r6,r7,1
ffc0e780: 90 ca 00 04 stw r6,4(r10)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc0e784: 80 c8 00 04 lwz r6,4(r8)
next_block->prev_size = block_size;
ffc0e788: 7c e7 51 2e stwx r7,r7,r10
} else { /* no coalesce */
/* Add 'block' to the head of the free blocks list as it tends to
produce less fragmentation than adding to the tail. */
_Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block );
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc0e78c: 54 c6 00 3c rlwinm r6,r6,0,0,30
{
Heap_Block *next = block_before->next;
new_block->next = next;
new_block->prev = block_before;
block_before->next = new_block;
ffc0e790: 91 49 00 08 stw r10,8(r9)
next_block->prev_size = block_size;
/* Statistics */
++stats->free_blocks;
ffc0e794: 81 49 00 38 lwz r10,56(r9)
} else { /* no coalesce */
/* Add 'block' to the head of the free blocks list as it tends to
produce less fragmentation than adding to the tail. */
_Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block );
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc0e798: 90 c8 00 04 stw r6,4(r8)
next_block->prev_size = block_size;
/* Statistics */
++stats->free_blocks;
ffc0e79c: 39 4a 00 01 addi r10,r10,1
if ( stats->max_free_blocks < stats->free_blocks ) {
ffc0e7a0: 81 09 00 3c lwz r8,60(r9)
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
next_block->prev_size = block_size;
/* Statistics */
++stats->free_blocks;
ffc0e7a4: 91 49 00 38 stw r10,56(r9)
if ( stats->max_free_blocks < stats->free_blocks ) {
ffc0e7a8: 7f 88 50 40 cmplw cr7,r8,r10
ffc0e7ac: 40 9c 00 08 bge- cr7,ffc0e7b4 <_Heap_Free+0x1d8>
stats->max_free_blocks = stats->free_blocks;
ffc0e7b0: 91 49 00 3c stw r10,60(r9)
}
}
/* Statistics */
--stats->used_blocks;
ffc0e7b4: 81 49 00 40 lwz r10,64(r9)
ffc0e7b8: 39 4a ff ff addi r10,r10,-1
ffc0e7bc: 91 49 00 40 stw r10,64(r9)
++stats->frees;
ffc0e7c0: 81 49 00 50 lwz r10,80(r9)
ffc0e7c4: 39 4a 00 01 addi r10,r10,1
ffc0e7c8: 91 49 00 50 stw r10,80(r9)
stats->free_size += block_size;
ffc0e7cc: 81 49 00 30 lwz r10,48(r9)
ffc0e7d0: 7c ea 3a 14 add r7,r10,r7
ffc0e7d4: 90 e9 00 30 stw r7,48(r9)
* If NULL return true so a free on NULL is considered a valid release. This
* is a special case that could be handled by the in heap check how-ever that
* would result in false being returned which is wrong.
*/
if ( alloc_begin_ptr == NULL ) {
return true;
ffc0e7d8: 38 60 00 01 li r3,1
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc0e7dc: 39 61 00 10 addi r11,r1,16
ffc0e7e0: 4b ff 1d e4 b ffc005c4 <_restgpr_31_x>
ffc0b86c <_Heap_Greedy_allocate>:
Heap_Block *_Heap_Greedy_allocate(
Heap_Control *heap,
const uintptr_t *block_sizes,
size_t block_count
)
{
ffc0b86c: 94 21 ff e0 stwu r1,-32(r1)
ffc0b870: 7c 08 02 a6 mflr r0
ffc0b874: bf 61 00 0c stmw r27,12(r1)
ffc0b878: 7c 7f 1b 78 mr r31,r3
ffc0b87c: 7c 9c 23 78 mr r28,r4
ffc0b880: 90 01 00 24 stw r0,36(r1)
ffc0b884: 7c bb 2b 78 mr r27,r5
Heap_Block *allocated_blocks = NULL;
Heap_Block *blocks = NULL;
Heap_Block *current;
size_t i;
for (i = 0; i < block_count; ++i) {
ffc0b888: 3b c0 00 00 li r30,0
const uintptr_t *block_sizes,
size_t block_count
)
{
Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
Heap_Block *allocated_blocks = NULL;
ffc0b88c: 3b a0 00 00 li r29,0
Heap_Block *blocks = NULL;
Heap_Block *current;
size_t i;
for (i = 0; i < block_count; ++i) {
ffc0b890: 48 00 00 40 b ffc0b8d0 <_Heap_Greedy_allocate+0x64>
#include "config.h"
#endif
#include <rtems/score/heap.h>
Heap_Block *_Heap_Greedy_allocate(
ffc0b894: 57 c9 10 3a rlwinm r9,r30,2,0,29
* @brief See _Heap_Allocate_aligned_with_boundary() with alignment and
* boundary equals zero.
*/
RTEMS_INLINE_ROUTINE void *_Heap_Allocate( Heap_Control *heap, uintptr_t size )
{
return _Heap_Allocate_aligned_with_boundary( heap, size, 0, 0 );
ffc0b898: 7c 9c 48 2e lwzx r4,r28,r9
ffc0b89c: 7f e3 fb 78 mr r3,r31
ffc0b8a0: 38 a0 00 00 li r5,0
ffc0b8a4: 38 c0 00 00 li r6,0
ffc0b8a8: 48 00 76 bd bl ffc12f64 <_Heap_Allocate_aligned_with_boundary>
size_t i;
for (i = 0; i < block_count; ++i) {
void *next = _Heap_Allocate( heap, block_sizes [i] );
if ( next != NULL ) {
ffc0b8ac: 2c 03 00 00 cmpwi r3,0
ffc0b8b0: 41 82 00 1c beq- ffc0b8cc <_Heap_Greedy_allocate+0x60> <== NEVER TAKEN
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc0b8b4: 81 3f 00 10 lwz r9,16(r31)
ffc0b8b8: 7c 63 4b 96 divwu r3,r3,r9
ffc0b8bc: 7d 23 49 d6 mullw r9,r3,r9
Heap_Block *next_block = _Heap_Block_of_alloc_area(
(uintptr_t) next,
heap->page_size
);
next_block->next = allocated_blocks;
ffc0b8c0: 93 a9 00 00 stw r29,0(r9)
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc0b8c4: 39 29 ff f8 addi r9,r9,-8
ffc0b8c8: 7d 3d 4b 78 mr r29,r9
Heap_Block *allocated_blocks = NULL;
Heap_Block *blocks = NULL;
Heap_Block *current;
size_t i;
for (i = 0; i < block_count; ++i) {
ffc0b8cc: 3b de 00 01 addi r30,r30,1
ffc0b8d0: 7f 9e d8 00 cmpw cr7,r30,r27
ffc0b8d4: 40 9e ff c0 bne+ cr7,ffc0b894 <_Heap_Greedy_allocate+0x28>
ffc0b8d8: 3b 80 00 00 li r28,0
ffc0b8dc: 48 00 00 28 b ffc0b904 <_Heap_Greedy_allocate+0x98>
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0b8e0: 80 de 00 04 lwz r6,4(r30)
allocated_blocks = next_block;
}
}
while ( (current = _Heap_Free_list_first( heap )) != free_list_tail ) {
_Heap_Block_allocate(
ffc0b8e4: 7f e3 fb 78 mr r3,r31
ffc0b8e8: 7f c4 f3 78 mr r4,r30
ffc0b8ec: 54 c6 00 3c rlwinm r6,r6,0,0,30
ffc0b8f0: 38 be 00 08 addi r5,r30,8
ffc0b8f4: 38 c6 ff f8 addi r6,r6,-8
ffc0b8f8: 48 00 03 0d bl ffc0bc04 <_Heap_Block_allocate>
current,
_Heap_Alloc_area_of_block( current ),
_Heap_Block_size( current ) - HEAP_BLOCK_HEADER_SIZE
);
current->next = blocks;
ffc0b8fc: 93 9e 00 08 stw r28,8(r30)
ffc0b900: 7f dc f3 78 mr r28,r30
return &heap->free_list;
}
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap )
{
return _Heap_Free_list_head(heap)->next;
ffc0b904: 83 df 00 08 lwz r30,8(r31)
next_block->next = allocated_blocks;
allocated_blocks = next_block;
}
}
while ( (current = _Heap_Free_list_first( heap )) != free_list_tail ) {
ffc0b908: 7f 9e f8 00 cmpw cr7,r30,r31
ffc0b90c: 40 9e ff d4 bne+ cr7,ffc0b8e0 <_Heap_Greedy_allocate+0x74>
ffc0b910: 48 00 00 14 b ffc0b924 <_Heap_Greedy_allocate+0xb8>
blocks = current;
}
while ( allocated_blocks != NULL ) {
current = allocated_blocks;
allocated_blocks = allocated_blocks->next;
ffc0b914: 7f a4 eb 78 mr r4,r29
ffc0b918: 87 a4 00 08 lwzu r29,8(r4)
_Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( current ) );
ffc0b91c: 7f e3 fb 78 mr r3,r31
ffc0b920: 48 00 77 d5 bl ffc130f4 <_Heap_Free>
current->next = blocks;
blocks = current;
}
while ( allocated_blocks != NULL ) {
ffc0b924: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b928: 40 9e ff ec bne+ cr7,ffc0b914 <_Heap_Greedy_allocate+0xa8>
allocated_blocks = allocated_blocks->next;
_Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( current ) );
}
return blocks;
}
ffc0b92c: 39 61 00 20 addi r11,r1,32
ffc0b930: 7f 83 e3 78 mr r3,r28
ffc0b934: 4b ff 57 f0 b ffc01124 <_restgpr_27_x>
ffc12f90 <_Heap_Iterate>:
void _Heap_Iterate(
Heap_Control *heap,
Heap_Block_visitor visitor,
void *visitor_arg
)
{
ffc12f90: 94 21 ff e8 stwu r1,-24(r1)
ffc12f94: 7c 08 02 a6 mflr r0
ffc12f98: 90 01 00 1c stw r0,28(r1)
ffc12f9c: bf 81 00 08 stmw r28,8(r1)
ffc12fa0: 7c 9d 23 78 mr r29,r4
ffc12fa4: 7c bc 2b 78 mr r28,r5
Heap_Block *current = heap->first_block;
ffc12fa8: 81 23 00 20 lwz r9,32(r3)
Heap_Block *end = heap->last_block;
ffc12fac: 83 c3 00 24 lwz r30,36(r3)
ffc12fb0: 48 00 00 34 b ffc12fe4 <_Heap_Iterate+0x54>
ffc12fb4: 80 89 00 04 lwz r4,4(r9)
while ( !stop && current != end ) {
uintptr_t size = _Heap_Block_size( current );
Heap_Block *next = _Heap_Block_at( current, size );
bool used = _Heap_Is_prev_used( next );
stop = (*visitor)( current, size, used, visitor_arg );
ffc12fb8: 7d 23 4b 78 mr r3,r9
ffc12fbc: 7f 86 e3 78 mr r6,r28
ffc12fc0: 7f a9 03 a6 mtctr r29
ffc12fc4: 54 84 00 3c rlwinm r4,r4,0,0,30
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc12fc8: 7f e9 22 14 add r31,r9,r4
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc12fcc: 80 bf 00 04 lwz r5,4(r31)
ffc12fd0: 54 a5 07 fe clrlwi r5,r5,31
ffc12fd4: 4e 80 04 21 bctrl
ffc12fd8: 7f e9 fb 78 mr r9,r31
{
Heap_Block *current = heap->first_block;
Heap_Block *end = heap->last_block;
bool stop = false;
while ( !stop && current != end ) {
ffc12fdc: 2f 83 00 00 cmpwi cr7,r3,0
ffc12fe0: 40 9e 00 0c bne- cr7,ffc12fec <_Heap_Iterate+0x5c> <== NEVER TAKEN
ffc12fe4: 7f 89 f0 00 cmpw cr7,r9,r30
ffc12fe8: 40 9e ff cc bne+ cr7,ffc12fb4 <_Heap_Iterate+0x24>
stop = (*visitor)( current, size, used, visitor_arg );
current = next;
}
}
ffc12fec: 39 61 00 18 addi r11,r1,24
ffc12ff0: 4b ff 05 54 b ffc03544 <_restgpr_28_x>
ffc1bc64 <_Heap_Size_of_alloc_area>:
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc1bc64: 81 03 00 10 lwz r8,16(r3)
bool _Heap_Size_of_alloc_area(
Heap_Control *heap,
void *alloc_begin_ptr,
uintptr_t *alloc_size
)
{
ffc1bc68: 7c 69 1b 78 mr r9,r3
RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap(
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
ffc1bc6c: 80 e3 00 20 lwz r7,32(r3)
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc1bc70: 7d 44 43 96 divwu r10,r4,r8
ffc1bc74: 7d 0a 41 d6 mullw r8,r10,r8
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc1bc78: 39 40 00 00 li r10,0
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc1bc7c: 39 08 ff f8 addi r8,r8,-8
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc1bc80: 7f 88 38 40 cmplw cr7,r8,r7
ffc1bc84: 41 9c 00 14 blt- cr7,ffc1bc98 <_Heap_Size_of_alloc_area+0x34>
ffc1bc88: 81 43 00 24 lwz r10,36(r3)
ffc1bc8c: 7d 48 50 10 subfc r10,r8,r10
ffc1bc90: 39 40 00 00 li r10,0
ffc1bc94: 7d 4a 51 14 adde r10,r10,r10
uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr;
Heap_Block *block = _Heap_Block_of_alloc_area( alloc_begin, page_size );
Heap_Block *next_block = NULL;
uintptr_t block_size = 0;
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc1bc98: 2f 8a 00 00 cmpwi cr7,r10,0
return false;
ffc1bc9c: 38 60 00 00 li r3,0
uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr;
Heap_Block *block = _Heap_Block_of_alloc_area( alloc_begin, page_size );
Heap_Block *next_block = NULL;
uintptr_t block_size = 0;
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc1bca0: 4d 9e 00 20 beqlr cr7
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc1bca4: 81 48 00 04 lwz r10,4(r8)
ffc1bca8: 55 4a 00 3c rlwinm r10,r10,0,0,30
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc1bcac: 7d 4a 42 14 add r10,r10,r8
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc1bcb0: 7f 8a 38 40 cmplw cr7,r10,r7
ffc1bcb4: 39 00 00 00 li r8,0
ffc1bcb8: 41 9c 00 14 blt- cr7,ffc1bccc <_Heap_Size_of_alloc_area+0x68><== NEVER TAKEN
ffc1bcbc: 81 09 00 24 lwz r8,36(r9)
ffc1bcc0: 7d 0a 40 10 subfc r8,r10,r8
ffc1bcc4: 39 00 00 00 li r8,0
ffc1bcc8: 7d 08 41 14 adde r8,r8,r8
}
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if (
ffc1bccc: 2f 88 00 00 cmpwi cr7,r8,0
Heap_Block *block = _Heap_Block_of_alloc_area( alloc_begin, page_size );
Heap_Block *next_block = NULL;
uintptr_t block_size = 0;
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
return false;
ffc1bcd0: 38 60 00 00 li r3,0
}
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if (
ffc1bcd4: 4d 9e 00 20 beqlr cr7
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc1bcd8: 81 2a 00 04 lwz r9,4(r10)
!_Heap_Is_block_in_heap( heap, next_block )
|| !_Heap_Is_prev_used( next_block )
ffc1bcdc: 71 28 00 01 andi. r8,r9,1
ffc1bce0: 4d 82 00 20 beqlr
) {
return false;
}
*alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin;
ffc1bce4: 20 84 00 04 subfic r4,r4,4
ffc1bce8: 7d 44 52 14 add r10,r4,r10
ffc1bcec: 91 45 00 00 stw r10,0(r5)
return true;
ffc1bcf0: 38 60 00 01 li r3,1
}
ffc1bcf4: 4e 80 00 20 blr
ffc0a3a4 <_Heap_Walk>:
uintptr_t const min_block_size = heap->min_block_size;
Heap_Block *const first_block = heap->first_block;
Heap_Block *const last_block = heap->last_block;
Heap_Block *block = first_block;
Heap_Walk_printer printer = dump ?
_Heap_Walk_print : _Heap_Walk_print_nothing;
ffc0a3a4: 2f 85 00 00 cmpwi cr7,r5,0
bool _Heap_Walk(
Heap_Control *heap,
int source,
bool dump
)
{
ffc0a3a8: 94 21 ff 98 stwu r1,-104(r1)
ffc0a3ac: 7c 08 02 a6 mflr r0
ffc0a3b0: bd c1 00 20 stmw r14,32(r1)
ffc0a3b4: 7c 7d 1b 78 mr r29,r3
ffc0a3b8: 7c 9e 23 78 mr r30,r4
ffc0a3bc: 90 01 00 6c stw r0,108(r1)
uintptr_t const page_size = heap->page_size;
ffc0a3c0: 83 43 00 10 lwz r26,16(r3)
uintptr_t const min_block_size = heap->min_block_size;
ffc0a3c4: 83 03 00 14 lwz r24,20(r3)
Heap_Block *const first_block = heap->first_block;
ffc0a3c8: 83 83 00 20 lwz r28,32(r3)
Heap_Block *const last_block = heap->last_block;
ffc0a3cc: 82 e3 00 24 lwz r23,36(r3)
Heap_Block *block = first_block;
Heap_Walk_printer printer = dump ?
_Heap_Walk_print : _Heap_Walk_print_nothing;
ffc0a3d0: 41 9e 00 10 beq- cr7,ffc0a3e0 <_Heap_Walk+0x3c>
ffc0a3d4: 3f e0 ff c1 lis r31,-63
ffc0a3d8: 3b ff a2 f4 addi r31,r31,-23820
ffc0a3dc: 48 00 00 0c b ffc0a3e8 <_Heap_Walk+0x44>
ffc0a3e0: 3f e0 ff c1 lis r31,-63
ffc0a3e4: 3b ff a2 f0 addi r31,r31,-23824
if ( !_System_state_Is_up( _System_state_Get() ) ) {
ffc0a3e8: 3d 20 00 00 lis r9,0
ffc0a3ec: 81 29 28 6c lwz r9,10348(r9)
ffc0a3f0: 2f 89 00 03 cmpwi cr7,r9,3
ffc0a3f4: 41 9e 00 0c beq- cr7,ffc0a400 <_Heap_Walk+0x5c>
return true;
ffc0a3f8: 38 60 00 01 li r3,1
ffc0a3fc: 48 00 04 cc b ffc0a8c8 <_Heap_Walk+0x524>
Heap_Block *const first_free_block = _Heap_Free_list_first( heap );
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
Heap_Block *const first_block = heap->first_block;
Heap_Block *const last_block = heap->last_block;
(*printer)(
ffc0a400: 81 5d 00 08 lwz r10,8(r29)
ffc0a404: 3c a0 ff c1 lis r5,-63
ffc0a408: 81 1d 00 18 lwz r8,24(r29)
ffc0a40c: 7f c3 f3 78 mr r3,r30
ffc0a410: 91 41 00 0c stw r10,12(r1)
ffc0a414: 38 80 00 00 li r4,0
ffc0a418: 38 a5 7b f8 addi r5,r5,31736
ffc0a41c: 7f e9 03 a6 mtctr r31
ffc0a420: 81 5d 00 0c lwz r10,12(r29)
ffc0a424: 7f 46 d3 78 mr r6,r26
ffc0a428: 81 3d 00 1c lwz r9,28(r29)
ffc0a42c: 7f 07 c3 78 mr r7,r24
ffc0a430: 91 41 00 10 stw r10,16(r1)
ffc0a434: 7f 8a e3 78 mr r10,r28
ffc0a438: 92 e1 00 08 stw r23,8(r1)
ffc0a43c: 4c c6 31 82 crclr 4*cr1+eq
ffc0a440: 4e 80 04 21 bctrl
heap->area_begin, heap->area_end,
first_block, last_block,
first_free_block, last_free_block
);
if ( page_size == 0 ) {
ffc0a444: 2f 9a 00 00 cmpwi cr7,r26,0
ffc0a448: 40 be 00 18 bne+ cr7,ffc0a460 <_Heap_Walk+0xbc>
(*printer)( source, true, "page size is zero\n" );
ffc0a44c: 3c a0 ff c1 lis r5,-63
ffc0a450: 7f c3 f3 78 mr r3,r30
ffc0a454: 38 80 00 01 li r4,1
ffc0a458: 38 a5 7c 89 addi r5,r5,31881
ffc0a45c: 48 00 00 d8 b ffc0a534 <_Heap_Walk+0x190>
return false;
}
if ( !_Addresses_Is_aligned( (void *) page_size ) ) {
ffc0a460: 73 47 00 07 andi. r7,r26,7
ffc0a464: 41 a2 00 1c beq+ ffc0a480 <_Heap_Walk+0xdc>
(*printer)(
ffc0a468: 3c a0 ff c1 lis r5,-63
ffc0a46c: 7f c3 f3 78 mr r3,r30
ffc0a470: 38 80 00 01 li r4,1
ffc0a474: 38 a5 7c 9c addi r5,r5,31900
ffc0a478: 7f 46 d3 78 mr r6,r26
ffc0a47c: 48 00 04 3c b ffc0a8b8 <_Heap_Walk+0x514>
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc0a480: 7d 38 d3 96 divwu r9,r24,r26
ffc0a484: 7d 29 d1 d6 mullw r9,r9,r26
);
return false;
}
if ( !_Heap_Is_aligned( min_block_size, page_size ) ) {
ffc0a488: 7f 98 48 00 cmpw cr7,r24,r9
ffc0a48c: 41 be 00 1c beq+ cr7,ffc0a4a8 <_Heap_Walk+0x104>
(*printer)(
ffc0a490: 3c a0 ff c1 lis r5,-63
ffc0a494: 7f c3 f3 78 mr r3,r30
ffc0a498: 38 80 00 01 li r4,1
ffc0a49c: 38 a5 7c ba addi r5,r5,31930
ffc0a4a0: 7f 06 c3 78 mr r6,r24
ffc0a4a4: 48 00 04 14 b ffc0a8b8 <_Heap_Walk+0x514>
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block(
const Heap_Block *block
)
{
return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE;
ffc0a4a8: 39 3c 00 08 addi r9,r28,8
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc0a4ac: 7d 49 d3 96 divwu r10,r9,r26
ffc0a4b0: 7d 4a d1 d6 mullw r10,r10,r26
);
return false;
}
if (
ffc0a4b4: 7f 89 50 00 cmpw cr7,r9,r10
ffc0a4b8: 41 be 00 18 beq+ cr7,ffc0a4d0 <_Heap_Walk+0x12c>
!_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size )
) {
(*printer)(
ffc0a4bc: 3c a0 ff c1 lis r5,-63
ffc0a4c0: 7f c3 f3 78 mr r3,r30
ffc0a4c4: 38 80 00 01 li r4,1
ffc0a4c8: 38 a5 7c de addi r5,r5,31966
ffc0a4cc: 48 00 03 e8 b ffc0a8b4 <_Heap_Walk+0x510>
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0a4d0: 81 3c 00 04 lwz r9,4(r28)
);
return false;
}
if ( !_Heap_Is_prev_used( first_block ) ) {
ffc0a4d4: 71 27 00 01 andi. r7,r9,1
ffc0a4d8: 40 a2 00 18 bne+ ffc0a4f0 <_Heap_Walk+0x14c>
(*printer)(
ffc0a4dc: 3c a0 ff c1 lis r5,-63
ffc0a4e0: 7f c3 f3 78 mr r3,r30
ffc0a4e4: 38 80 00 01 li r4,1
ffc0a4e8: 38 a5 7d 0f addi r5,r5,32015
ffc0a4ec: 48 00 00 48 b ffc0a534 <_Heap_Walk+0x190>
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0a4f0: 82 d7 00 04 lwz r22,4(r23)
ffc0a4f4: 56 d6 00 3c rlwinm r22,r22,0,0,30
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc0a4f8: 7e d7 b2 14 add r22,r23,r22
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0a4fc: 81 36 00 04 lwz r9,4(r22)
);
return false;
}
if ( _Heap_Is_free( last_block ) ) {
ffc0a500: 71 27 00 01 andi. r7,r9,1
ffc0a504: 40 a2 00 18 bne+ ffc0a51c <_Heap_Walk+0x178>
(*printer)(
ffc0a508: 3c a0 ff c1 lis r5,-63
ffc0a50c: 7f c3 f3 78 mr r3,r30
ffc0a510: 38 80 00 01 li r4,1
ffc0a514: 38 a5 7d 3d addi r5,r5,32061
ffc0a518: 48 00 00 1c b ffc0a534 <_Heap_Walk+0x190>
);
return false;
}
if (
ffc0a51c: 7f 96 e0 00 cmpw cr7,r22,r28
ffc0a520: 41 9e 00 24 beq- cr7,ffc0a544 <_Heap_Walk+0x1a0>
_Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block
) {
(*printer)(
ffc0a524: 3c a0 ff c1 lis r5,-63
ffc0a528: 7f c3 f3 78 mr r3,r30
ffc0a52c: 38 80 00 01 li r4,1
ffc0a530: 38 a5 7d 52 addi r5,r5,32082
ffc0a534: 7f e9 03 a6 mtctr r31
ffc0a538: 4c c6 31 82 crclr 4*cr1+eq
ffc0a53c: 4e 80 04 21 bctrl
ffc0a540: 48 00 03 5c b ffc0a89c <_Heap_Walk+0x4f8>
int source,
Heap_Walk_printer printer,
Heap_Control *heap
)
{
uintptr_t const page_size = heap->page_size;
ffc0a544: 81 3d 00 10 lwz r9,16(r29)
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
ffc0a548: 7f aa eb 78 mr r10,r29
return &heap->free_list;
}
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap )
{
return _Heap_Free_list_head(heap)->next;
ffc0a54c: 80 dd 00 08 lwz r6,8(r29)
ffc0a550: 48 00 00 bc b ffc0a60c <_Heap_Walk+0x268>
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0a554: 80 fd 00 20 lwz r7,32(r29)
ffc0a558: 39 00 00 00 li r8,0
ffc0a55c: 7f 87 30 40 cmplw cr7,r7,r6
ffc0a560: 41 9d 00 14 bgt- cr7,ffc0a574 <_Heap_Walk+0x1d0>
ffc0a564: 81 1d 00 24 lwz r8,36(r29)
ffc0a568: 7d 06 40 10 subfc r8,r6,r8
ffc0a56c: 39 00 00 00 li r8,0
ffc0a570: 7d 08 41 14 adde r8,r8,r8
const Heap_Block *const first_free_block = _Heap_Free_list_first( heap );
const Heap_Block *prev_block = free_list_tail;
const Heap_Block *free_block = first_free_block;
while ( free_block != free_list_tail ) {
if ( !_Heap_Is_block_in_heap( heap, free_block ) ) {
ffc0a574: 2f 88 00 00 cmpwi cr7,r8,0
ffc0a578: 40 be 00 18 bne+ cr7,ffc0a590 <_Heap_Walk+0x1ec>
(*printer)(
ffc0a57c: 3c a0 ff c1 lis r5,-63
ffc0a580: 7f c3 f3 78 mr r3,r30
ffc0a584: 38 80 00 01 li r4,1
ffc0a588: 38 a5 7d 81 addi r5,r5,32129
ffc0a58c: 48 00 03 2c b ffc0a8b8 <_Heap_Walk+0x514>
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block(
const Heap_Block *block
)
{
return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE;
ffc0a590: 39 06 00 08 addi r8,r6,8
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc0a594: 7c e8 4b 96 divwu r7,r8,r9
ffc0a598: 7c e7 49 d6 mullw r7,r7,r9
);
return false;
}
if (
ffc0a59c: 7f 88 38 00 cmpw cr7,r8,r7
ffc0a5a0: 41 be 00 18 beq+ cr7,ffc0a5b8 <_Heap_Walk+0x214>
!_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size )
) {
(*printer)(
ffc0a5a4: 3c a0 ff c1 lis r5,-63
ffc0a5a8: 7f c3 f3 78 mr r3,r30
ffc0a5ac: 38 80 00 01 li r4,1
ffc0a5b0: 38 a5 7d a1 addi r5,r5,32161
ffc0a5b4: 48 00 03 04 b ffc0a8b8 <_Heap_Walk+0x514>
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0a5b8: 81 06 00 04 lwz r8,4(r6)
ffc0a5bc: 55 08 00 3c rlwinm r8,r8,0,0,30
block = next_block;
} while ( block != first_block );
return true;
}
ffc0a5c0: 7d 06 42 14 add r8,r6,r8
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0a5c4: 81 08 00 04 lwz r8,4(r8)
);
return false;
}
if ( _Heap_Is_used( free_block ) ) {
ffc0a5c8: 71 07 00 01 andi. r7,r8,1
ffc0a5cc: 41 a2 00 18 beq+ ffc0a5e4 <_Heap_Walk+0x240>
(*printer)(
ffc0a5d0: 3c a0 ff c1 lis r5,-63
ffc0a5d4: 7f c3 f3 78 mr r3,r30
ffc0a5d8: 38 80 00 01 li r4,1
ffc0a5dc: 38 a5 7d d1 addi r5,r5,32209
ffc0a5e0: 48 00 02 d8 b ffc0a8b8 <_Heap_Walk+0x514>
);
return false;
}
if ( free_block->prev != prev_block ) {
ffc0a5e4: 80 e6 00 0c lwz r7,12(r6)
ffc0a5e8: 7f 87 50 00 cmpw cr7,r7,r10
ffc0a5ec: 41 be 00 18 beq+ cr7,ffc0a604 <_Heap_Walk+0x260>
(*printer)(
ffc0a5f0: 3c a0 ff c1 lis r5,-63
ffc0a5f4: 7f c3 f3 78 mr r3,r30
ffc0a5f8: 38 80 00 01 li r4,1
ffc0a5fc: 38 a5 7d ed addi r5,r5,32237
ffc0a600: 48 00 01 38 b ffc0a738 <_Heap_Walk+0x394>
return false;
}
prev_block = free_block;
free_block = free_block->next;
ffc0a604: 7c ca 33 78 mr r10,r6
ffc0a608: 80 c6 00 08 lwz r6,8(r6)
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
const Heap_Block *const first_free_block = _Heap_Free_list_first( heap );
const Heap_Block *prev_block = free_list_tail;
const Heap_Block *free_block = first_free_block;
while ( free_block != free_list_tail ) {
ffc0a60c: 7f 86 e8 00 cmpw cr7,r6,r29
ffc0a610: 40 9e ff 44 bne+ cr7,ffc0a554 <_Heap_Walk+0x1b0>
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc0a614: 3e 80 ff c1 lis r20,-63
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
(*printer)(
ffc0a618: 3e 60 ff c1 lis r19,-63
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a61c: 3e 40 ff c1 lis r18,-63
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
const Heap_Block *const first_free_block = _Heap_Free_list_first( heap );
const Heap_Block *prev_block = free_list_tail;
const Heap_Block *free_block = first_free_block;
while ( free_block != free_list_tail ) {
ffc0a620: 7e dc b3 78 mr r28,r22
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc0a624: 3a 94 7f 8d addi r20,r20,32653
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
(*printer)(
ffc0a628: 3a 73 7f 76 addi r19,r19,32630
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a62c: 3a 52 7e d9 addi r18,r18,32473
ffc0a630: 3e 20 ff c1 lis r17,-63
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
block->next,
block->next == last_free_block ?
" (= last free)"
: (block->next == free_list_tail ? " (= tail)" : "")
ffc0a634: 3e a0 ff c1 lis r21,-63
ffc0a638: 3e 00 ff c1 lis r16,-63
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a63c: 3d e0 ff c1 lis r15,-63
block,
block_size,
block->prev,
block->prev == first_free_block ?
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
ffc0a640: 3d c0 ff c1 lis r14,-63
block = next_block;
} while ( block != first_block );
return true;
}
ffc0a644: 81 7c 00 04 lwz r11,4(r28)
uintptr_t const block_begin = (uintptr_t) block;
uintptr_t const block_size = _Heap_Block_size( block );
bool const prev_used = _Heap_Is_prev_used( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
uintptr_t const next_block_begin = (uintptr_t) next_block;
bool const is_not_last_block = block != last_block;
ffc0a648: 7f 89 ba 78 xor r9,r28,r23
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0a64c: 81 1d 00 20 lwz r8,32(r29)
ffc0a650: 7d 29 00 34 cntlzw r9,r9
- HEAP_BLOCK_HEADER_SIZE);
}
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block )
{
return block->size_and_flag & ~HEAP_PREV_BLOCK_USED;
ffc0a654: 55 7b 00 3c rlwinm r27,r11,0,0,30
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
ffc0a658: 7f 3b e2 14 add r25,r27,r28
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0a65c: 7f 88 c8 40 cmplw cr7,r8,r25
ffc0a660: 55 29 d9 7e rlwinm r9,r9,27,5,31
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0a664: 55 6b 07 fe clrlwi r11,r11,31
ffc0a668: 69 29 00 01 xori r9,r9,1
const Heap_Control *heap,
const Heap_Block *block
)
{
return (uintptr_t) block >= (uintptr_t) heap->first_block
&& (uintptr_t) block <= (uintptr_t) heap->last_block;
ffc0a66c: 39 40 00 00 li r10,0
ffc0a670: 41 9d 00 14 bgt- cr7,ffc0a684 <_Heap_Walk+0x2e0> <== NEVER TAKEN
ffc0a674: 81 5d 00 24 lwz r10,36(r29)
ffc0a678: 7d 59 50 10 subfc r10,r25,r10
ffc0a67c: 39 40 00 00 li r10,0
ffc0a680: 7d 4a 51 14 adde r10,r10,r10
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc0a684: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0a688: 40 be 00 18 bne+ cr7,ffc0a6a0 <_Heap_Walk+0x2fc>
(*printer)(
ffc0a68c: 3c a0 ff c1 lis r5,-63
ffc0a690: 7f c3 f3 78 mr r3,r30
ffc0a694: 38 80 00 01 li r4,1
ffc0a698: 38 a5 7e 1f addi r5,r5,32287
ffc0a69c: 48 00 00 94 b ffc0a730 <_Heap_Walk+0x38c>
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc0a6a0: 7d 5b d3 96 divwu r10,r27,r26
ffc0a6a4: 7d 4a d1 d6 mullw r10,r10,r26
);
return false;
}
if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) {
ffc0a6a8: 7f 9b 50 00 cmpw cr7,r27,r10
ffc0a6ac: 41 9e 00 28 beq- cr7,ffc0a6d4 <_Heap_Walk+0x330>
ffc0a6b0: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a6b4: 41 be 00 94 beq+ cr7,ffc0a748 <_Heap_Walk+0x3a4>
(*printer)(
ffc0a6b8: 3c a0 ff c1 lis r5,-63
ffc0a6bc: 7f c3 f3 78 mr r3,r30
ffc0a6c0: 38 80 00 01 li r4,1
ffc0a6c4: 38 a5 7e 4c addi r5,r5,32332
ffc0a6c8: 7f 86 e3 78 mr r6,r28
ffc0a6cc: 7f 67 db 78 mr r7,r27
ffc0a6d0: 48 00 00 68 b ffc0a738 <_Heap_Walk+0x394>
);
return false;
}
if ( block_size < min_block_size && is_not_last_block ) {
ffc0a6d4: 7f 9b c0 40 cmplw cr7,r27,r24
ffc0a6d8: 40 9c 00 38 bge- cr7,ffc0a710 <_Heap_Walk+0x36c>
ffc0a6dc: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a6e0: 41 be 00 68 beq+ cr7,ffc0a748 <_Heap_Walk+0x3a4> <== NEVER TAKEN
(*printer)(
ffc0a6e4: 3c a0 ff c1 lis r5,-63
ffc0a6e8: 7f e9 03 a6 mtctr r31
ffc0a6ec: 7f c3 f3 78 mr r3,r30
ffc0a6f0: 38 80 00 01 li r4,1
ffc0a6f4: 38 a5 7e 7a addi r5,r5,32378
ffc0a6f8: 7f 86 e3 78 mr r6,r28
ffc0a6fc: 7f 67 db 78 mr r7,r27
ffc0a700: 7f 08 c3 78 mr r8,r24
ffc0a704: 4c c6 31 82 crclr 4*cr1+eq
ffc0a708: 4e 80 04 21 bctrl
ffc0a70c: 48 00 01 90 b ffc0a89c <_Heap_Walk+0x4f8>
);
return false;
}
if ( next_block_begin <= block_begin && is_not_last_block ) {
ffc0a710: 7f 99 e0 40 cmplw cr7,r25,r28
ffc0a714: 41 9d 00 34 bgt- cr7,ffc0a748 <_Heap_Walk+0x3a4>
ffc0a718: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a71c: 41 be 00 2c beq+ cr7,ffc0a748 <_Heap_Walk+0x3a4>
(*printer)(
ffc0a720: 3c a0 ff c1 lis r5,-63
ffc0a724: 7f c3 f3 78 mr r3,r30
ffc0a728: 38 80 00 01 li r4,1
ffc0a72c: 38 a5 7e a5 addi r5,r5,32421
ffc0a730: 7f 86 e3 78 mr r6,r28
ffc0a734: 7f 27 cb 78 mr r7,r25
ffc0a738: 7f e9 03 a6 mtctr r31
ffc0a73c: 4c c6 31 82 crclr 4*cr1+eq
ffc0a740: 4e 80 04 21 bctrl
ffc0a744: 48 00 01 58 b ffc0a89c <_Heap_Walk+0x4f8>
block->size_and_flag = size | flag;
}
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block )
{
return block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0a748: 81 39 00 04 lwz r9,4(r25)
);
return false;
}
if ( !_Heap_Is_prev_used( next_block ) ) {
ffc0a74c: 71 27 00 01 andi. r7,r9,1
ffc0a750: 40 a2 00 f4 bne+ ffc0a844 <_Heap_Walk+0x4a0>
false,
"block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n",
block,
block_size,
block->prev,
block->prev == first_free_block ?
ffc0a754: 81 1c 00 0c lwz r8,12(r28)
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a758: 81 3d 00 08 lwz r9,8(r29)
return _Heap_Free_list_head(heap)->next;
}
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_last( Heap_Control *heap )
{
return _Heap_Free_list_tail(heap)->prev;
ffc0a75c: 80 fd 00 0c lwz r7,12(r29)
ffc0a760: 7f 88 48 00 cmpw cr7,r8,r9
ffc0a764: 41 9e 00 18 beq- cr7,ffc0a77c <_Heap_Walk+0x3d8>
block,
block_size,
block->prev,
block->prev == first_free_block ?
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
ffc0a768: 7f 88 e8 00 cmpw cr7,r8,r29
ffc0a76c: 39 35 7a 9d addi r9,r21,31389
ffc0a770: 40 be 00 10 bne+ cr7,ffc0a780 <_Heap_Walk+0x3dc>
ffc0a774: 39 2e 7b d5 addi r9,r14,31701
ffc0a778: 48 00 00 08 b ffc0a780 <_Heap_Walk+0x3dc>
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a77c: 39 2f 7b c5 addi r9,r15,31685
block->prev,
block->prev == first_free_block ?
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
block->next,
block->next == last_free_block ?
ffc0a780: 81 5c 00 08 lwz r10,8(r28)
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a784: 7f 8a 38 00 cmpw cr7,r10,r7
ffc0a788: 41 9e 00 18 beq- cr7,ffc0a7a0 <_Heap_Walk+0x3fc>
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
block->next,
block->next == last_free_block ?
" (= last free)"
: (block->next == free_list_tail ? " (= tail)" : "")
ffc0a78c: 7f 8a e8 00 cmpw cr7,r10,r29
ffc0a790: 38 f5 7a 9d addi r7,r21,31389
ffc0a794: 40 be 00 10 bne+ cr7,ffc0a7a4 <_Heap_Walk+0x400>
ffc0a798: 38 f0 7b ee addi r7,r16,31726
ffc0a79c: 48 00 00 08 b ffc0a7a4 <_Heap_Walk+0x400>
Heap_Block *const last_free_block = _Heap_Free_list_last( heap );
bool const prev_used = _Heap_Is_prev_used( block );
uintptr_t const block_size = _Heap_Block_size( block );
Heap_Block *const next_block = _Heap_Block_at( block, block_size );
(*printer)(
ffc0a7a0: 38 f1 7b df addi r7,r17,31711
ffc0a7a4: 90 e1 00 08 stw r7,8(r1)
ffc0a7a8: 7f c3 f3 78 mr r3,r30
ffc0a7ac: 38 80 00 00 li r4,0
ffc0a7b0: 7f e9 03 a6 mtctr r31
ffc0a7b4: 91 61 00 18 stw r11,24(r1)
ffc0a7b8: 7e 45 93 78 mr r5,r18
ffc0a7bc: 7f 86 e3 78 mr r6,r28
ffc0a7c0: 7f 67 db 78 mr r7,r27
ffc0a7c4: 4c c6 31 82 crclr 4*cr1+eq
ffc0a7c8: 4e 80 04 21 bctrl
block->next == last_free_block ?
" (= last free)"
: (block->next == free_list_tail ? " (= tail)" : "")
);
if ( block_size != next_block->prev_size ) {
ffc0a7cc: 81 19 00 00 lwz r8,0(r25)
ffc0a7d0: 81 61 00 18 lwz r11,24(r1)
ffc0a7d4: 7f 9b 40 00 cmpw cr7,r27,r8
ffc0a7d8: 41 be 00 30 beq+ cr7,ffc0a808 <_Heap_Walk+0x464>
(*printer)(
ffc0a7dc: 3c a0 ff c1 lis r5,-63
ffc0a7e0: 7f e9 03 a6 mtctr r31
ffc0a7e4: 7f c3 f3 78 mr r3,r30
ffc0a7e8: 38 80 00 01 li r4,1
ffc0a7ec: 38 a5 7f 0e addi r5,r5,32526
ffc0a7f0: 7f 86 e3 78 mr r6,r28
ffc0a7f4: 7f 67 db 78 mr r7,r27
ffc0a7f8: 7f 29 cb 78 mr r9,r25
ffc0a7fc: 4c c6 31 82 crclr 4*cr1+eq
ffc0a800: 4e 80 04 21 bctrl
ffc0a804: 48 00 00 98 b ffc0a89c <_Heap_Walk+0x4f8>
);
return false;
}
if ( !prev_used ) {
ffc0a808: 2f 8b 00 00 cmpwi cr7,r11,0
ffc0a80c: 40 be 00 18 bne+ cr7,ffc0a824 <_Heap_Walk+0x480>
(*printer)(
ffc0a810: 3c a0 ff c1 lis r5,-63
ffc0a814: 7f c3 f3 78 mr r3,r30
ffc0a818: 38 80 00 01 li r4,1
ffc0a81c: 38 a5 7f 47 addi r5,r5,32583
ffc0a820: 48 00 00 94 b ffc0a8b4 <_Heap_Walk+0x510>
return &heap->free_list;
}
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap )
{
return _Heap_Free_list_head(heap)->next;
ffc0a824: 81 3d 00 08 lwz r9,8(r29)
ffc0a828: 48 00 00 10 b ffc0a838 <_Heap_Walk+0x494>
{
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
const Heap_Block *free_block = _Heap_Free_list_first( heap );
while ( free_block != free_list_tail ) {
if ( free_block == block ) {
ffc0a82c: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0a830: 41 9e 00 5c beq- cr7,ffc0a88c <_Heap_Walk+0x4e8>
return true;
}
free_block = free_block->next;
ffc0a834: 81 29 00 08 lwz r9,8(r9)
)
{
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
const Heap_Block *free_block = _Heap_Free_list_first( heap );
while ( free_block != free_list_tail ) {
ffc0a838: 7f 89 e8 00 cmpw cr7,r9,r29
ffc0a83c: 40 9e ff f0 bne+ cr7,ffc0a82c <_Heap_Walk+0x488>
ffc0a840: 48 00 00 64 b ffc0a8a4 <_Heap_Walk+0x500>
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
ffc0a844: 2f 8b 00 00 cmpwi cr7,r11,0
(*printer)(
ffc0a848: 7f c3 f3 78 mr r3,r30
ffc0a84c: 38 80 00 00 li r4,0
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
ffc0a850: 41 9e 00 20 beq- cr7,ffc0a870 <_Heap_Walk+0x4cc>
(*printer)(
ffc0a854: 7e 65 9b 78 mr r5,r19
ffc0a858: 7f e9 03 a6 mtctr r31
ffc0a85c: 7f 86 e3 78 mr r6,r28
ffc0a860: 7f 67 db 78 mr r7,r27
ffc0a864: 4c c6 31 82 crclr 4*cr1+eq
ffc0a868: 4e 80 04 21 bctrl
ffc0a86c: 48 00 00 20 b ffc0a88c <_Heap_Walk+0x4e8>
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc0a870: 7e 85 a3 78 mr r5,r20
ffc0a874: 81 1c 00 00 lwz r8,0(r28)
ffc0a878: 7f 86 e3 78 mr r6,r28
ffc0a87c: 7f e9 03 a6 mtctr r31
ffc0a880: 7f 67 db 78 mr r7,r27
ffc0a884: 4c c6 31 82 crclr 4*cr1+eq
ffc0a888: 4e 80 04 21 bctrl
block->prev_size
);
}
block = next_block;
} while ( block != first_block );
ffc0a88c: 7f 99 b0 00 cmpw cr7,r25,r22
ffc0a890: 7f 3c cb 78 mr r28,r25
ffc0a894: 40 9e fd b0 bne+ cr7,ffc0a644 <_Heap_Walk+0x2a0>
ffc0a898: 4b ff fb 60 b ffc0a3f8 <_Heap_Walk+0x54>
if ( !_System_state_Is_up( _System_state_Get() ) ) {
return true;
}
if ( !_Heap_Walk_check_control( source, printer, heap ) ) {
return false;
ffc0a89c: 38 60 00 00 li r3,0
ffc0a8a0: 48 00 00 28 b ffc0a8c8 <_Heap_Walk+0x524>
return false;
}
if ( !_Heap_Walk_is_in_free_list( heap, block ) ) {
(*printer)(
ffc0a8a4: 3c a0 ff c1 lis r5,-63
ffc0a8a8: 7f c3 f3 78 mr r3,r30
ffc0a8ac: 38 80 00 01 li r4,1
ffc0a8b0: 38 a5 7f b2 addi r5,r5,32690
ffc0a8b4: 7f 86 e3 78 mr r6,r28
ffc0a8b8: 7f e9 03 a6 mtctr r31
ffc0a8bc: 4c c6 31 82 crclr 4*cr1+eq
ffc0a8c0: 4e 80 04 21 bctrl
ffc0a8c4: 4b ff ff d8 b ffc0a89c <_Heap_Walk+0x4f8>
block = next_block;
} while ( block != first_block );
return true;
}
ffc0a8c8: 39 61 00 68 addi r11,r1,104
ffc0a8cc: 4b ff 62 9c b ffc00b68 <_restgpr_14_x>
ffc0a2f4 <_Heap_Walk_print>:
/* Do nothing */
}
static void _Heap_Walk_print( int source, bool error, const char *fmt, ... )
{
ffc0a2f4: 7c 2b 0b 78 mr r11,r1
ffc0a2f8: 7c 08 02 a6 mflr r0
ffc0a2fc: 94 21 ff 88 stwu r1,-120(r1)
ffc0a300: 4b ff 68 61 bl ffc00b60 <_savegpr_31>
ffc0a304: 90 01 00 7c stw r0,124(r1)
ffc0a308: 7c 6b 1b 78 mr r11,r3
ffc0a30c: 90 c1 00 1c stw r6,28(r1)
ffc0a310: 90 e1 00 20 stw r7,32(r1)
ffc0a314: 91 01 00 24 stw r8,36(r1)
ffc0a318: 91 21 00 28 stw r9,40(r1)
ffc0a31c: 91 41 00 2c stw r10,44(r1)
ffc0a320: 40 86 00 24 bne- cr1,ffc0a344 <_Heap_Walk_print+0x50> <== ALWAYS TAKEN
ffc0a324: d8 21 00 30 stfd f1,48(r1) <== NOT EXECUTED
ffc0a328: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED
ffc0a32c: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED
ffc0a330: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED
ffc0a334: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED
ffc0a338: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED
ffc0a33c: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED
ffc0a340: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED
va_list ap;
if ( error ) {
ffc0a344: 2f 84 00 00 cmpwi cr7,r4,0
{
/* Do nothing */
}
static void _Heap_Walk_print( int source, bool error, const char *fmt, ... )
{
ffc0a348: 7c bf 2b 78 mr r31,r5
va_list ap;
if ( error ) {
ffc0a34c: 41 be 00 10 beq+ cr7,ffc0a35c <_Heap_Walk_print+0x68>
printk( "FAIL[%d]: ", source );
ffc0a350: 3c 60 ff c1 lis r3,-63
ffc0a354: 38 63 7b af addi r3,r3,31663
ffc0a358: 48 00 00 0c b ffc0a364 <_Heap_Walk_print+0x70>
} else {
printk( "PASS[%d]: ", source );
ffc0a35c: 3c 60 ff c1 lis r3,-63
ffc0a360: 38 63 7b ba addi r3,r3,31674
ffc0a364: 7d 64 5b 78 mr r4,r11
ffc0a368: 4c c6 31 82 crclr 4*cr1+eq
ffc0a36c: 4b ff b3 01 bl ffc0566c <printk>
}
va_start( ap, fmt );
ffc0a370: 39 20 00 03 li r9,3
ffc0a374: 99 21 00 08 stb r9,8(r1)
ffc0a378: 39 20 00 00 li r9,0
vprintk( fmt, ap );
ffc0a37c: 7f e3 fb 78 mr r3,r31
printk( "FAIL[%d]: ", source );
} else {
printk( "PASS[%d]: ", source );
}
va_start( ap, fmt );
ffc0a380: 99 21 00 09 stb r9,9(r1)
ffc0a384: 39 21 00 80 addi r9,r1,128
vprintk( fmt, ap );
ffc0a388: 38 81 00 08 addi r4,r1,8
printk( "FAIL[%d]: ", source );
} else {
printk( "PASS[%d]: ", source );
}
va_start( ap, fmt );
ffc0a38c: 91 21 00 0c stw r9,12(r1)
ffc0a390: 39 21 00 10 addi r9,r1,16
ffc0a394: 91 21 00 10 stw r9,16(r1)
vprintk( fmt, ap );
ffc0a398: 4b ff dd 1d bl ffc080b4 <vprintk>
va_end( ap );
}
ffc0a39c: 39 61 00 78 addi r11,r1,120
ffc0a3a0: 4b ff 68 0c b ffc00bac <_restgpr_31_x>
ffc09dd0 <_Internal_error_Occurred>:
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
ffc09dd0: 94 21 ff d8 stwu r1,-40(r1)
ffc09dd4: 7c 08 02 a6 mflr r0
ffc09dd8: bf a1 00 1c stmw r29,28(r1)
ffc09ddc: 7c 9e 23 78 mr r30,r4
ffc09de0: 7c 7d 1b 78 mr r29,r3
Internal_errors_Source source,
bool is_internal,
Internal_errors_t error
)
{
User_extensions_Fatal_context ctx = { source, is_internal, error };
ffc09de4: 98 81 00 0c stb r4,12(r1)
_User_extensions_Iterate( &ctx, _User_extensions_Fatal_visitor );
ffc09de8: 3c 80 ff c1 lis r4,-63
ffc09dec: 38 84 be 4c addi r4,r4,-16820
Internal_errors_Source source,
bool is_internal,
Internal_errors_t error
)
{
User_extensions_Fatal_context ctx = { source, is_internal, error };
ffc09df0: 90 61 00 08 stw r3,8(r1)
_User_extensions_Iterate( &ctx, _User_extensions_Fatal_visitor );
ffc09df4: 38 61 00 08 addi r3,r1,8
ffc09df8: 7c bf 2b 78 mr r31,r5
ffc09dfc: 90 01 00 2c stw r0,44(r1)
Internal_errors_Source source,
bool is_internal,
Internal_errors_t error
)
{
User_extensions_Fatal_context ctx = { source, is_internal, error };
ffc09e00: 90 a1 00 10 stw r5,16(r1)
_User_extensions_Iterate( &ctx, _User_extensions_Fatal_visitor );
ffc09e04: 48 00 20 6d bl ffc0be70 <_User_extensions_Iterate>
_User_extensions_Fatal( the_source, is_internal, the_error );
_Internal_errors_What_happened.the_source = the_source;
ffc09e08: 3d 40 00 00 lis r10,0
ffc09e0c: 39 2a 31 78 addi r9,r10,12664
ffc09e10: 93 aa 31 78 stw r29,12664(r10)
_Internal_errors_What_happened.is_internal = is_internal;
_Internal_errors_What_happened.the_error = the_error;
_System_state_Set( SYSTEM_STATE_FAILED );
_CPU_Fatal_halt( the_error );
ffc09e14: 7f e3 fb 78 mr r3,r31
)
{
_User_extensions_Fatal( the_source, is_internal, the_error );
_Internal_errors_What_happened.the_source = the_source;
_Internal_errors_What_happened.is_internal = is_internal;
ffc09e18: 9b c9 00 04 stb r30,4(r9)
RTEMS_INLINE_ROUTINE void _System_state_Set (
System_state_Codes state
)
{
_System_state_Current = state;
ffc09e1c: 39 40 00 05 li r10,5
_Internal_errors_What_happened.the_error = the_error;
ffc09e20: 93 e9 00 08 stw r31,8(r9)
ffc09e24: 3d 20 00 00 lis r9,0
ffc09e28: 91 49 28 90 stw r10,10384(r9)
_System_state_Set( SYSTEM_STATE_FAILED );
_CPU_Fatal_halt( the_error );
ffc09e2c: 4b ff 99 35 bl ffc03760 <_BSP_Fatal_error>
ffc09e30: 48 00 00 00 b ffc09e30 <_Internal_error_Occurred+0x60><== NOT EXECUTED
ffc09e48 <_Objects_Allocate>:
#endif
Objects_Control *_Objects_Allocate(
Objects_Information *information
)
{
ffc09e48: 94 21 ff f0 stwu r1,-16(r1)
ffc09e4c: 7c 08 02 a6 mflr r0
ffc09e50: 90 01 00 14 stw r0,20(r1)
* If the application is using the optional manager stubs and
* still attempts to create the object, the information block
* should be all zeroed out because it is in the BSS. So let's
* check that code for this manager is even present.
*/
if ( information->size == 0 )
ffc09e54: 81 23 00 18 lwz r9,24(r3)
#endif
Objects_Control *_Objects_Allocate(
Objects_Information *information
)
{
ffc09e58: bf c1 00 08 stmw r30,8(r1)
ffc09e5c: 7c 7f 1b 78 mr r31,r3
* If the application is using the optional manager stubs and
* still attempts to create the object, the information block
* should be all zeroed out because it is in the BSS. So let's
* check that code for this manager is even present.
*/
if ( information->size == 0 )
ffc09e60: 2f 89 00 00 cmpwi cr7,r9,0
ffc09e64: 40 be 00 0c bne+ cr7,ffc09e70 <_Objects_Allocate+0x28> <== ALWAYS TAKEN
return NULL;
ffc09e68: 38 60 00 00 li r3,0
ffc09e6c: 48 00 00 70 b ffc09edc <_Objects_Allocate+0x94>
/*
* OK. The manager should be initialized and configured to have objects.
* With any luck, it is safe to attempt to allocate an object.
*/
the_object = (Objects_Control *) _Chain_Get( &information->Inactive );
ffc09e70: 3b c3 00 20 addi r30,r3,32
ffc09e74: 7f c3 f3 78 mr r3,r30
ffc09e78: 4b ff f5 b9 bl ffc09430 <_Chain_Get>
if ( information->auto_extend ) {
ffc09e7c: 89 3f 00 12 lbz r9,18(r31)
ffc09e80: 2f 89 00 00 cmpwi cr7,r9,0
ffc09e84: 41 9e 00 58 beq- cr7,ffc09edc <_Objects_Allocate+0x94>
/*
* If the list is empty then we are out of objects and need to
* extend information base.
*/
if ( !the_object ) {
ffc09e88: 2f 83 00 00 cmpwi cr7,r3,0
ffc09e8c: 40 be 00 1c bne+ cr7,ffc09ea8 <_Objects_Allocate+0x60>
_Objects_Extend_information( information );
ffc09e90: 7f e3 fb 78 mr r3,r31
ffc09e94: 48 00 00 69 bl ffc09efc <_Objects_Extend_information>
the_object = (Objects_Control *) _Chain_Get( &information->Inactive );
ffc09e98: 7f c3 f3 78 mr r3,r30
ffc09e9c: 4b ff f5 95 bl ffc09430 <_Chain_Get>
}
if ( the_object ) {
ffc09ea0: 2c 03 00 00 cmpwi r3,0
ffc09ea4: 41 82 ff c4 beq+ ffc09e68 <_Objects_Allocate+0x20>
uint32_t block;
block = (uint32_t) _Objects_Get_index( the_object->id ) -
ffc09ea8: a1 43 00 0a lhz r10,10(r3)
ffc09eac: a1 3f 00 0a lhz r9,10(r31)
ffc09eb0: 7d 29 50 50 subf r9,r9,r10
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
ffc09eb4: a1 5f 00 14 lhz r10,20(r31)
ffc09eb8: 7d 29 53 96 divwu r9,r9,r10
information->inactive_per_block[ block ]--;
ffc09ebc: 81 5f 00 30 lwz r10,48(r31)
ffc09ec0: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc09ec4: 7d 0a 48 2e lwzx r8,r10,r9
ffc09ec8: 39 08 ff ff addi r8,r8,-1
ffc09ecc: 7d 0a 49 2e stwx r8,r10,r9
information->inactive--;
ffc09ed0: a1 3f 00 2c lhz r9,44(r31)
ffc09ed4: 39 29 ff ff addi r9,r9,-1
ffc09ed8: b1 3f 00 2c sth r9,44(r31)
);
}
#endif
return the_object;
}
ffc09edc: 39 61 00 10 addi r11,r1,16
ffc09ee0: 4b ff 66 e0 b ffc005c0 <_restgpr_30_x>
ffc09efc <_Objects_Extend_information>:
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
ffc09efc: 94 21 ff b8 stwu r1,-72(r1)
ffc09f00: 7c 08 02 a6 mflr r0
ffc09f04: 90 01 00 4c stw r0,76(r1)
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
ffc09f08: 81 43 00 34 lwz r10,52(r3)
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
ffc09f0c: be a1 00 1c stmw r21,28(r1)
ffc09f10: 7c 7f 1b 78 mr r31,r3
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
ffc09f14: 2f 8a 00 00 cmpwi cr7,r10,0
/*
* Search for a free block of indexes. If we do NOT need to allocate or
* extend the block table, then we will change do_extend.
*/
do_extend = true;
minimum_index = _Objects_Get_index( information->minimum_id );
ffc09f18: a3 83 00 0a lhz r28,10(r3)
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
ffc09f1c: 41 9e 00 54 beq- cr7,ffc09f70 <_Objects_Extend_information+0x74>
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc09f20: a1 03 00 14 lhz r8,20(r3)
/*
* Search for a free block of indexes. If we do NOT need to allocate or
* extend the block table, then we will change do_extend.
*/
do_extend = true;
minimum_index = _Objects_Get_index( information->minimum_id );
ffc09f24: 7f 9e e3 78 mr r30,r28
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc09f28: a3 a3 00 10 lhz r29,16(r3)
* extend the block table, then we will change do_extend.
*/
do_extend = true;
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
ffc09f2c: 3b 60 00 00 li r27,0
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc09f30: 7f bd 43 96 divwu r29,r29,r8
ffc09f34: 2f 9d 00 00 cmpwi cr7,r29,0
* extend the block table, then we will change do_extend.
*/
do_extend = true;
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
ffc09f38: 39 3d 00 01 addi r9,r29,1
ffc09f3c: 40 be 00 24 bne+ cr7,ffc09f60 <_Objects_Extend_information+0x64><== ALWAYS TAKEN
ffc09f40: 39 20 00 01 li r9,1 <== NOT EXECUTED
ffc09f44: 48 00 00 1c b ffc09f60 <_Objects_Extend_information+0x64><== NOT EXECUTED
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc09f48: 57 67 10 3a rlwinm r7,r27,2,0,29
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
if ( information->object_blocks[ block ] == NULL ) {
ffc09f4c: 7c ea 38 2e lwzx r7,r10,r7
ffc09f50: 2f 87 00 00 cmpwi cr7,r7,0
ffc09f54: 41 9e 00 30 beq- cr7,ffc09f84 <_Objects_Extend_information+0x88>
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc09f58: 7f de 42 14 add r30,r30,r8
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
ffc09f5c: 3b 7b 00 01 addi r27,r27,1
ffc09f60: 35 29 ff ff addic. r9,r9,-1
ffc09f64: 40 82 ff e4 bne+ ffc09f48 <_Objects_Extend_information+0x4c>
/*
* Search for a free block of indexes. If we do NOT need to allocate or
* extend the block table, then we will change do_extend.
*/
do_extend = true;
ffc09f68: 3b 40 00 01 li r26,1
ffc09f6c: 48 00 00 1c b ffc09f88 <_Objects_Extend_information+0x8c>
minimum_index = _Objects_Get_index( information->minimum_id );
ffc09f70: 7f 9e e3 78 mr r30,r28
/*
* Search for a free block of indexes. If we do NOT need to allocate or
* extend the block table, then we will change do_extend.
*/
do_extend = true;
ffc09f74: 3b 40 00 01 li r26,1
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
ffc09f78: 3b 60 00 00 li r27,0
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
ffc09f7c: 3b a0 00 00 li r29,0
ffc09f80: 48 00 00 08 b ffc09f88 <_Objects_Extend_information+0x8c>
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
if ( information->object_blocks[ block ] == NULL ) {
do_extend = false;
ffc09f84: 3b 40 00 00 li r26,0
} else
index_base += information->allocation_size;
}
}
maximum = (uint32_t) information->maximum + information->allocation_size;
ffc09f88: a1 3f 00 14 lhz r9,20(r31)
ffc09f8c: a3 3f 00 10 lhz r25,16(r31)
ffc09f90: 7f 29 ca 14 add r25,r9,r25
/*
* We need to limit the number of objects to the maximum number
* representable in the index portion of the object Id. In the
* case of 16-bit Ids, this is only 256 object instances.
*/
if ( maximum > OBJECTS_ID_FINAL_INDEX ) {
ffc09f94: 2b 99 ff ff cmplwi cr7,r25,65535
ffc09f98: 41 9d 02 10 bgt- cr7,ffc0a1a8 <_Objects_Extend_information+0x2ac>
/*
* Allocate the name table, and the objects and if it fails either return or
* generate a fatal error depending on auto-extending being active.
*/
block_size = information->allocation_size * information->size;
ffc09f9c: 80 7f 00 18 lwz r3,24(r31)
ffc09fa0: 7c 69 19 d6 mullw r3,r9,r3
if ( information->auto_extend ) {
ffc09fa4: 89 3f 00 12 lbz r9,18(r31)
ffc09fa8: 2f 89 00 00 cmpwi cr7,r9,0
ffc09fac: 41 9e 00 14 beq- cr7,ffc09fc0 <_Objects_Extend_information+0xc4>
new_object_block = _Workspace_Allocate( block_size );
ffc09fb0: 48 00 23 c9 bl ffc0c378 <_Workspace_Allocate>
if ( !new_object_block )
ffc09fb4: 7c 76 1b 79 mr. r22,r3
ffc09fb8: 40 a2 00 10 bne+ ffc09fc8 <_Objects_Extend_information+0xcc>
ffc09fbc: 48 00 01 ec b ffc0a1a8 <_Objects_Extend_information+0x2ac>
return;
} else {
new_object_block = _Workspace_Allocate_or_fatal_error( block_size );
ffc09fc0: 48 00 23 e1 bl ffc0c3a0 <_Workspace_Allocate_or_fatal_error>
ffc09fc4: 7c 76 1b 78 mr r22,r3
}
/*
* Do we need to grow the tables?
*/
if ( do_extend ) {
ffc09fc8: 2f 9a 00 00 cmpwi cr7,r26,0
ffc09fcc: 41 9e 01 58 beq- cr7,ffc0a124 <_Objects_Extend_information+0x228>
*/
/*
* Up the block count and maximum
*/
block_count++;
ffc09fd0: 3b 1d 00 01 addi r24,r29,1
/*
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
ffc09fd4: 1d 38 00 03 mulli r9,r24,3
((maximum + minimum_index) * sizeof(Objects_Control *));
ffc09fd8: 7c 79 e2 14 add r3,r25,r28
/*
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
ffc09fdc: 7c 63 4a 14 add r3,r3,r9
((maximum + minimum_index) * sizeof(Objects_Control *));
if ( information->auto_extend ) {
ffc09fe0: 89 3f 00 12 lbz r9,18(r31)
block_count++;
/*
* Allocate the tables and break it up.
*/
block_size = block_count *
ffc09fe4: 54 63 10 3a rlwinm r3,r3,2,0,29
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
((maximum + minimum_index) * sizeof(Objects_Control *));
if ( information->auto_extend ) {
ffc09fe8: 2f 89 00 00 cmpwi cr7,r9,0
ffc09fec: 41 9e 00 1c beq- cr7,ffc0a008 <_Objects_Extend_information+0x10c>
object_blocks = _Workspace_Allocate( block_size );
ffc09ff0: 48 00 23 89 bl ffc0c378 <_Workspace_Allocate>
if ( !object_blocks ) {
ffc09ff4: 7c 7a 1b 79 mr. r26,r3
ffc09ff8: 40 a2 00 18 bne+ ffc0a010 <_Objects_Extend_information+0x114>
_Workspace_Free( new_object_block );
ffc09ffc: 7e c3 b3 78 mr r3,r22
ffc0a000: 48 00 23 91 bl ffc0c390 <_Workspace_Free>
ffc0a004: 48 00 01 a4 b ffc0a1a8 <_Objects_Extend_information+0x2ac>
return;
}
} else {
object_blocks = _Workspace_Allocate_or_fatal_error( block_size );
ffc0a008: 48 00 23 99 bl ffc0c3a0 <_Workspace_Allocate_or_fatal_error>
ffc0a00c: 7c 7a 1b 78 mr r26,r3
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a010: a1 1f 00 10 lhz r8,16(r31)
/*
* Break the block into the various sections.
*/
inactive_per_block = (uint32_t *) _Addresses_Add_offset(
object_blocks, block_count * sizeof(void*) );
ffc0a014: 57 18 10 3a rlwinm r24,r24,2,0,29
RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset (
const void *base,
uintptr_t offset
)
{
return (void *)((uintptr_t)base + offset);
ffc0a018: 7e fa c2 14 add r23,r26,r24
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a01c: 7f 88 e0 40 cmplw cr7,r8,r28
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
ffc0a020: 38 fc 00 01 addi r7,r28,1
ffc0a024: 7f 17 c2 14 add r24,r23,r24
ffc0a028: 7c e9 03 a6 mtctr r7
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a02c: 39 20 00 00 li r9,0
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
ffc0a030: 39 40 00 00 li r10,0
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a034: 40 bd 00 50 ble+ cr7,ffc0a084 <_Objects_Extend_information+0x188>
* separate parts as size of each block has changed.
*/
memcpy( object_blocks,
information->object_blocks,
block_count * sizeof(void*) );
ffc0a038: 57 b5 10 3a rlwinm r21,r29,2,0,29
/*
* Copy each section of the table over. This has to be performed as
* separate parts as size of each block has changed.
*/
memcpy( object_blocks,
ffc0a03c: 80 9f 00 34 lwz r4,52(r31)
ffc0a040: 7e a5 ab 78 mr r5,r21
ffc0a044: 7f 43 d3 78 mr r3,r26
ffc0a048: 48 00 72 69 bl ffc112b0 <memcpy>
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
ffc0a04c: 80 9f 00 30 lwz r4,48(r31)
ffc0a050: 7e a5 ab 78 mr r5,r21
ffc0a054: 7e e3 bb 78 mr r3,r23
ffc0a058: 48 00 72 59 bl ffc112b0 <memcpy>
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
information->local_table,
(information->maximum + minimum_index) * sizeof(Objects_Control *) );
ffc0a05c: a1 3f 00 10 lhz r9,16(r31)
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
ffc0a060: 80 9f 00 1c lwz r4,28(r31)
ffc0a064: 7f 03 c3 78 mr r3,r24
information->local_table,
(information->maximum + minimum_index) * sizeof(Objects_Control *) );
ffc0a068: 7c a9 e2 14 add r5,r9,r28
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
ffc0a06c: 54 a5 10 3a rlwinm r5,r5,2,0,29
ffc0a070: 48 00 72 41 bl ffc112b0 <memcpy>
ffc0a074: 48 00 00 14 b ffc0a088 <_Objects_Extend_information+0x18c>
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc0a078: 55 28 10 3a rlwinm r8,r9,2,0,29
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
ffc0a07c: 7d 48 c1 2e stwx r10,r8,r24
} else {
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
ffc0a080: 39 29 00 01 addi r9,r9,1
ffc0a084: 42 00 ff f4 bdnz+ ffc0a078 <_Objects_Extend_information+0x17c>
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
ffc0a088: 39 20 00 00 li r9,0
ffc0a08c: 57 bd 10 3a rlwinm r29,r29,2,0,29
ffc0a090: 7d 3a e9 2e stwx r9,r26,r29
inactive_per_block[block_count] = 0;
for ( index=index_base ;
ffc0a094: 7f ca f3 78 mr r10,r30
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
ffc0a098: 38 e0 00 00 li r7,0
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
ffc0a09c: 7d 37 e9 2e stwx r9,r23,r29
for ( index=index_base ;
index < ( information->allocation_size + index_base );
ffc0a0a0: a1 3f 00 14 lhz r9,20(r31)
index++ ) {
local_table[ index ] = NULL;
ffc0a0a4: 7d 1e 4a 14 add r8,r30,r9
ffc0a0a8: 7f 9e 40 40 cmplw cr7,r30,r8
ffc0a0ac: 39 29 00 01 addi r9,r9,1
ffc0a0b0: 41 9d 00 0c bgt- cr7,ffc0a0bc <_Objects_Extend_information+0x1c0><== NEVER TAKEN
ffc0a0b4: 2f 88 00 00 cmpwi cr7,r8,0
ffc0a0b8: 40 be 00 18 bne+ cr7,ffc0a0d0 <_Objects_Extend_information+0x1d4><== ALWAYS TAKEN
ffc0a0bc: 39 20 00 01 li r9,1 <== NOT EXECUTED
ffc0a0c0: 48 00 00 10 b ffc0a0d0 <_Objects_Extend_information+0x1d4><== NOT EXECUTED
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc0a0c4: 55 48 10 3a rlwinm r8,r10,2,0,29
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
ffc0a0c8: 7c e8 c1 2e stwx r7,r8,r24
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
index++ ) {
ffc0a0cc: 39 4a 00 01 addi r10,r10,1
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
ffc0a0d0: 35 29 ff ff addic. r9,r9,-1
ffc0a0d4: 40 82 ff f0 bne+ ffc0a0c4 <_Objects_Extend_information+0x1c8>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0a0d8: 7d 40 00 a6 mfmsr r10
ffc0a0dc: 7d 30 42 a6 mfsprg r9,0
ffc0a0e0: 7d 49 48 78 andc r9,r10,r9
ffc0a0e4: 7d 20 01 24 mtmsr r9
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a0e8: 81 3f 00 00 lwz r9,0(r31)
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
ffc0a0ec: a1 1f 00 04 lhz r8,4(r31)
ffc0a0f0: 55 29 c0 0e rlwinm r9,r9,24,0,7
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = (Objects_Maximum) maximum;
ffc0a0f4: b3 3f 00 10 sth r25,16(r31)
ffc0a0f8: 65 29 00 01 oris r9,r9,1
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a0fc: 7d 39 cb 78 or r25,r9,r25
local_table[ index ] = NULL;
}
_ISR_Disable( level );
old_tables = information->object_blocks;
ffc0a100: 80 7f 00 34 lwz r3,52(r31)
ffc0a104: 55 08 d8 08 rlwinm r8,r8,27,0,4
information->object_blocks = object_blocks;
ffc0a108: 93 5f 00 34 stw r26,52(r31)
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a10c: 7f 39 43 78 or r25,r25,r8
information->inactive_per_block = inactive_per_block;
ffc0a110: 92 ff 00 30 stw r23,48(r31)
information->local_table = local_table;
ffc0a114: 93 1f 00 1c stw r24,28(r31)
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
ffc0a118: 93 3f 00 0c stw r25,12(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0a11c: 7d 40 01 24 mtmsr r10
information->maximum
);
_ISR_Enable( level );
_Workspace_Free( old_tables );
ffc0a120: 48 00 22 71 bl ffc0c390 <_Workspace_Free>
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
ffc0a124: 81 3f 00 34 lwz r9,52(r31)
ffc0a128: 57 7b 10 3a rlwinm r27,r27,2,0,29
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a12c: 3b a1 00 08 addi r29,r1,8
ffc0a130: a0 bf 00 14 lhz r5,20(r31)
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
ffc0a134: 7e c9 d9 2e stwx r22,r9,r27
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a138: 7f a3 eb 78 mr r3,r29
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a13c: 3b 9f 00 20 addi r28,r31,32
information->object_blocks[ block ] = new_object_block;
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a140: 81 3f 00 34 lwz r9,52(r31)
ffc0a144: 80 df 00 18 lwz r6,24(r31)
ffc0a148: 7c 89 d8 2e lwzx r4,r9,r27
ffc0a14c: 4b ff f3 25 bl ffc09470 <_Chain_Initialize>
/*
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
ffc0a150: 48 00 00 30 b ffc0a180 <_Objects_Extend_information+0x284>
ffc0a154: 81 3f 00 00 lwz r9,0(r31)
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a158: 7f 83 e3 78 mr r3,r28
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
the_object->id = _Objects_Build_id(
ffc0a15c: a1 5f 00 04 lhz r10,4(r31)
ffc0a160: 55 29 c0 0e rlwinm r9,r9,24,0,7
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a164: 55 4a d8 08 rlwinm r10,r10,27,0,4
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a168: 65 29 00 01 oris r9,r9,1
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a16c: 7d 29 53 78 or r9,r9,r10
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a170: 7d 29 f3 78 or r9,r9,r30
ffc0a174: 91 24 00 08 stw r9,8(r4)
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
ffc0a178: 3b de 00 01 addi r30,r30,1
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a17c: 4b ff f2 85 bl ffc09400 <_Chain_Append>
/*
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
ffc0a180: 7f a3 eb 78 mr r3,r29
ffc0a184: 4b ff f2 ad bl ffc09430 <_Chain_Get>
ffc0a188: 7c 64 1b 79 mr. r4,r3
ffc0a18c: 40 82 ff c8 bne+ ffc0a154 <_Objects_Extend_information+0x258>
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
ffc0a190: a1 3f 00 14 lhz r9,20(r31)
ffc0a194: 81 5f 00 30 lwz r10,48(r31)
ffc0a198: 7d 2a d9 2e stwx r9,r10,r27
information->inactive =
(Objects_Maximum)(information->inactive + information->allocation_size);
ffc0a19c: a1 5f 00 2c lhz r10,44(r31)
ffc0a1a0: 7d 29 52 14 add r9,r9,r10
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
information->inactive =
ffc0a1a4: b1 3f 00 2c sth r9,44(r31)
(Objects_Maximum)(information->inactive + information->allocation_size);
}
ffc0a1a8: 39 61 00 48 addi r11,r1,72
ffc0a1ac: 4b ff 63 f0 b ffc0059c <_restgpr_21_x>
ffc0a258 <_Objects_Get_information>:
Objects_Information *_Objects_Get_information(
Objects_APIs the_api,
uint16_t the_class
)
{
ffc0a258: 94 21 ff f0 stwu r1,-16(r1)
ffc0a25c: 7c 08 02 a6 mflr r0
ffc0a260: bf c1 00 08 stmw r30,8(r1)
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
ffc0a264: 7c 9f 23 79 mr. r31,r4
Objects_Information *_Objects_Get_information(
Objects_APIs the_api,
uint16_t the_class
)
{
ffc0a268: 90 01 00 14 stw r0,20(r1)
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
ffc0a26c: 40 a2 00 0c bne+ ffc0a278 <_Objects_Get_information+0x20>
return NULL;
ffc0a270: 38 60 00 00 li r3,0
ffc0a274: 48 00 00 50 b ffc0a2c4 <_Objects_Get_information+0x6c>
ffc0a278: 7c 7e 1b 78 mr r30,r3
/*
* This call implicitly validates the_api so we do not call
* _Objects_Is_api_valid above here.
*/
the_class_api_maximum = _Objects_API_maximum_class( the_api );
ffc0a27c: 48 00 45 69 bl ffc0e7e4 <_Objects_API_maximum_class>
if ( the_class_api_maximum == 0 )
ffc0a280: 2c 03 00 00 cmpwi r3,0
ffc0a284: 41 a2 ff ec beq- ffc0a270 <_Objects_Get_information+0x18>
return NULL;
if ( the_class > (uint32_t) the_class_api_maximum )
ffc0a288: 7f 9f 18 40 cmplw cr7,r31,r3
ffc0a28c: 41 bd ff e4 bgt- cr7,ffc0a270 <_Objects_Get_information+0x18>
return NULL;
if ( !_Objects_Information_table[ the_api ] )
ffc0a290: 3d 20 00 00 lis r9,0
ffc0a294: 57 de 10 3a rlwinm r30,r30,2,0,29
ffc0a298: 39 29 2c 78 addi r9,r9,11384
ffc0a29c: 7d 29 f0 2e lwzx r9,r9,r30
ffc0a2a0: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a2a4: 41 be ff cc beq- cr7,ffc0a270 <_Objects_Get_information+0x18><== NEVER TAKEN
return NULL;
info = _Objects_Information_table[ the_api ][ the_class ];
ffc0a2a8: 57 ff 10 3a rlwinm r31,r31,2,0,29
ffc0a2ac: 7c 69 f8 2e lwzx r3,r9,r31
if ( !info )
ffc0a2b0: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a2b4: 41 be ff bc beq- cr7,ffc0a270 <_Objects_Get_information+0x18><== NEVER TAKEN
* In a multprocessing configuration, we may access remote objects.
* Thus we may have 0 local instances and still have a valid object
* pointer.
*/
#if !defined(RTEMS_MULTIPROCESSING)
if ( info->maximum == 0 )
ffc0a2b8: a1 23 00 10 lhz r9,16(r3)
ffc0a2bc: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a2c0: 41 be ff b0 beq- cr7,ffc0a270 <_Objects_Get_information+0x18>
return NULL;
#endif
return info;
}
ffc0a2c4: 39 61 00 10 addi r11,r1,16
ffc0a2c8: 4b ff 62 f8 b ffc005c0 <_restgpr_30_x>
ffc1c818 <_Objects_Get_no_protection>:
/*
* You can't just extract the index portion or you can get tricked
* by a value between 1 and maximum.
*/
index = id - information->minimum_id + 1;
ffc1c818: 81 23 00 08 lwz r9,8(r3)
ffc1c81c: 21 29 00 01 subfic r9,r9,1
ffc1c820: 7c 89 22 14 add r4,r9,r4
if ( information->maximum >= index ) {
ffc1c824: a1 23 00 10 lhz r9,16(r3)
ffc1c828: 7f 89 20 40 cmplw cr7,r9,r4
ffc1c82c: 41 9c 00 24 blt- cr7,ffc1c850 <_Objects_Get_no_protection+0x38>
if ( (the_object = information->local_table[ index ]) != NULL ) {
ffc1c830: 81 23 00 1c lwz r9,28(r3)
ffc1c834: 54 84 10 3a rlwinm r4,r4,2,0,29
ffc1c838: 7c 69 20 2e lwzx r3,r9,r4
ffc1c83c: 2f 83 00 00 cmpwi cr7,r3,0
ffc1c840: 41 9e 00 10 beq- cr7,ffc1c850 <_Objects_Get_no_protection+0x38><== NEVER TAKEN
*location = OBJECTS_LOCAL;
ffc1c844: 39 20 00 00 li r9,0
ffc1c848: 91 25 00 00 stw r9,0(r5)
return the_object;
ffc1c84c: 4e 80 00 20 blr
/*
* This isn't supported or required yet for Global objects so
* if it isn't local, we don't find it.
*/
*location = OBJECTS_ERROR;
ffc1c850: 39 20 00 01 li r9,1
ffc1c854: 91 25 00 00 stw r9,0(r5)
return NULL;
ffc1c858: 38 60 00 00 li r3,0
}
ffc1c85c: 4e 80 00 20 blr
ffc0e280 <_Objects_Id_to_name>:
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
ffc0e280: 7c 2b 0b 78 mr r11,r1
ffc0e284: 94 21 ff e0 stwu r1,-32(r1)
ffc0e288: 7c 08 02 a6 mflr r0
ffc0e28c: 48 01 b3 2d bl ffc295b8 <_savegpr_31>
ffc0e290: 7c 9f 23 78 mr r31,r4
/*
* Caller is trusted for name != NULL.
*/
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
ffc0e294: 7c 64 1b 79 mr. r4,r3
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
ffc0e298: 90 01 00 24 stw r0,36(r1)
/*
* Caller is trusted for name != NULL.
*/
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
ffc0e29c: 40 82 00 10 bne- ffc0e2ac <_Objects_Id_to_name+0x2c>
ffc0e2a0: 3d 20 00 00 lis r9,0
ffc0e2a4: 81 29 3a f0 lwz r9,15088(r9)
ffc0e2a8: 80 89 00 08 lwz r4,8(r9)
*/
RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API(
Objects_Id id
)
{
return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS);
ffc0e2ac: 54 8a 47 7e rlwinm r10,r4,8,29,31
*/
RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid(
uint32_t the_api
)
{
if ( !the_api || the_api > OBJECTS_APIS_LAST )
ffc0e2b0: 39 0a ff ff addi r8,r10,-1
ffc0e2b4: 2b 88 00 02 cmplwi cr7,r8,2
ffc0e2b8: 40 9d 00 4c ble- cr7,ffc0e304 <_Objects_Id_to_name+0x84>
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
ffc0e2bc: 38 60 00 03 li r3,3
ffc0e2c0: 48 00 00 60 b ffc0e320 <_Objects_Id_to_name+0xa0>
if ( !_Objects_Information_table[ the_api ] )
return OBJECTS_INVALID_ID;
the_class = _Objects_Get_class( tmpId );
information = _Objects_Information_table[ the_api ][ the_class ];
ffc0e2c4: 54 88 3e 7a rlwinm r8,r4,7,25,29
ffc0e2c8: 7c 6a 40 2e lwzx r3,r10,r8
if ( !information )
ffc0e2cc: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e2d0: 41 be ff ec beq- cr7,ffc0e2bc <_Objects_Id_to_name+0x3c><== NEVER TAKEN
return OBJECTS_INVALID_ID;
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string )
ffc0e2d4: 89 43 00 38 lbz r10,56(r3)
ffc0e2d8: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0e2dc: 40 9e ff e0 bne+ cr7,ffc0e2bc <_Objects_Id_to_name+0x3c><== NEVER TAKEN
return OBJECTS_INVALID_ID;
#endif
the_object = _Objects_Get( information, tmpId, &ignored_location );
ffc0e2e0: 38 a1 00 08 addi r5,r1,8
ffc0e2e4: 4b ff ff 1d bl ffc0e200 <_Objects_Get>
if ( !the_object )
ffc0e2e8: 2c 03 00 00 cmpwi r3,0
ffc0e2ec: 41 a2 ff d0 beq- ffc0e2bc <_Objects_Id_to_name+0x3c>
return OBJECTS_INVALID_ID;
*name = the_object->name;
ffc0e2f0: 81 23 00 0c lwz r9,12(r3)
ffc0e2f4: 91 3f 00 00 stw r9,0(r31)
_Thread_Enable_dispatch();
ffc0e2f8: 48 00 0e 9d bl ffc0f194 <_Thread_Enable_dispatch>
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
ffc0e2fc: 38 60 00 00 li r3,0
ffc0e300: 48 00 00 20 b ffc0e320 <_Objects_Id_to_name+0xa0>
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
if ( !_Objects_Information_table[ the_api ] )
ffc0e304: 3d 00 00 00 lis r8,0
ffc0e308: 55 4a 10 3a rlwinm r10,r10,2,0,29
ffc0e30c: 39 08 35 78 addi r8,r8,13688
ffc0e310: 7d 48 50 2e lwzx r10,r8,r10
ffc0e314: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0e318: 40 9e ff ac bne+ cr7,ffc0e2c4 <_Objects_Id_to_name+0x44>
ffc0e31c: 4b ff ff a0 b ffc0e2bc <_Objects_Id_to_name+0x3c>
return OBJECTS_INVALID_ID;
*name = the_object->name;
_Thread_Enable_dispatch();
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
}
ffc0e320: 39 61 00 20 addi r11,r1,32
ffc0e324: 4b ff 25 0c b ffc00830 <_restgpr_31_x>
ffc0a99c <_POSIX_Absolute_timeout_to_ticks>:
*/
POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks(
const struct timespec *abstime,
Watchdog_Interval *ticks_out
)
{
ffc0a99c: 94 21 ff c8 stwu r1,-56(r1)
ffc0a9a0: 7c 08 02 a6 mflr r0
/*
* Make sure there is always a value returned.
*/
*ticks_out = 0;
ffc0a9a4: 39 20 00 00 li r9,0
*/
POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks(
const struct timespec *abstime,
Watchdog_Interval *ticks_out
)
{
ffc0a9a8: bf 81 00 28 stmw r28,40(r1)
ffc0a9ac: 7c 7c 1b 78 mr r28,r3
ffc0a9b0: 7c 9d 23 78 mr r29,r4
ffc0a9b4: 90 01 00 3c stw r0,60(r1)
/*
* Make sure there is always a value returned.
*/
*ticks_out = 0;
ffc0a9b8: 91 24 00 00 stw r9,0(r4)
/*
* Is the absolute time even valid?
*/
if ( !_Timespec_Is_valid(abstime) )
ffc0a9bc: 48 00 44 61 bl ffc0ee1c <_Timespec_Is_valid>
return POSIX_ABSOLUTE_TIMEOUT_INVALID;
ffc0a9c0: 39 20 00 00 li r9,0
*ticks_out = 0;
/*
* Is the absolute time even valid?
*/
if ( !_Timespec_Is_valid(abstime) )
ffc0a9c4: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a9c8: 41 be 00 9c beq+ cr7,ffc0aa64 <_POSIX_Absolute_timeout_to_ticks+0xc8>
)
{
Timestamp_Control tod_as_timestamp;
Timestamp_Control *tod_as_timestamp_ptr;
tod_as_timestamp_ptr =
ffc0a9cc: 3c 80 00 00 lis r4,0
ffc0a9d0: 38 84 2c c0 addi r4,r4,11456
ffc0a9d4: 38 61 00 18 addi r3,r1,24
ffc0a9d8: 48 00 1f 1d bl ffc0c8f4 <_TOD_Get_with_nanoseconds>
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc0a9dc: 3c c0 3b 9a lis r6,15258
/*
* This is the case we were expecting and it took this long to
* get here.
*/
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE;
}
ffc0a9e0: 83 c3 00 00 lwz r30,0(r3)
ffc0a9e4: 38 a0 00 00 li r5,0
ffc0a9e8: 83 e3 00 04 lwz r31,4(r3)
ffc0a9ec: 60 c6 ca 00 ori r6,r6,51712
ffc0a9f0: 7f c3 f3 78 mr r3,r30
ffc0a9f4: 7f e4 fb 78 mr r4,r31
ffc0a9f8: 48 00 da b5 bl ffc184ac <__divdi3>
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc0a9fc: 3c c0 3b 9a lis r6,15258
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc0aa00: 90 81 00 10 stw r4,16(r1)
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc0aa04: 38 a0 00 00 li r5,0
ffc0aa08: 60 c6 ca 00 ori r6,r6,51712
ffc0aa0c: 7f c3 f3 78 mr r3,r30
ffc0aa10: 7f e4 fb 78 mr r4,r31
ffc0aa14: 48 00 de bd bl ffc188d0 <__moddi3>
/*
* Is the absolute time in the past?
*/
_TOD_Get( ¤t_time );
if ( _Timespec_Less_than( abstime, ¤t_time ) )
ffc0aa18: 7f 83 e3 78 mr r3,r28
ffc0aa1c: 90 81 00 14 stw r4,20(r1)
ffc0aa20: 38 81 00 10 addi r4,r1,16
ffc0aa24: 48 00 44 39 bl ffc0ee5c <_Timespec_Less_than>
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST;
ffc0aa28: 39 20 00 01 li r9,1
/*
* Is the absolute time in the past?
*/
_TOD_Get( ¤t_time );
if ( _Timespec_Less_than( abstime, ¤t_time ) )
ffc0aa2c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0aa30: 40 be 00 34 bne+ cr7,ffc0aa64 <_POSIX_Absolute_timeout_to_ticks+0xc8>
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST;
/*
* How long until the requested absolute time?
*/
_Timespec_Subtract( ¤t_time, abstime, &difference );
ffc0aa34: 38 61 00 10 addi r3,r1,16
ffc0aa38: 7f 84 e3 78 mr r4,r28
ffc0aa3c: 38 a1 00 08 addi r5,r1,8
ffc0aa40: 48 00 44 59 bl ffc0ee98 <_Timespec_Subtract>
/*
* Internally the SuperCore uses ticks, so convert to them.
*/
*ticks_out = _Timespec_To_ticks( &difference );
ffc0aa44: 38 61 00 08 addi r3,r1,8
ffc0aa48: 48 00 44 91 bl ffc0eed8 <_Timespec_To_ticks>
/*
* This is the case we were expecting and it took this long to
* get here.
*/
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE;
ffc0aa4c: 39 20 00 03 li r9,3
/*
* If the difference was 0, then the future is now. It is so bright
* we better wear shades.
*/
if ( !*ticks_out )
ffc0aa50: 2f 83 00 00 cmpwi cr7,r3,0
_Timespec_Subtract( ¤t_time, abstime, &difference );
/*
* Internally the SuperCore uses ticks, so convert to them.
*/
*ticks_out = _Timespec_To_ticks( &difference );
ffc0aa54: 90 7d 00 00 stw r3,0(r29)
/*
* If the difference was 0, then the future is now. It is so bright
* we better wear shades.
*/
if ( !*ticks_out )
ffc0aa58: 40 9e 00 0c bne- cr7,ffc0aa64 <_POSIX_Absolute_timeout_to_ticks+0xc8><== ALWAYS TAKEN
return POSIX_ABSOLUTE_TIMEOUT_IS_NOW;
ffc0aa5c: 39 20 00 02 li r9,2 <== NOT EXECUTED
ffc0aa60: 48 00 00 04 b ffc0aa64 <_POSIX_Absolute_timeout_to_ticks+0xc8><== NOT EXECUTED
/*
* This is the case we were expecting and it took this long to
* get here.
*/
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE;
}
ffc0aa64: 39 61 00 38 addi r11,r1,56
ffc0aa68: 7d 23 4b 78 mr r3,r9
ffc0aa6c: 4b ff 7f 0c b ffc02978 <_restgpr_28_x>
ffc0fe50 <_POSIX_Keys_Run_destructors>:
*/
void _POSIX_Keys_Run_destructors(
Thread_Control *thread
)
{
ffc0fe50: 94 21 ff e0 stwu r1,-32(r1)
ffc0fe54: 7c 08 02 a6 mflr r0
ffc0fe58: 90 01 00 24 stw r0,36(r1)
Objects_Maximum thread_index = _Objects_Get_index( thread->Object.id );
ffc0fe5c: 81 23 00 08 lwz r9,8(r3)
*/
void _POSIX_Keys_Run_destructors(
Thread_Control *thread
)
{
ffc0fe60: bf 41 00 08 stmw r26,8(r1)
*
* Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99.
*/
while ( !done ) {
Objects_Maximum index = 0;
Objects_Maximum max = _POSIX_Keys_Information.maximum;
ffc0fe64: 3f c0 00 00 lis r30,0
for ( index = 1 ; index <= max ; ++index ) {
POSIX_Keys_Control *key = (POSIX_Keys_Control *)
_POSIX_Keys_Information.local_table [ index ];
if ( key != NULL && key->destructor != NULL ) {
void *value = key->Values [ thread_api ][ thread_index ];
ffc0fe68: 55 3d 13 ba rlwinm r29,r9,2,14,29
ffc0fe6c: 55 29 56 fa rlwinm r9,r9,10,27,29
ffc0fe70: 3b 89 00 10 addi r28,r9,16
if ( value != NULL ) {
key->Values [ thread_api ][ thread_index ] = NULL;
ffc0fe74: 3b 60 00 00 li r27,0
*
* Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99.
*/
while ( !done ) {
Objects_Maximum index = 0;
Objects_Maximum max = _POSIX_Keys_Information.maximum;
ffc0fe78: 39 3e 30 58 addi r9,r30,12376
ffc0fe7c: a3 49 00 10 lhz r26,16(r9)
done = true;
for ( index = 1 ; index <= max ; ++index ) {
ffc0fe80: 3b e0 00 01 li r31,1
*/
while ( !done ) {
Objects_Maximum index = 0;
Objects_Maximum max = _POSIX_Keys_Information.maximum;
done = true;
ffc0fe84: 39 40 00 01 li r10,1
for ( index = 1 ; index <= max ; ++index ) {
ffc0fe88: 48 00 00 58 b ffc0fee0 <_POSIX_Keys_Run_destructors+0x90>
POSIX_Keys_Control *key = (POSIX_Keys_Control *)
_POSIX_Keys_Information.local_table [ index ];
ffc0fe8c: 39 3e 30 58 addi r9,r30,12376
Objects_Maximum max = _POSIX_Keys_Information.maximum;
done = true;
for ( index = 1 ; index <= max ; ++index ) {
POSIX_Keys_Control *key = (POSIX_Keys_Control *)
ffc0fe90: 81 09 00 1c lwz r8,28(r9)
ffc0fe94: 57 e9 10 3a rlwinm r9,r31,2,0,29
ffc0fe98: 7d 28 48 2e lwzx r9,r8,r9
_POSIX_Keys_Information.local_table [ index ];
if ( key != NULL && key->destructor != NULL ) {
ffc0fe9c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0fea0: 41 9e 00 38 beq- cr7,ffc0fed8 <_POSIX_Keys_Run_destructors+0x88>
ffc0fea4: 81 09 00 10 lwz r8,16(r9)
ffc0fea8: 2f 88 00 00 cmpwi cr7,r8,0
ffc0feac: 41 9e 00 2c beq- cr7,ffc0fed8 <_POSIX_Keys_Run_destructors+0x88>
void *value = key->Values [ thread_api ][ thread_index ];
ffc0feb0: 7d 09 e2 14 add r8,r9,r28
ffc0feb4: 81 08 00 04 lwz r8,4(r8)
ffc0feb8: 7c 68 e8 2e lwzx r3,r8,r29
if ( value != NULL ) {
ffc0febc: 2f 83 00 00 cmpwi cr7,r3,0
ffc0fec0: 41 9e 00 18 beq- cr7,ffc0fed8 <_POSIX_Keys_Run_destructors+0x88><== ALWAYS TAKEN
key->Values [ thread_api ][ thread_index ] = NULL;
ffc0fec4: 7f 68 e9 2e stwx r27,r8,r29 <== NOT EXECUTED
(*key->destructor)( value );
ffc0fec8: 81 29 00 10 lwz r9,16(r9) <== NOT EXECUTED
ffc0fecc: 7d 29 03 a6 mtctr r9 <== NOT EXECUTED
ffc0fed0: 4e 80 04 21 bctrl <== NOT EXECUTED
done = false;
ffc0fed4: 39 40 00 00 li r10,0 <== NOT EXECUTED
Objects_Maximum index = 0;
Objects_Maximum max = _POSIX_Keys_Information.maximum;
done = true;
for ( index = 1 ; index <= max ; ++index ) {
ffc0fed8: 3b ff 00 01 addi r31,r31,1
ffc0fedc: 57 ff 04 3e clrlwi r31,r31,16
ffc0fee0: 7f 9f d0 40 cmplw cr7,r31,r26
ffc0fee4: 40 bd ff a8 ble- cr7,ffc0fe8c <_POSIX_Keys_Run_destructors+0x3c>
* number of iterations. An infinite loop may happen if destructors set
* thread specific data. This can be considered dubious.
*
* Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99.
*/
while ( !done ) {
ffc0fee8: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0feec: 41 9e ff 8c beq+ cr7,ffc0fe78 <_POSIX_Keys_Run_destructors+0x28><== NEVER TAKEN
done = false;
}
}
}
}
}
ffc0fef0: 39 61 00 20 addi r11,r1,32
ffc0fef4: 4b ff 06 bc b ffc005b0 <_restgpr_26_x>
ffc0d5f0 <_POSIX_Message_queue_Receive_support>:
size_t msg_len,
unsigned int *msg_prio,
bool wait,
Watchdog_Interval timeout
)
{
ffc0d5f0: 94 21 ff c8 stwu r1,-56(r1)
ffc0d5f4: 7c 08 02 a6 mflr r0
ffc0d5f8: bf 61 00 24 stmw r27,36(r1)
ffc0d5fc: 7c 7e 1b 78 mr r30,r3
RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd (
mqd_t id,
Objects_Locations *location
)
{
return (POSIX_Message_queue_Control_fd *) _Objects_Get(
ffc0d600: 3c 60 00 00 lis r3,0
ffc0d604: 7c 9d 23 78 mr r29,r4
ffc0d608: 91 01 00 18 stw r8,24(r1)
ffc0d60c: 7c bc 2b 78 mr r28,r5
ffc0d610: 38 63 36 4c addi r3,r3,13900
ffc0d614: 90 01 00 3c stw r0,60(r1)
ffc0d618: 7f c4 f3 78 mr r4,r30
ffc0d61c: 38 a1 00 0c addi r5,r1,12
ffc0d620: 7c df 33 78 mr r31,r6
ffc0d624: 7c fb 3b 78 mr r27,r7
ffc0d628: 48 00 34 dd bl ffc10b04 <_Objects_Get>
Objects_Locations location;
size_t length_out;
bool do_wait;
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
ffc0d62c: 81 21 00 0c lwz r9,12(r1)
ffc0d630: 81 01 00 18 lwz r8,24(r1)
ffc0d634: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d638: 40 9e 00 d0 bne- cr7,ffc0d708 <_POSIX_Message_queue_Receive_support+0x118>
case OBJECTS_LOCAL:
if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) {
ffc0d63c: 81 43 00 14 lwz r10,20(r3)
ffc0d640: 55 49 07 be clrlwi r9,r10,30
ffc0d644: 2f 89 00 01 cmpwi cr7,r9,1
ffc0d648: 40 be 00 0c bne+ cr7,ffc0d654 <_POSIX_Message_queue_Receive_support+0x64>
_Thread_Enable_dispatch();
ffc0d64c: 48 00 43 ad bl ffc119f8 <_Thread_Enable_dispatch>
ffc0d650: 48 00 00 b8 b ffc0d708 <_POSIX_Message_queue_Receive_support+0x118>
rtems_set_errno_and_return_minus_one( EBADF );
}
the_mq = the_mq_fd->Queue;
ffc0d654: 80 63 00 10 lwz r3,16(r3)
if ( msg_len < the_mq->Message_queue.maximum_message_size ) {
ffc0d658: 81 23 00 68 lwz r9,104(r3)
ffc0d65c: 7f 9c 48 40 cmplw cr7,r28,r9
ffc0d660: 40 bc 00 14 bge+ cr7,ffc0d674 <_POSIX_Message_queue_Receive_support+0x84>
_Thread_Enable_dispatch();
ffc0d664: 48 00 43 95 bl ffc119f8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EMSGSIZE );
ffc0d668: 48 00 9d 71 bl ffc173d8 <__errno>
ffc0d66c: 39 20 00 7a li r9,122
ffc0d670: 48 00 00 a0 b ffc0d710 <_POSIX_Message_queue_Receive_support+0x120>
length_out = -1;
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
ffc0d674: 2f 9b 00 00 cmpwi cr7,r27,0
/*
* Now if something goes wrong, we return a "length" of -1
* to indicate an error.
*/
length_out = -1;
ffc0d678: 39 20 ff ff li r9,-1
ffc0d67c: 91 21 00 08 stw r9,8(r1)
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
ffc0d680: 38 e0 00 00 li r7,0
ffc0d684: 41 9e 00 0c beq- cr7,ffc0d690 <_POSIX_Message_queue_Receive_support+0xa0>
do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true;
ffc0d688: 69 49 40 00 xori r9,r10,16384
ffc0d68c: 55 27 97 fe rlwinm r7,r9,18,31,31
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
ffc0d690: 38 63 00 1c addi r3,r3,28
ffc0d694: 7f c4 f3 78 mr r4,r30
ffc0d698: 7f a5 eb 78 mr r5,r29
ffc0d69c: 38 c1 00 08 addi r6,r1,8
ffc0d6a0: 48 00 22 e5 bl ffc0f984 <_CORE_message_queue_Seize>
&length_out,
do_wait,
timeout
);
_Thread_Enable_dispatch();
ffc0d6a4: 48 00 43 55 bl ffc119f8 <_Thread_Enable_dispatch>
if (msg_prio) {
ffc0d6a8: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0d6ac: 41 9e 00 20 beq- cr7,ffc0d6cc <_POSIX_Message_queue_Receive_support+0xdc><== NEVER TAKEN
*msg_prio = _POSIX_Message_queue_Priority_from_core(
_Thread_Executing->Wait.count
ffc0d6b0: 3d 20 00 00 lis r9,0
ffc0d6b4: 81 29 36 f0 lwz r9,14064(r9)
RTEMS_INLINE_ROUTINE unsigned int _POSIX_Message_queue_Priority_from_core(
CORE_message_queue_Submit_types priority
)
{
/* absolute value without a library dependency */
return (unsigned int) ((priority >= 0) ? priority : -priority);
ffc0d6b8: 81 29 00 24 lwz r9,36(r9)
ffc0d6bc: 7d 2a fe 70 srawi r10,r9,31
ffc0d6c0: 7d 49 4a 78 xor r9,r10,r9
ffc0d6c4: 7d 2a 48 50 subf r9,r10,r9
timeout
);
_Thread_Enable_dispatch();
if (msg_prio) {
*msg_prio = _POSIX_Message_queue_Priority_from_core(
ffc0d6c8: 91 3f 00 00 stw r9,0(r31)
_Thread_Executing->Wait.count
);
}
if ( !_Thread_Executing->Wait.return_code )
ffc0d6cc: 3f e0 00 00 lis r31,0
ffc0d6d0: 3b ff 36 e0 addi r31,r31,14048
ffc0d6d4: 81 3f 00 10 lwz r9,16(r31)
ffc0d6d8: 81 29 00 34 lwz r9,52(r9)
ffc0d6dc: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d6e0: 40 9e 00 0c bne- cr7,ffc0d6ec <_POSIX_Message_queue_Receive_support+0xfc>
return length_out;
ffc0d6e4: 80 61 00 08 lwz r3,8(r1)
ffc0d6e8: 48 00 00 30 b ffc0d718 <_POSIX_Message_queue_Receive_support+0x128>
rtems_set_errno_and_return_minus_one(
ffc0d6ec: 48 00 9c ed bl ffc173d8 <__errno>
ffc0d6f0: 81 3f 00 10 lwz r9,16(r31)
ffc0d6f4: 7c 7e 1b 78 mr r30,r3
ffc0d6f8: 80 69 00 34 lwz r3,52(r9)
ffc0d6fc: 48 00 02 85 bl ffc0d980 <_POSIX_Message_queue_Translate_core_message_queue_return_code>
ffc0d700: 90 7e 00 00 stw r3,0(r30)
ffc0d704: 48 00 00 10 b ffc0d714 <_POSIX_Message_queue_Receive_support+0x124>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EBADF );
ffc0d708: 48 00 9c d1 bl ffc173d8 <__errno>
ffc0d70c: 39 20 00 09 li r9,9
ffc0d710: 91 23 00 00 stw r9,0(r3)
ffc0d714: 38 60 ff ff li r3,-1
}
ffc0d718: 39 61 00 38 addi r11,r1,56
ffc0d71c: 4b ff 81 80 b ffc0589c <_restgpr_27_x>
ffc0fd18 <_POSIX_Semaphore_Create_support>:
POSIX_Semaphore_Control *the_semaphore;
CORE_semaphore_Attributes *the_sem_attr;
char *name;
/* Sharing semaphores among processes is not currently supported */
if (pshared != 0)
ffc0fd18: 2f 85 00 00 cmpwi cr7,r5,0
size_t name_len,
int pshared,
unsigned int value,
POSIX_Semaphore_Control **the_sem
)
{
ffc0fd1c: 94 21 ff d8 stwu r1,-40(r1)
ffc0fd20: 7c 08 02 a6 mflr r0
ffc0fd24: bf 61 00 14 stmw r27,20(r1)
ffc0fd28: 90 01 00 2c stw r0,44(r1)
POSIX_Semaphore_Control *the_semaphore;
CORE_semaphore_Attributes *the_sem_attr;
char *name;
/* Sharing semaphores among processes is not currently supported */
if (pshared != 0)
ffc0fd2c: 41 be 00 10 beq+ cr7,ffc0fd3c <_POSIX_Semaphore_Create_support+0x24>
rtems_set_errno_and_return_minus_one( ENOSYS );
ffc0fd30: 48 00 27 e5 bl ffc12514 <__errno>
ffc0fd34: 39 20 00 58 li r9,88
ffc0fd38: 48 00 00 4c b ffc0fd84 <_POSIX_Semaphore_Create_support+0x6c>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0fd3c: 3d 20 00 00 lis r9,0
ffc0fd40: 81 49 28 a8 lwz r10,10408(r9)
ffc0fd44: 7c 7e 1b 78 mr r30,r3
ffc0fd48: 7c db 33 78 mr r27,r6
++level;
ffc0fd4c: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc0fd50: 91 49 28 a8 stw r10,10408(r9)
ffc0fd54: 7c fc 3b 78 mr r28,r7
* _POSIX_Semaphore_Allocate
*/
RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Allocate( void )
{
return (POSIX_Semaphore_Control *)
ffc0fd58: 3f a0 00 00 lis r29,0
ffc0fd5c: 90 81 00 08 stw r4,8(r1)
ffc0fd60: 3b bd 59 00 addi r29,r29,22784
ffc0fd64: 7f a3 eb 78 mr r3,r29
ffc0fd68: 4b ff bd 25 bl ffc0ba8c <_Objects_Allocate>
_Thread_Disable_dispatch();
the_semaphore = _POSIX_Semaphore_Allocate();
if ( !the_semaphore ) {
ffc0fd6c: 80 81 00 08 lwz r4,8(r1)
ffc0fd70: 7c 7f 1b 79 mr. r31,r3
ffc0fd74: 40 a2 00 1c bne+ ffc0fd90 <_POSIX_Semaphore_Create_support+0x78>
_Thread_Enable_dispatch();
ffc0fd78: 4b ff d1 51 bl ffc0cec8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( ENOSPC );
ffc0fd7c: 48 00 27 99 bl ffc12514 <__errno>
ffc0fd80: 39 20 00 1c li r9,28
ffc0fd84: 91 23 00 00 stw r9,0(r3)
ffc0fd88: 38 60 ff ff li r3,-1
ffc0fd8c: 48 00 00 b4 b ffc0fe40 <_POSIX_Semaphore_Create_support+0x128>
/*
* Make a copy of the user's string for name just in case it was
* dynamically constructed.
*/
if ( name_arg != NULL ) {
ffc0fd90: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0fd94: 41 9e 00 30 beq- cr7,ffc0fdc4 <_POSIX_Semaphore_Create_support+0xac>
name = _Workspace_String_duplicate( name_arg, name_len );
ffc0fd98: 7f c3 f3 78 mr r3,r30
ffc0fd9c: 48 00 0f a1 bl ffc10d3c <_Workspace_String_duplicate>
if ( !name ) {
ffc0fda0: 7c 7e 1b 79 mr. r30,r3
ffc0fda4: 40 a2 00 24 bne+ ffc0fdc8 <_POSIX_Semaphore_Create_support+0xb0><== ALWAYS TAKEN
RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Free (
POSIX_Semaphore_Control *the_semaphore
)
{
_Objects_Free( &_POSIX_Semaphore_Information, &the_semaphore->Object );
ffc0fda8: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc0fdac: 7f e4 fb 78 mr r4,r31 <== NOT EXECUTED
ffc0fdb0: 4b ff c0 45 bl ffc0bdf4 <_Objects_Free> <== NOT EXECUTED
_POSIX_Semaphore_Free( the_semaphore );
_Thread_Enable_dispatch();
ffc0fdb4: 4b ff d1 15 bl ffc0cec8 <_Thread_Enable_dispatch> <== NOT EXECUTED
rtems_set_errno_and_return_minus_one( ENOMEM );
ffc0fdb8: 48 00 27 5d bl ffc12514 <__errno> <== NOT EXECUTED
ffc0fdbc: 39 20 00 0c li r9,12 <== NOT EXECUTED
ffc0fdc0: 4b ff ff c4 b ffc0fd84 <_POSIX_Semaphore_Create_support+0x6c><== NOT EXECUTED
}
} else {
name = NULL;
ffc0fdc4: 3b c0 00 00 li r30,0
}
the_semaphore->process_shared = pshared;
if ( name ) {
ffc0fdc8: 2f 9e 00 00 cmpwi cr7,r30,0
}
} else {
name = NULL;
}
the_semaphore->process_shared = pshared;
ffc0fdcc: 39 20 00 00 li r9,0
ffc0fdd0: 91 3f 00 10 stw r9,16(r31)
if ( name ) {
ffc0fdd4: 41 9e 00 1c beq- cr7,ffc0fdf0 <_POSIX_Semaphore_Create_support+0xd8>
the_semaphore->named = true;
ffc0fdd8: 39 20 00 01 li r9,1
ffc0fddc: 99 3f 00 14 stb r9,20(r31)
the_semaphore->open_count = 1;
ffc0fde0: 39 20 00 01 li r9,1
ffc0fde4: 91 3f 00 18 stw r9,24(r31)
the_semaphore->linked = true;
ffc0fde8: 99 3f 00 15 stb r9,21(r31)
ffc0fdec: 48 00 00 10 b ffc0fdfc <_POSIX_Semaphore_Create_support+0xe4>
} else {
the_semaphore->named = false;
ffc0fdf0: 9b df 00 14 stb r30,20(r31)
the_semaphore->open_count = 0;
ffc0fdf4: 93 df 00 18 stw r30,24(r31)
the_semaphore->linked = false;
ffc0fdf8: 9b df 00 15 stb r30,21(r31)
* blocking tasks on this semaphore should be. It could somehow
* be derived from the current scheduling policy. One
* thing is certain, no matter what we decide, it won't be
* the same as all other POSIX implementations. :)
*/
the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;
ffc0fdfc: 39 20 00 00 li r9,0
ffc0fe00: 91 3f 00 60 stw r9,96(r31)
/*
* This effectively disables limit checking.
*/
the_sem_attr->maximum_count = 0xFFFFFFFF;
ffc0fe04: 39 20 ff ff li r9,-1
_CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value );
ffc0fe08: 38 7f 00 1c addi r3,r31,28
the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;
/*
* This effectively disables limit checking.
*/
the_sem_attr->maximum_count = 0xFFFFFFFF;
ffc0fe0c: 91 3f 00 5c stw r9,92(r31)
_CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value );
ffc0fe10: 38 9f 00 5c addi r4,r31,92
ffc0fe14: 7f 65 db 78 mr r5,r27
ffc0fe18: 4b ff b6 35 bl ffc0b44c <_CORE_semaphore_Initialize>
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
_Objects_Set_local_object(
ffc0fe1c: a1 3f 00 0a lhz r9,10(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc0fe20: 3d 40 00 00 lis r10,0
ffc0fe24: 81 4a 59 1c lwz r10,22812(r10)
ffc0fe28: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0fe2c: 7f ea 49 2e stwx r31,r10,r9
the_object
);
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
/* ASSERT: information->is_string */
the_object->name.name_p = name;
ffc0fe30: 93 df 00 0c stw r30,12(r31)
&_POSIX_Semaphore_Information,
&the_semaphore->Object,
name
);
*the_sem = the_semaphore;
ffc0fe34: 93 fc 00 00 stw r31,0(r28)
_Thread_Enable_dispatch();
ffc0fe38: 4b ff d0 91 bl ffc0cec8 <_Thread_Enable_dispatch>
return 0;
ffc0fe3c: 38 60 00 00 li r3,0
}
ffc0fe40: 39 61 00 28 addi r11,r1,40
ffc0fe44: 48 00 cf 60 b ffc1cda4 <_restgpr_27_x>
ffc0d3e8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>:
Thread_Control *the_thread
)
{
POSIX_API_Control *thread_support;
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0d3e8: 81 23 01 50 lwz r9,336(r3)
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
ffc0d3ec: 81 49 00 d8 lwz r10,216(r9)
ffc0d3f0: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0d3f4: 40 9e 00 34 bne- cr7,ffc0d428 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x40><== NEVER TAKEN
ffc0d3f8: 81 49 00 dc lwz r10,220(r9)
ffc0d3fc: 2f 8a 00 01 cmpwi cr7,r10,1
ffc0d400: 40 be 00 28 bne+ cr7,ffc0d428 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x40>
thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS &&
ffc0d404: 81 29 00 e0 lwz r9,224(r9)
ffc0d408: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d40c: 41 be 00 1c beq+ cr7,ffc0d428 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x40>
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0d410: 3d 20 00 00 lis r9,0
ffc0d414: 81 49 28 70 lwz r10,10352(r9)
thread_support->cancelation_requested ) {
_Thread_Unnest_dispatch();
_POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED );
ffc0d418: 38 80 ff ff li r4,-1
--level;
ffc0d41c: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc0d420: 91 49 28 70 stw r10,10352(r9)
ffc0d424: 48 00 06 94 b ffc0dab8 <_POSIX_Thread_Exit>
} else
_Thread_Enable_dispatch();
ffc0d428: 4b ff db 3c b ffc0af64 <_Thread_Enable_dispatch>
ffc0e7e4 <_POSIX_Thread_Translate_sched_param>:
int policy,
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
ffc0e7e4: 94 21 ff e8 stwu r1,-24(r1)
ffc0e7e8: 7c 08 02 a6 mflr r0
ffc0e7ec: bf 81 00 08 stmw r28,8(r1)
ffc0e7f0: 7c 7e 1b 78 mr r30,r3
ffc0e7f4: 7c 9f 23 78 mr r31,r4
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
ffc0e7f8: 80 64 00 00 lwz r3,0(r4)
int policy,
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
ffc0e7fc: 7c bd 2b 78 mr r29,r5
ffc0e800: 90 01 00 1c stw r0,28(r1)
ffc0e804: 7c dc 33 78 mr r28,r6
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
ffc0e808: 4b ff ff b5 bl ffc0e7bc <_POSIX_Priority_Is_valid>
ffc0e80c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e810: 40 9e 00 0c bne- cr7,ffc0e81c <_POSIX_Thread_Translate_sched_param+0x38><== ALWAYS TAKEN
return EINVAL;
ffc0e814: 38 60 00 16 li r3,22
ffc0e818: 48 00 00 b8 b ffc0e8d0 <_POSIX_Thread_Translate_sched_param+0xec>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
*budget_callout = NULL;
if ( policy == SCHED_OTHER ) {
ffc0e81c: 2f 9e 00 00 cmpwi cr7,r30,0
)
{
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
ffc0e820: 39 20 00 00 li r9,0
ffc0e824: 91 3d 00 00 stw r9,0(r29)
*budget_callout = NULL;
ffc0e828: 91 3c 00 00 stw r9,0(r28)
if ( policy == SCHED_OTHER ) {
ffc0e82c: 40 be 00 10 bne+ cr7,ffc0e83c <_POSIX_Thread_Translate_sched_param+0x58>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
ffc0e830: 39 20 00 01 li r9,1
ffc0e834: 91 3d 00 00 stw r9,0(r29)
ffc0e838: 48 00 00 94 b ffc0e8cc <_POSIX_Thread_Translate_sched_param+0xe8>
return 0;
}
if ( policy == SCHED_FIFO ) {
ffc0e83c: 2f 9e 00 01 cmpwi cr7,r30,1
ffc0e840: 41 9e 00 8c beq- cr7,ffc0e8cc <_POSIX_Thread_Translate_sched_param+0xe8>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
return 0;
}
if ( policy == SCHED_RR ) {
ffc0e844: 2f 9e 00 02 cmpwi cr7,r30,2
ffc0e848: 40 be 00 0c bne+ cr7,ffc0e854 <_POSIX_Thread_Translate_sched_param+0x70>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE;
ffc0e84c: 93 dd 00 00 stw r30,0(r29)
ffc0e850: 48 00 00 7c b ffc0e8cc <_POSIX_Thread_Translate_sched_param+0xe8>
return 0;
}
if ( policy == SCHED_SPORADIC ) {
ffc0e854: 2f 9e 00 04 cmpwi cr7,r30,4
ffc0e858: 40 9e ff bc bne+ cr7,ffc0e814 <_POSIX_Thread_Translate_sched_param+0x30>
if ( (param->sched_ss_repl_period.tv_sec == 0) &&
ffc0e85c: 81 3f 00 08 lwz r9,8(r31)
ffc0e860: 2f 89 00 00 cmpwi cr7,r9,0
ffc0e864: 40 9e 00 10 bne- cr7,ffc0e874 <_POSIX_Thread_Translate_sched_param+0x90>
ffc0e868: 81 3f 00 0c lwz r9,12(r31)
ffc0e86c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0e870: 41 9e ff a4 beq+ cr7,ffc0e814 <_POSIX_Thread_Translate_sched_param+0x30>
(param->sched_ss_repl_period.tv_nsec == 0) )
return EINVAL;
if ( (param->sched_ss_init_budget.tv_sec == 0) &&
ffc0e874: 81 3f 00 10 lwz r9,16(r31)
ffc0e878: 2f 89 00 00 cmpwi cr7,r9,0
ffc0e87c: 40 9e 00 10 bne- cr7,ffc0e88c <_POSIX_Thread_Translate_sched_param+0xa8>
ffc0e880: 81 3f 00 14 lwz r9,20(r31)
ffc0e884: 2f 89 00 00 cmpwi cr7,r9,0
ffc0e888: 41 9e ff 8c beq+ cr7,ffc0e814 <_POSIX_Thread_Translate_sched_param+0x30>
(param->sched_ss_init_budget.tv_nsec == 0) )
return EINVAL;
if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) <
ffc0e88c: 38 7f 00 08 addi r3,r31,8
ffc0e890: 4b ff e0 a1 bl ffc0c930 <_Timespec_To_ticks>
ffc0e894: 7c 7e 1b 78 mr r30,r3
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
ffc0e898: 38 7f 00 10 addi r3,r31,16
ffc0e89c: 4b ff e0 95 bl ffc0c930 <_Timespec_To_ticks>
if ( (param->sched_ss_init_budget.tv_sec == 0) &&
(param->sched_ss_init_budget.tv_nsec == 0) )
return EINVAL;
if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) <
ffc0e8a0: 7f 9e 18 40 cmplw cr7,r30,r3
ffc0e8a4: 41 9c ff 70 blt+ cr7,ffc0e814 <_POSIX_Thread_Translate_sched_param+0x30>
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
return EINVAL;
if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) )
ffc0e8a8: 80 7f 00 04 lwz r3,4(r31)
ffc0e8ac: 4b ff ff 11 bl ffc0e7bc <_POSIX_Priority_Is_valid>
ffc0e8b0: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e8b4: 41 9e ff 60 beq+ cr7,ffc0e814 <_POSIX_Thread_Translate_sched_param+0x30>
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
ffc0e8b8: 39 20 00 03 li r9,3
ffc0e8bc: 91 3d 00 00 stw r9,0(r29)
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
ffc0e8c0: 3d 20 ff c1 lis r9,-63
ffc0e8c4: 39 29 8a dc addi r9,r9,-29988
ffc0e8c8: 91 3c 00 00 stw r9,0(r28)
return 0;
}
if ( policy == SCHED_FIFO ) {
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
return 0;
ffc0e8cc: 38 60 00 00 li r3,0
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
return 0;
}
return EINVAL;
}
ffc0e8d0: 39 61 00 18 addi r11,r1,24
ffc0e8d4: 4b ff 22 d0 b ffc00ba4 <_restgpr_28_x>
ffc0db30 <_POSIX_Threads_Delete_extension>:
*/
static void _POSIX_Threads_Delete_extension(
Thread_Control *executing __attribute__((unused)),
Thread_Control *deleted
)
{
ffc0db30: 94 21 ff e8 stwu r1,-24(r1)
ffc0db34: 7c 08 02 a6 mflr r0
api = deleted->API_Extensions[ THREAD_API_POSIX ];
/*
* Run the POSIX cancellation handlers
*/
_POSIX_Threads_cancel_run( deleted );
ffc0db38: 7c 83 23 78 mr r3,r4
*/
static void _POSIX_Threads_Delete_extension(
Thread_Control *executing __attribute__((unused)),
Thread_Control *deleted
)
{
ffc0db3c: bf 81 00 08 stmw r28,8(r1)
ffc0db40: 7c 9f 23 78 mr r31,r4
Thread_Control *the_thread;
POSIX_API_Control *api;
void **value_ptr;
api = deleted->API_Extensions[ THREAD_API_POSIX ];
ffc0db44: 83 c4 01 50 lwz r30,336(r4)
*/
static void _POSIX_Threads_Delete_extension(
Thread_Control *executing __attribute__((unused)),
Thread_Control *deleted
)
{
ffc0db48: 90 01 00 1c stw r0,28(r1)
api = deleted->API_Extensions[ THREAD_API_POSIX ];
/*
* Run the POSIX cancellation handlers
*/
_POSIX_Threads_cancel_run( deleted );
ffc0db4c: 48 00 22 8d bl ffc0fdd8 <_POSIX_Threads_cancel_run>
/*
* Run all the key destructors
*/
_POSIX_Keys_Run_destructors( deleted );
ffc0db50: 7f e3 fb 78 mr r3,r31
ffc0db54: 48 00 22 fd bl ffc0fe50 <_POSIX_Keys_Run_destructors>
/*
* Wakeup all the tasks which joined with this one
*/
value_ptr = (void **) deleted->Wait.return_argument;
while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) )
ffc0db58: 3b be 00 44 addi r29,r30,68
_POSIX_Keys_Run_destructors( deleted );
/*
* Wakeup all the tasks which joined with this one
*/
value_ptr = (void **) deleted->Wait.return_argument;
ffc0db5c: 83 9f 00 28 lwz r28,40(r31)
while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) )
ffc0db60: 48 00 00 0c b ffc0db6c <_POSIX_Threads_Delete_extension+0x3c>
*(void **)the_thread->Wait.return_argument = value_ptr;
ffc0db64: 81 23 00 28 lwz r9,40(r3) <== NOT EXECUTED
ffc0db68: 93 89 00 00 stw r28,0(r9) <== NOT EXECUTED
/*
* Wakeup all the tasks which joined with this one
*/
value_ptr = (void **) deleted->Wait.return_argument;
while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) )
ffc0db6c: 7f a3 eb 78 mr r3,r29
ffc0db70: 4b ff da 71 bl ffc0b5e0 <_Thread_queue_Dequeue>
ffc0db74: 2c 03 00 00 cmpwi r3,0
ffc0db78: 40 82 ff ec bne+ ffc0db64 <_POSIX_Threads_Delete_extension+0x34><== NEVER TAKEN
*(void **)the_thread->Wait.return_argument = value_ptr;
if ( api->schedpolicy == SCHED_SPORADIC )
ffc0db7c: 81 3e 00 84 lwz r9,132(r30)
ffc0db80: 2f 89 00 04 cmpwi cr7,r9,4
ffc0db84: 40 be 00 0c bne+ cr7,ffc0db90 <_POSIX_Threads_Delete_extension+0x60>
(void) _Watchdog_Remove( &api->Sporadic_timer );
ffc0db88: 38 7e 00 a8 addi r3,r30,168
ffc0db8c: 4b ff e5 65 bl ffc0c0f0 <_Watchdog_Remove>
deleted->API_Extensions[ THREAD_API_POSIX ] = NULL;
_Workspace_Free( api );
}
ffc0db90: 80 01 00 1c lwz r0,28(r1)
*(void **)the_thread->Wait.return_argument = value_ptr;
if ( api->schedpolicy == SCHED_SPORADIC )
(void) _Watchdog_Remove( &api->Sporadic_timer );
deleted->API_Extensions[ THREAD_API_POSIX ] = NULL;
ffc0db94: 39 20 00 00 li r9,0
ffc0db98: 91 3f 01 50 stw r9,336(r31)
_Workspace_Free( api );
ffc0db9c: 7f c3 f3 78 mr r3,r30
}
ffc0dba0: 7c 08 03 a6 mtlr r0
ffc0dba4: bb 81 00 08 lmw r28,8(r1)
ffc0dba8: 38 21 00 18 addi r1,r1,24
if ( api->schedpolicy == SCHED_SPORADIC )
(void) _Watchdog_Remove( &api->Sporadic_timer );
deleted->API_Extensions[ THREAD_API_POSIX ] = NULL;
_Workspace_Free( api );
ffc0dbac: 4b ff e7 e4 b ffc0c390 <_Workspace_Free>
ffc08808 <_POSIX_Threads_Initialize_user_threads_body>:
#include <rtems/posix/config.h>
#include <rtems/posix/key.h>
#include <rtems/posix/time.h>
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc08808: 94 21 ff 98 stwu r1,-104(r1)
ffc0880c: 7c 08 02 a6 mflr r0
uint32_t maximum;
posix_initialization_threads_table *user_threads;
pthread_t thread_id;
pthread_attr_t attr;
user_threads = Configuration_POSIX_API.User_initialization_threads_table;
ffc08810: 3d 20 00 00 lis r9,0
#include <rtems/posix/config.h>
#include <rtems/posix/key.h>
#include <rtems/posix/time.h>
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc08814: 90 01 00 6c stw r0,108(r1)
uint32_t maximum;
posix_initialization_threads_table *user_threads;
pthread_t thread_id;
pthread_attr_t attr;
user_threads = Configuration_POSIX_API.User_initialization_threads_table;
ffc08818: 39 29 20 04 addi r9,r9,8196
#include <rtems/posix/config.h>
#include <rtems/posix/key.h>
#include <rtems/posix/time.h>
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc0881c: bf a1 00 5c stmw r29,92(r1)
uint32_t maximum;
posix_initialization_threads_table *user_threads;
pthread_t thread_id;
pthread_attr_t attr;
user_threads = Configuration_POSIX_API.User_initialization_threads_table;
ffc08820: 83 e9 00 34 lwz r31,52(r9)
maximum = Configuration_POSIX_API.number_of_initialization_threads;
ffc08824: 83 a9 00 30 lwz r29,48(r9)
if ( !user_threads || maximum == 0 )
ffc08828: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0882c: 41 9e 00 68 beq- cr7,ffc08894 <_POSIX_Threads_Initialize_user_threads_body+0x8c><== NEVER TAKEN
ffc08830: 2f 9d 00 00 cmpwi cr7,r29,0
ffc08834: 41 9e 00 60 beq- cr7,ffc08894 <_POSIX_Threads_Initialize_user_threads_body+0x8c><== NEVER TAKEN
ffc08838: 3b c0 00 00 li r30,0
for ( index=0 ; index < maximum ; index++ ) {
/*
* There is no way for these calls to fail in this situation.
*/
(void) pthread_attr_init( &attr );
ffc0883c: 38 61 00 08 addi r3,r1,8
ffc08840: 48 00 60 99 bl ffc0e8d8 <pthread_attr_init>
(void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED );
ffc08844: 38 80 00 02 li r4,2
ffc08848: 38 61 00 08 addi r3,r1,8
ffc0884c: 48 00 60 d1 bl ffc0e91c <pthread_attr_setinheritsched>
(void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size);
ffc08850: 80 9f 00 04 lwz r4,4(r31)
ffc08854: 38 61 00 08 addi r3,r1,8
ffc08858: 48 00 61 01 bl ffc0e958 <pthread_attr_setstacksize>
status = pthread_create(
ffc0885c: 80 bf 00 00 lwz r5,0(r31)
ffc08860: 38 61 00 48 addi r3,r1,72
ffc08864: 38 81 00 08 addi r4,r1,8
ffc08868: 38 c0 00 00 li r6,0
ffc0886c: 4b ff fc 5d bl ffc084c8 <pthread_create>
ffc08870: 3b ff 00 08 addi r31,r31,8
&thread_id,
&attr,
user_threads[ index ].thread_entry,
NULL
);
if ( status )
ffc08874: 7c 65 1b 79 mr. r5,r3
ffc08878: 41 a2 00 10 beq+ ffc08888 <_POSIX_Threads_Initialize_user_threads_body+0x80>
_Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status );
ffc0887c: 38 60 00 02 li r3,2
ffc08880: 38 80 00 01 li r4,1
ffc08884: 48 00 21 51 bl ffc0a9d4 <_Internal_error_Occurred>
*
* Setting the attributes explicitly is critical, since we don't want
* to inherit the idle tasks attributes.
*/
for ( index=0 ; index < maximum ; index++ ) {
ffc08888: 3b de 00 01 addi r30,r30,1
ffc0888c: 7f 9e e8 00 cmpw cr7,r30,r29
ffc08890: 40 9e ff ac bne+ cr7,ffc0883c <_POSIX_Threads_Initialize_user_threads_body+0x34><== NEVER TAKEN
NULL
);
if ( status )
_Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status );
}
}
ffc08894: 39 61 00 68 addi r11,r1,104
ffc08898: 4b ff 83 10 b ffc00ba8 <_restgpr_29_x>
ffc0dcb8 <_POSIX_Threads_Sporadic_budget_TSR>:
*/
void _POSIX_Threads_Sporadic_budget_TSR(
Objects_Id id __attribute__((unused)),
void *argument
)
{
ffc0dcb8: 94 21 ff f0 stwu r1,-16(r1)
ffc0dcbc: 7c 08 02 a6 mflr r0
ffc0dcc0: 90 01 00 14 stw r0,20(r1)
ffc0dcc4: bf c1 00 08 stmw r30,8(r1)
ffc0dcc8: 7c 9f 23 78 mr r31,r4
Thread_Control *the_thread;
POSIX_API_Control *api;
the_thread = argument;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0dccc: 83 c4 01 50 lwz r30,336(r4)
/* ticks is guaranteed to be at least one */
ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget );
ffc0dcd0: 38 7e 00 98 addi r3,r30,152
ffc0dcd4: 48 00 0e 51 bl ffc0eb24 <_Timespec_To_ticks>
RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core(
int priority
)
{
return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1);
ffc0dcd8: 3d 20 00 00 lis r9,0
ffc0dcdc: 88 89 27 84 lbz r4,10116(r9)
ffc0dce0: 81 3e 00 88 lwz r9,136(r30)
the_thread->cpu_time_budget = ticks;
ffc0dce4: 90 7f 00 74 stw r3,116(r31)
ffc0dce8: 7c 89 20 50 subf r4,r9,r4
*/
#if 0
printk( "TSR %d %d %d\n", the_thread->resource_count,
the_thread->current_priority, new_priority );
#endif
if ( the_thread->resource_count == 0 ) {
ffc0dcec: 81 3f 00 1c lwz r9,28(r31)
ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget );
the_thread->cpu_time_budget = ticks;
new_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority );
the_thread->real_priority = new_priority;
ffc0dcf0: 90 9f 00 18 stw r4,24(r31)
*/
#if 0
printk( "TSR %d %d %d\n", the_thread->resource_count,
the_thread->current_priority, new_priority );
#endif
if ( the_thread->resource_count == 0 ) {
ffc0dcf4: 2f 89 00 00 cmpwi cr7,r9,0
ffc0dcf8: 40 9e 00 1c bne- cr7,ffc0dd14 <_POSIX_Threads_Sporadic_budget_TSR+0x5c><== NEVER TAKEN
/*
* If this would make them less important, then do not change it.
*/
if ( the_thread->current_priority > new_priority ) {
ffc0dcfc: 81 3f 00 14 lwz r9,20(r31)
ffc0dd00: 7f 89 20 40 cmplw cr7,r9,r4
ffc0dd04: 40 bd 00 10 ble+ cr7,ffc0dd14 <_POSIX_Threads_Sporadic_budget_TSR+0x5c>
_Thread_Change_priority( the_thread, new_priority, true );
ffc0dd08: 7f e3 fb 78 mr r3,r31
ffc0dd0c: 38 a0 00 01 li r5,1
ffc0dd10: 4b ff cf d5 bl ffc0ace4 <_Thread_Change_priority>
#endif
}
}
/* ticks is guaranteed to be at least one */
ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period );
ffc0dd14: 38 7e 00 90 addi r3,r30,144
ffc0dd18: 48 00 0e 0d bl ffc0eb24 <_Timespec_To_ticks>
_Watchdog_Insert_ticks( &api->Sporadic_timer, ticks );
}
ffc0dd1c: 80 01 00 14 lwz r0,20(r1)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc0dd20: 90 7e 00 b4 stw r3,180(r30)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc0dd24: 38 9e 00 a8 addi r4,r30,168
ffc0dd28: 7c 08 03 a6 mtlr r0
ffc0dd2c: 3c 60 00 00 lis r3,0
ffc0dd30: bb c1 00 08 lmw r30,8(r1)
ffc0dd34: 38 63 2d a8 addi r3,r3,11688
ffc0dd38: 38 21 00 10 addi r1,r1,16
ffc0dd3c: 4b ff e2 58 b ffc0bf94 <_Watchdog_Insert>
ffc085e0 <_POSIX_Timer_TSR>:
* This is the operation that is run when a timer expires
*/
void _POSIX_Timer_TSR(
Objects_Id timer __attribute__((unused)),
void *data)
{
ffc085e0: 94 21 ff d8 stwu r1,-40(r1)
ffc085e4: 7c 08 02 a6 mflr r0
ffc085e8: 90 01 00 2c stw r0,44(r1)
bool activated;
ptimer = (POSIX_Timer_Control *)data;
/* Increment the number of expirations. */
ptimer->overrun = ptimer->overrun + 1;
ffc085ec: 81 24 00 68 lwz r9,104(r4)
* This is the operation that is run when a timer expires
*/
void _POSIX_Timer_TSR(
Objects_Id timer __attribute__((unused)),
void *data)
{
ffc085f0: bf a1 00 1c stmw r29,28(r1)
ffc085f4: 7c 9d 23 78 mr r29,r4
bool activated;
ptimer = (POSIX_Timer_Control *)data;
/* Increment the number of expirations. */
ptimer->overrun = ptimer->overrun + 1;
ffc085f8: 39 29 00 01 addi r9,r9,1
ffc085fc: 91 24 00 68 stw r9,104(r4)
/* The timer must be reprogrammed */
if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) ||
ffc08600: 81 24 00 54 lwz r9,84(r4)
ffc08604: 2f 89 00 00 cmpwi cr7,r9,0
ffc08608: 40 9e 00 10 bne- cr7,ffc08618 <_POSIX_Timer_TSR+0x38>
ffc0860c: 81 24 00 58 lwz r9,88(r4)
ffc08610: 2f 89 00 00 cmpwi cr7,r9,0
ffc08614: 41 9e 00 80 beq- cr7,ffc08694 <_POSIX_Timer_TSR+0xb4> <== NEVER TAKEN
( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) {
activated = _POSIX_Timer_Insert_helper(
ffc08618: 80 9d 00 64 lwz r4,100(r29)
ffc0861c: 3c c0 ff c1 lis r6,-63
ffc08620: 80 bd 00 08 lwz r5,8(r29)
ffc08624: 38 7d 00 10 addi r3,r29,16
ffc08628: 38 c6 85 e0 addi r6,r6,-31264
ffc0862c: 7f a7 eb 78 mr r7,r29
ffc08630: 48 00 5f d5 bl ffc0e604 <_POSIX_Timer_Insert_helper>
ptimer->ticks,
ptimer->Object.id,
_POSIX_Timer_TSR,
ptimer
);
if ( !activated )
ffc08634: 2f 83 00 00 cmpwi cr7,r3,0
ffc08638: 41 be 00 78 beq+ cr7,ffc086b0 <_POSIX_Timer_TSR+0xd0> <== NEVER TAKEN
)
{
Timestamp_Control tod_as_timestamp;
Timestamp_Control *tod_as_timestamp_ptr;
tod_as_timestamp_ptr =
ffc0863c: 3c 80 00 00 lis r4,0
ffc08640: 38 84 2c a0 addi r4,r4,11424
ffc08644: 38 61 00 08 addi r3,r1,8
ffc08648: 48 00 18 8d bl ffc09ed4 <_TOD_Get_with_nanoseconds>
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc0864c: 3c c0 3b 9a lis r6,15258
/* After the signal handler returns, the count of expirations of the
* timer must be set to 0.
*/
ptimer->overrun = 0;
}
ffc08650: 83 e3 00 04 lwz r31,4(r3)
ffc08654: 38 a0 00 00 li r5,0
ffc08658: 83 c3 00 00 lwz r30,0(r3)
ffc0865c: 60 c6 ca 00 ori r6,r6,51712
ffc08660: 7f e4 fb 78 mr r4,r31
ffc08664: 7f c3 f3 78 mr r3,r30
ffc08668: 48 01 24 ad bl ffc1ab14 <__divdi3>
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc0866c: 3c c0 3b 9a lis r6,15258
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc08670: 90 9d 00 6c stw r4,108(r29)
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc08674: 7f c3 f3 78 mr r3,r30
ffc08678: 7f e4 fb 78 mr r4,r31
ffc0867c: 38 a0 00 00 li r5,0
ffc08680: 60 c6 ca 00 ori r6,r6,51712
ffc08684: 48 01 28 b5 bl ffc1af38 <__moddi3>
/* Store the time when the timer was started again */
_TOD_Get( &ptimer->time );
/* The state really did not change but just to be safe */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
ffc08688: 39 20 00 03 li r9,3
ffc0868c: 90 9d 00 70 stw r4,112(r29)
ffc08690: 48 00 00 08 b ffc08698 <_POSIX_Timer_TSR+0xb8>
} else {
/* Indicates that the timer is stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
ffc08694: 39 20 00 04 li r9,4 <== NOT EXECUTED
ffc08698: 99 3d 00 3c stb r9,60(r29)
/*
* The sending of the signal to the process running the handling function
* specified for that signal is simulated
*/
if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) {
ffc0869c: 80 7d 00 38 lwz r3,56(r29)
ffc086a0: 80 9d 00 44 lwz r4,68(r29)
ffc086a4: 48 00 5a fd bl ffc0e1a0 <pthread_kill>
}
/* After the signal handler returns, the count of expirations of the
* timer must be set to 0.
*/
ptimer->overrun = 0;
ffc086a8: 39 20 00 00 li r9,0
ffc086ac: 91 3d 00 68 stw r9,104(r29)
}
ffc086b0: 39 61 00 28 addi r11,r1,40
ffc086b4: 4b ff 7f ec b ffc006a0 <_restgpr_29_x>
ffc0fef8 <_POSIX_signals_Check_signal>:
bool _POSIX_signals_Check_signal(
POSIX_API_Control *api,
int signo,
bool is_global
)
{
ffc0fef8: 94 21 ff 98 stwu r1,-104(r1)
ffc0fefc: 7c 08 02 a6 mflr r0
ffc0ff00: 7c a6 2b 78 mr r6,r5
siginfo_t siginfo_struct;
sigset_t saved_signals_blocked;
Thread_Wait_information stored_thread_wait_information;
if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct,
ffc0ff04: 38 e0 00 01 li r7,1
bool _POSIX_signals_Check_signal(
POSIX_API_Control *api,
int signo,
bool is_global
)
{
ffc0ff08: bf 21 00 4c stmw r25,76(r1)
siginfo_t siginfo_struct;
sigset_t saved_signals_blocked;
Thread_Wait_information stored_thread_wait_information;
if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct,
ffc0ff0c: 38 a1 00 30 addi r5,r1,48
bool _POSIX_signals_Check_signal(
POSIX_API_Control *api,
int signo,
bool is_global
)
{
ffc0ff10: 90 01 00 6c stw r0,108(r1)
ffc0ff14: 7c 7f 1b 78 mr r31,r3
ffc0ff18: 7c 9e 23 78 mr r30,r4
siginfo_t siginfo_struct;
sigset_t saved_signals_blocked;
Thread_Wait_information stored_thread_wait_information;
if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct,
ffc0ff1c: 48 00 00 b1 bl ffc0ffcc <_POSIX_signals_Clear_signals>
ffc0ff20: 2f 83 00 00 cmpwi cr7,r3,0
ffc0ff24: 41 9e 00 9c beq- cr7,ffc0ffc0 <_POSIX_signals_Check_signal+0xc8>
#endif
/*
* Just to prevent sending a signal which is currently being ignored.
*/
if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN )
ffc0ff28: 3f 20 00 00 lis r25,0
ffc0ff2c: 1f 5e 00 0c mulli r26,r30,12
ffc0ff30: 3b 39 32 20 addi r25,r25,12832
ffc0ff34: 7d 39 d2 14 add r9,r25,r26
ffc0ff38: 83 a9 00 08 lwz r29,8(r9)
ffc0ff3c: 2f 9d 00 01 cmpwi cr7,r29,1
ffc0ff40: 41 9e 00 80 beq- cr7,ffc0ffc0 <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN
return false;
/*
* Block the signals requested in sa_mask
*/
saved_signals_blocked = api->signals_blocked;
ffc0ff44: 83 9f 00 d0 lwz r28,208(r31)
/*
* We have to save the blocking information of the current wait queue
* because the signal handler may subsequently go on and put the thread
* on a wait queue, for its own purposes.
*/
memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait,
ffc0ff48: 3f 60 00 00 lis r27,0
/*
* Block the signals requested in sa_mask
*/
saved_signals_blocked = api->signals_blocked;
api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask;
ffc0ff4c: 81 29 00 04 lwz r9,4(r9)
/*
* We have to save the blocking information of the current wait queue
* because the signal handler may subsequently go on and put the thread
* on a wait queue, for its own purposes.
*/
memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait,
ffc0ff50: 38 61 00 08 addi r3,r1,8
ffc0ff54: 38 a0 00 28 li r5,40
/*
* Block the signals requested in sa_mask
*/
saved_signals_blocked = api->signals_blocked;
api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask;
ffc0ff58: 7d 29 e3 78 or r9,r9,r28
ffc0ff5c: 91 3f 00 d0 stw r9,208(r31)
/*
* We have to save the blocking information of the current wait queue
* because the signal handler may subsequently go on and put the thread
* on a wait queue, for its own purposes.
*/
memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait,
ffc0ff60: 39 3b 31 a0 addi r9,r27,12704
ffc0ff64: 80 89 00 10 lwz r4,16(r9)
ffc0ff68: 38 84 00 20 addi r4,r4,32
ffc0ff6c: 48 00 13 45 bl ffc112b0 <memcpy>
sizeof( Thread_Wait_information ));
/*
* Here, the signal handler function executes
*/
switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) {
ffc0ff70: 7d 39 d0 2e lwzx r9,r25,r26
case SA_SIGINFO:
(*_POSIX_signals_Vectors[ signo ].sa_sigaction)(
ffc0ff74: 7f c3 f3 78 mr r3,r30
sizeof( Thread_Wait_information ));
/*
* Here, the signal handler function executes
*/
switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) {
ffc0ff78: 2f 89 00 02 cmpwi cr7,r9,2
ffc0ff7c: 40 be 00 18 bne+ cr7,ffc0ff94 <_POSIX_signals_Check_signal+0x9c>
case SA_SIGINFO:
(*_POSIX_signals_Vectors[ signo ].sa_sigaction)(
ffc0ff80: 38 81 00 30 addi r4,r1,48
ffc0ff84: 7f a9 03 a6 mtctr r29
ffc0ff88: 38 a0 00 00 li r5,0
ffc0ff8c: 4e 80 04 21 bctrl
signo,
&siginfo_struct,
NULL /* context is undefined per 1003.1b-1993, p. 66 */
);
break;
ffc0ff90: 48 00 00 0c b ffc0ff9c <_POSIX_signals_Check_signal+0xa4>
default:
(*_POSIX_signals_Vectors[ signo ].sa_handler)( signo );
ffc0ff94: 7f a9 03 a6 mtctr r29
ffc0ff98: 4e 80 04 21 bctrl
}
/*
* Restore the blocking information
*/
memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information,
ffc0ff9c: 3b 7b 31 a0 addi r27,r27,12704
ffc0ffa0: 80 7b 00 10 lwz r3,16(r27)
ffc0ffa4: 38 81 00 08 addi r4,r1,8
ffc0ffa8: 38 a0 00 28 li r5,40
ffc0ffac: 38 63 00 20 addi r3,r3,32
ffc0ffb0: 48 00 13 01 bl ffc112b0 <memcpy>
sizeof( Thread_Wait_information ));
/*
* Restore the previous set of blocked signals
*/
api->signals_blocked = saved_signals_blocked;
ffc0ffb4: 93 9f 00 d0 stw r28,208(r31)
return true;
ffc0ffb8: 38 60 00 01 li r3,1
ffc0ffbc: 48 00 00 08 b ffc0ffc4 <_POSIX_signals_Check_signal+0xcc>
sigset_t saved_signals_blocked;
Thread_Wait_information stored_thread_wait_information;
if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct,
is_global, true ) )
return false;
ffc0ffc0: 38 60 00 00 li r3,0
* Restore the previous set of blocked signals
*/
api->signals_blocked = saved_signals_blocked;
return true;
}
ffc0ffc4: 39 61 00 68 addi r11,r1,104
ffc0ffc8: 4b ff 05 e4 b ffc005ac <_restgpr_25_x>
ffc10524 <_POSIX_signals_Clear_process_signals>:
ffc10524: 39 23 ff ff addi r9,r3,-1
ffc10528: 39 00 00 01 li r8,1
ffc1052c: 7d 08 48 30 slw r8,r8,r9
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc10530: 7c e0 00 a6 mfmsr r7
ffc10534: 7d 30 42 a6 mfsprg r9,0
ffc10538: 7c e9 48 78 andc r9,r7,r9
ffc1053c: 7d 20 01 24 mtmsr r9
mask = signo_to_mask( signo );
ISR_Level level;
_ISR_Disable( level );
if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) {
ffc10540: 3d 20 00 00 lis r9,0
ffc10544: 1c 63 00 0c mulli r3,r3,12
ffc10548: 39 29 32 20 addi r9,r9,12832
ffc1054c: 7d 29 18 2e lwzx r9,r9,r3
ffc10550: 2f 89 00 02 cmpwi cr7,r9,2
ffc10554: 40 be 00 28 bne+ cr7,ffc1057c <_POSIX_signals_Clear_process_signals+0x58>
if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) )
ffc10558: 3d 20 00 00 lis r9,0
ffc1055c: 39 29 34 14 addi r9,r9,13332
ffc10560: 7d 43 4a 14 add r10,r3,r9
ffc10564: 7d 23 48 2e lwzx r9,r3,r9
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc10568: 39 4a 00 04 addi r10,r10,4
ffc1056c: 7f 89 50 00 cmpw cr7,r9,r10
ffc10570: 41 9e 00 0c beq- cr7,ffc1057c <_POSIX_signals_Clear_process_signals+0x58><== ALWAYS TAKEN
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc10574: 7c e0 01 24 mtmsr r7
ffc10578: 4e 80 00 20 blr
clear_signal = false;
}
if ( clear_signal ) {
_POSIX_signals_Pending &= ~mask;
ffc1057c: 3d 20 00 00 lis r9,0
ffc10580: 81 49 28 98 lwz r10,10392(r9)
ffc10584: 7d 4a 40 78 andc r10,r10,r8
ffc10588: 91 49 28 98 stw r10,10392(r9)
ffc1058c: 4b ff ff e8 b ffc10574 <_POSIX_signals_Clear_process_signals+0x50>
ffc090d4 <_POSIX_signals_Get_lowest>:
ffc090d4: 38 e0 00 05 li r7,5
ffc090d8: 7c e9 03 a6 mtctr r7
sigset_t set
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc090dc: 39 20 00 1b li r9,27
ffc090e0: 39 40 00 01 li r10,1
#include <rtems/posix/psignalimpl.h>
#include <rtems/seterr.h>
#include <rtems/posix/time.h>
#include <rtems/score/isr.h>
static int _POSIX_signals_Get_lowest(
ffc090e4: 39 09 ff ff addi r8,r9,-1
ffc090e8: 7d 48 40 30 slw r8,r10,r8
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
if ( set & signo_to_mask( signo ) ) {
ffc090ec: 7d 07 18 39 and. r7,r8,r3
ffc090f0: 40 82 00 34 bne- ffc09124 <_POSIX_signals_Get_lowest+0x50><== NEVER TAKEN
sigset_t set
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc090f4: 39 29 00 01 addi r9,r9,1
ffc090f8: 42 00 ff ec bdnz+ ffc090e4 <_POSIX_signals_Get_lowest+0x10>
ffc090fc: 39 00 00 1a li r8,26
ffc09100: 7d 09 03 a6 mtctr r8
ffc09104: 39 20 00 01 li r9,1
ffc09108: 39 40 00 01 li r10,1
#include <rtems/posix/psignalimpl.h>
#include <rtems/seterr.h>
#include <rtems/posix/time.h>
#include <rtems/score/isr.h>
static int _POSIX_signals_Get_lowest(
ffc0910c: 39 09 ff ff addi r8,r9,-1
ffc09110: 7d 48 40 30 slw r8,r10,r8
#if (SIGHUP != 1)
#error "Assumption that SIGHUP==1 violated!!"
#endif
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
if ( set & signo_to_mask( signo ) ) {
ffc09114: 7d 07 18 39 and. r7,r8,r3
ffc09118: 40 82 00 0c bne- ffc09124 <_POSIX_signals_Get_lowest+0x50>
*/
#if (SIGHUP != 1)
#error "Assumption that SIGHUP==1 violated!!"
#endif
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
ffc0911c: 39 29 00 01 addi r9,r9,1
ffc09120: 42 00 ff ec bdnz+ ffc0910c <_POSIX_signals_Get_lowest+0x38>
* a return 0. This routine will NOT be called unless a signal
* is pending in the set passed in.
*/
found_it:
return signo;
}
ffc09124: 7d 23 4b 78 mr r3,r9
ffc09128: 4e 80 00 20 blr
ffc0d8e4 <_POSIX_signals_Post_switch_hook>:
*/
static void _POSIX_signals_Post_switch_hook(
Thread_Control *the_thread
)
{
ffc0d8e4: 94 21 ff e8 stwu r1,-24(r1)
ffc0d8e8: 7c 08 02 a6 mflr r0
/*
* We need to ensure that if the signal handler executes a call
* which overwrites the unblocking status, we restore it.
*/
hold_errno = _Thread_Executing->Wait.return_code;
ffc0d8ec: 3d 20 00 00 lis r9,0
*/
static void _POSIX_signals_Post_switch_hook(
Thread_Control *the_thread
)
{
ffc0d8f0: 90 01 00 1c stw r0,28(r1)
ffc0d8f4: bf 81 00 08 stmw r28,8(r1)
POSIX_API_Control *api;
int signo;
ISR_Level level;
int hold_errno;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0d8f8: 83 e3 01 50 lwz r31,336(r3)
/*
* We need to ensure that if the signal handler executes a call
* which overwrites the unblocking status, we restore it.
*/
hold_errno = _Thread_Executing->Wait.return_code;
ffc0d8fc: 81 29 31 b0 lwz r9,12720(r9)
/*
* api may be NULL in case of a thread close in progress
*/
if ( !api )
ffc0d900: 2f 9f 00 00 cmpwi cr7,r31,0
/*
* We need to ensure that if the signal handler executes a call
* which overwrites the unblocking status, we restore it.
*/
hold_errno = _Thread_Executing->Wait.return_code;
ffc0d904: 83 a9 00 34 lwz r29,52(r9)
/*
* api may be NULL in case of a thread close in progress
*/
if ( !api )
ffc0d908: 41 9e 00 a8 beq- cr7,ffc0d9b0 <_POSIX_signals_Post_switch_hook+0xcc><== NEVER TAKEN
* processed at all. No point in doing this loop otherwise.
*/
while (1) {
_ISR_Disable( level );
if ( !(~api->signals_blocked &
(api->signals_pending | _POSIX_signals_Pending)) ) {
ffc0d90c: 3f 80 00 00 lis r28,0
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0d910: 7d 20 00 a6 mfmsr r9
ffc0d914: 7d 50 42 a6 mfsprg r10,0
ffc0d918: 7d 2a 50 78 andc r10,r9,r10
ffc0d91c: 7d 40 01 24 mtmsr r10
ffc0d920: 81 5f 00 d4 lwz r10,212(r31)
ffc0d924: 81 1c 28 98 lwz r8,10392(r28)
ffc0d928: 7d 08 53 78 or r8,r8,r10
* The first thing done is to check there are any signals to be
* processed at all. No point in doing this loop otherwise.
*/
while (1) {
_ISR_Disable( level );
if ( !(~api->signals_blocked &
ffc0d92c: 81 5f 00 d0 lwz r10,208(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0d930: 7d 20 01 24 mtmsr r9
ffc0d934: 7d 07 50 79 andc. r7,r8,r10
ffc0d938: 40 a2 00 14 bne+ ffc0d94c <_POSIX_signals_Post_switch_hook+0x68>
_POSIX_signals_Check_signal( api, signo, false );
_POSIX_signals_Check_signal( api, signo, true );
}
}
_Thread_Executing->Wait.return_code = hold_errno;
ffc0d93c: 3d 20 00 00 lis r9,0
ffc0d940: 81 29 31 b0 lwz r9,12720(r9)
ffc0d944: 93 a9 00 34 stw r29,52(r9)
ffc0d948: 48 00 00 68 b ffc0d9b0 <_POSIX_signals_Post_switch_hook+0xcc>
_ISR_Enable( level );
break;
}
_ISR_Enable( level );
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc0d94c: 3b c0 00 1b li r30,27
_POSIX_signals_Check_signal( api, signo, false );
ffc0d950: 7f c4 f3 78 mr r4,r30
ffc0d954: 38 a0 00 00 li r5,0
ffc0d958: 7f e3 fb 78 mr r3,r31
ffc0d95c: 48 00 25 9d bl ffc0fef8 <_POSIX_signals_Check_signal>
_POSIX_signals_Check_signal( api, signo, true );
ffc0d960: 7f c4 f3 78 mr r4,r30
ffc0d964: 7f e3 fb 78 mr r3,r31
ffc0d968: 38 a0 00 01 li r5,1
ffc0d96c: 48 00 25 8d bl ffc0fef8 <_POSIX_signals_Check_signal>
_ISR_Enable( level );
break;
}
_ISR_Enable( level );
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc0d970: 2f 9e 00 1f cmpwi cr7,r30,31
ffc0d974: 3b de 00 01 addi r30,r30,1
ffc0d978: 40 9e ff d8 bne+ cr7,ffc0d950 <_POSIX_signals_Post_switch_hook+0x6c>
ffc0d97c: 3b c0 00 01 li r30,1
_POSIX_signals_Check_signal( api, signo, true );
}
/* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
_POSIX_signals_Check_signal( api, signo, false );
ffc0d980: 7f c4 f3 78 mr r4,r30
ffc0d984: 38 a0 00 00 li r5,0
ffc0d988: 7f e3 fb 78 mr r3,r31
ffc0d98c: 48 00 25 6d bl ffc0fef8 <_POSIX_signals_Check_signal>
_POSIX_signals_Check_signal( api, signo, true );
ffc0d990: 7f c4 f3 78 mr r4,r30
ffc0d994: 7f e3 fb 78 mr r3,r31
ffc0d998: 38 a0 00 01 li r5,1
ffc0d99c: 48 00 25 5d bl ffc0fef8 <_POSIX_signals_Check_signal>
_POSIX_signals_Check_signal( api, signo, false );
_POSIX_signals_Check_signal( api, signo, true );
}
/* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
ffc0d9a0: 2f 9e 00 1a cmpwi cr7,r30,26
ffc0d9a4: 3b de 00 01 addi r30,r30,1
ffc0d9a8: 40 9e ff d8 bne+ cr7,ffc0d980 <_POSIX_signals_Post_switch_hook+0x9c>
ffc0d9ac: 4b ff ff 64 b ffc0d910 <_POSIX_signals_Post_switch_hook+0x2c>
_POSIX_signals_Check_signal( api, signo, true );
}
}
_Thread_Executing->Wait.return_code = hold_errno;
}
ffc0d9b0: 39 61 00 18 addi r11,r1,24
ffc0d9b4: 4b ff 2c 04 b ffc005b8 <_restgpr_28_x>
ffc1b854 <_POSIX_signals_Unblock_thread>:
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc1b854: 7c 2b 0b 78 mr r11,r1
ffc1b858: 7c 08 02 a6 mflr r0
ffc1b85c: 94 21 ff f0 stwu r1,-16(r1)
ffc1b860: 7c aa 2b 78 mr r10,r5
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc1b864: 3c a0 10 00 lis r5,4096
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc1b868: 90 01 00 14 stw r0,20(r1)
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc1b86c: 60 a5 80 00 ori r5,r5,32768
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc1b870: 4b ff f5 4d bl ffc1adbc <_savegpr_31>
ffc1b874: 39 04 ff ff addi r8,r4,-1
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc1b878: 81 23 00 10 lwz r9,16(r3)
ffc1b87c: 38 e0 00 01 li r7,1
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc1b880: 7c 7f 1b 78 mr r31,r3
POSIX_API_Control *api;
sigset_t mask;
siginfo_t *the_info = NULL;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc1b884: 80 c3 01 50 lwz r6,336(r3)
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc1b888: 7d 2b 28 38 and r11,r9,r5
ffc1b88c: 7f 8b 28 00 cmpw cr7,r11,r5
ffc1b890: 7c e8 40 30 slw r8,r7,r8
ffc1b894: 40 be 00 60 bne+ cr7,ffc1b8f4 <_POSIX_signals_Unblock_thread+0xa0>
if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) {
ffc1b898: 81 23 00 30 lwz r9,48(r3)
ffc1b89c: 7d 07 48 39 and. r7,r8,r9
ffc1b8a0: 40 82 00 14 bne- ffc1b8b4 <_POSIX_signals_Unblock_thread+0x60>
ffc1b8a4: 81 26 00 d0 lwz r9,208(r6)
ffc1b8a8: 7d 06 48 79 andc. r6,r8,r9
ffc1b8ac: 40 a2 00 08 bne+ ffc1b8b4 <_POSIX_signals_Unblock_thread+0x60>
ffc1b8b0: 48 00 00 c8 b ffc1b978 <_POSIX_signals_Unblock_thread+0x124>
the_thread->Wait.return_code = EINTR;
the_info = (siginfo_t *) the_thread->Wait.return_argument;
if ( !info ) {
ffc1b8b4: 2f 8a 00 00 cmpwi cr7,r10,0
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) {
the_thread->Wait.return_code = EINTR;
ffc1b8b8: 39 20 00 04 li r9,4
ffc1b8bc: 91 3f 00 34 stw r9,52(r31)
the_info = (siginfo_t *) the_thread->Wait.return_argument;
ffc1b8c0: 81 3f 00 28 lwz r9,40(r31)
if ( !info ) {
ffc1b8c4: 40 be 00 18 bne+ cr7,ffc1b8dc <_POSIX_signals_Unblock_thread+0x88>
the_info->si_signo = signo;
the_info->si_code = SI_USER;
ffc1b8c8: 39 00 00 01 li r8,1
the_thread->Wait.return_code = EINTR;
the_info = (siginfo_t *) the_thread->Wait.return_argument;
if ( !info ) {
the_info->si_signo = signo;
ffc1b8cc: 90 89 00 00 stw r4,0(r9)
the_info->si_code = SI_USER;
ffc1b8d0: 91 09 00 04 stw r8,4(r9)
the_info->si_value.sival_int = 0;
ffc1b8d4: 91 49 00 08 stw r10,8(r9)
ffc1b8d8: 48 00 00 0c b ffc1b8e4 <_POSIX_signals_Unblock_thread+0x90>
} else {
*the_info = *info;
ffc1b8dc: 7c aa 64 aa lswi r5,r10,12
ffc1b8e0: 7c a9 65 aa stswi r5,r9,12
}
_Thread_queue_Extract_with_proxy( the_thread );
ffc1b8e4: 7f e3 fb 78 mr r3,r31
ffc1b8e8: 4b ff 00 e9 bl ffc0b9d0 <_Thread_queue_Extract_with_proxy>
return true;
ffc1b8ec: 38 60 00 01 li r3,1
ffc1b8f0: 48 00 00 8c b ffc1b97c <_POSIX_signals_Unblock_thread+0x128>
}
/*
* Thread is not waiting due to a sigwait.
*/
if ( ~api->signals_blocked & mask ) {
ffc1b8f4: 81 46 00 d0 lwz r10,208(r6)
ffc1b8f8: 7d 06 50 79 andc. r6,r8,r10
ffc1b8fc: 41 82 00 7c beq- ffc1b978 <_POSIX_signals_Unblock_thread+0x124>
* it is not blocked, THEN
* we need to dispatch at the end of this ISR.
* + Any other combination, do nothing.
*/
if ( _States_Is_interruptible_by_signal( the_thread->current_state ) ) {
ffc1b900: 75 28 10 00 andis. r8,r9,4096
ffc1b904: 41 82 00 48 beq- ffc1b94c <_POSIX_signals_Unblock_thread+0xf8>
the_thread->Wait.return_code = EINTR;
ffc1b908: 39 40 00 04 li r10,4
ffc1b90c: 91 43 00 34 stw r10,52(r3)
/*
* In pthread_cond_wait, a thread will be blocking on a thread
* queue, but is also interruptible by a POSIX signal.
*/
if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) )
ffc1b910: 3d 40 00 03 lis r10,3
ffc1b914: 61 4a be e0 ori r10,r10,48864
ffc1b918: 7d 26 50 39 and. r6,r9,r10
ffc1b91c: 41 a2 00 0c beq+ ffc1b928 <_POSIX_signals_Unblock_thread+0xd4>
_Thread_queue_Extract_with_proxy( the_thread );
ffc1b920: 4b ff 00 b1 bl ffc0b9d0 <_Thread_queue_Extract_with_proxy>
ffc1b924: 48 00 00 54 b ffc1b978 <_POSIX_signals_Unblock_thread+0x124>
else if ( _States_Is_delaying(the_thread->current_state) ) {
ffc1b928: 71 27 00 08 andi. r7,r9,8
ffc1b92c: 41 a2 00 4c beq+ ffc1b978 <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
(void) _Watchdog_Remove( &the_thread->Timer );
ffc1b930: 38 63 00 48 addi r3,r3,72
ffc1b934: 4b ff 07 bd bl ffc0c0f0 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc1b938: 3c 80 10 07 lis r4,4103
ffc1b93c: 7f e3 fb 78 mr r3,r31
ffc1b940: 60 84 ff f8 ori r4,r4,65528
ffc1b944: 4b fe f4 c5 bl ffc0ae08 <_Thread_Clear_state>
ffc1b948: 48 00 00 30 b ffc1b978 <_POSIX_signals_Unblock_thread+0x124>
_Thread_Unblock( the_thread );
}
} else if ( the_thread->current_state == STATES_READY ) {
ffc1b94c: 2f 89 00 00 cmpwi cr7,r9,0
ffc1b950: 40 9e 00 28 bne- cr7,ffc1b978 <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
ffc1b954: 3d 20 00 00 lis r9,0
ffc1b958: 39 29 31 a0 addi r9,r9,12704
ffc1b95c: 81 49 00 08 lwz r10,8(r9)
ffc1b960: 2f 8a 00 00 cmpwi cr7,r10,0
ffc1b964: 41 9e 00 14 beq- cr7,ffc1b978 <_POSIX_signals_Unblock_thread+0x124>
ffc1b968: 81 49 00 10 lwz r10,16(r9)
ffc1b96c: 7f 83 50 00 cmpw cr7,r3,r10
ffc1b970: 40 be 00 08 bne+ cr7,ffc1b978 <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc1b974: 98 e9 00 0c stb r7,12(r9)
}
}
return false;
ffc1b978: 38 60 00 00 li r3,0
}
ffc1b97c: 39 61 00 10 addi r11,r1,16
ffc1b980: 4b fe 4c 44 b ffc005c4 <_restgpr_31_x>
ffc0b0c0 <_RBTree_Extract_unprotected>:
*/
void _RBTree_Extract_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
ffc0b0c0: 94 21 ff e8 stwu r1,-24(r1)
ffc0b0c4: 7c 08 02 a6 mflr r0
ffc0b0c8: bf 81 00 08 stmw r28,8(r1)
RBTree_Node *leaf, *target;
RBTree_Color victim_color;
RBTree_Direction dir;
if (!the_node) return;
ffc0b0cc: 7c 9f 23 79 mr. r31,r4
*/
void _RBTree_Extract_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
ffc0b0d0: 90 01 00 1c stw r0,28(r1)
RBTree_Node *leaf, *target;
RBTree_Color victim_color;
RBTree_Direction dir;
if (!the_node) return;
ffc0b0d4: 41 82 01 9c beq- ffc0b270 <_RBTree_Extract_unprotected+0x1b0>
/* check if min needs to be updated */
if (the_node == the_rbtree->first[RBT_LEFT]) {
ffc0b0d8: 81 23 00 08 lwz r9,8(r3)
ffc0b0dc: 7c 7c 1b 78 mr r28,r3
ffc0b0e0: 7f 9f 48 00 cmpw cr7,r31,r9
ffc0b0e4: 40 be 00 14 bne+ cr7,ffc0b0f8 <_RBTree_Extract_unprotected+0x38>
*/
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Successor_unprotected(
const RBTree_Node *node
)
{
return _RBTree_Next_unprotected( node, RBT_RIGHT );
ffc0b0e8: 7f e3 fb 78 mr r3,r31
ffc0b0ec: 38 80 00 01 li r4,1
ffc0b0f0: 48 00 04 f5 bl ffc0b5e4 <_RBTree_Next_unprotected>
RBTree_Node *next;
next = _RBTree_Successor_unprotected(the_node);
the_rbtree->first[RBT_LEFT] = next;
ffc0b0f4: 90 7c 00 08 stw r3,8(r28)
}
/* Check if max needs to be updated. min=max for 1 element trees so
* do not use else if here. */
if (the_node == the_rbtree->first[RBT_RIGHT]) {
ffc0b0f8: 81 3c 00 0c lwz r9,12(r28)
ffc0b0fc: 7f 9f 48 00 cmpw cr7,r31,r9
ffc0b100: 40 be 00 14 bne+ cr7,ffc0b114 <_RBTree_Extract_unprotected+0x54>
*/
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Predecessor_unprotected(
const RBTree_Node *node
)
{
return _RBTree_Next_unprotected( node, RBT_LEFT );
ffc0b104: 7f e3 fb 78 mr r3,r31
ffc0b108: 38 80 00 00 li r4,0
ffc0b10c: 48 00 04 d9 bl ffc0b5e4 <_RBTree_Next_unprotected>
RBTree_Node *previous;
previous = _RBTree_Predecessor_unprotected(the_node);
the_rbtree->first[RBT_RIGHT] = previous;
ffc0b110: 90 7c 00 0c stw r3,12(r28)
* either max in node->child[RBT_LEFT] or min in node->child[RBT_RIGHT],
* and replace the_node with the target node. This maintains the binary
* search tree property, but may violate the red-black properties.
*/
if (the_node->child[RBT_LEFT] && the_node->child[RBT_RIGHT]) {
ffc0b114: 83 df 00 04 lwz r30,4(r31)
ffc0b118: 83 bf 00 08 lwz r29,8(r31)
ffc0b11c: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0b120: 41 9e 00 d0 beq- cr7,ffc0b1f0 <_RBTree_Extract_unprotected+0x130>
ffc0b124: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b128: 40 be 00 0c bne+ cr7,ffc0b134 <_RBTree_Extract_unprotected+0x74>
ffc0b12c: 48 00 00 d0 b ffc0b1fc <_RBTree_Extract_unprotected+0x13c>
target = the_node->child[RBT_LEFT]; /* find max in node->child[RBT_LEFT] */
while (target->child[RBT_RIGHT]) target = target->child[RBT_RIGHT];
ffc0b130: 7d 3e 4b 78 mr r30,r9
ffc0b134: 81 3e 00 08 lwz r9,8(r30)
ffc0b138: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b13c: 40 9e ff f4 bne+ cr7,ffc0b130 <_RBTree_Extract_unprotected+0x70>
* target's position (target is the right child of target->parent)
* when target vacates it. if there is no child, then target->parent
* should become NULL. This may cause the coloring to be violated.
* For now we store the color of the node being deleted in victim_color.
*/
leaf = target->child[RBT_LEFT];
ffc0b140: 83 be 00 04 lwz r29,4(r30)
if(leaf) {
ffc0b144: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b148: 41 9e 00 10 beq- cr7,ffc0b158 <_RBTree_Extract_unprotected+0x98>
leaf->parent = target->parent;
ffc0b14c: 81 3e 00 00 lwz r9,0(r30)
ffc0b150: 91 3d 00 00 stw r9,0(r29)
ffc0b154: 48 00 00 0c b ffc0b160 <_RBTree_Extract_unprotected+0xa0>
} else {
/* fix the tree here if the child is a null leaf. */
_RBTree_Extract_validate_unprotected(target);
ffc0b158: 7f c3 f3 78 mr r3,r30
ffc0b15c: 4b ff fd cd bl ffc0af28 <_RBTree_Extract_validate_unprotected>
}
victim_color = target->color;
dir = target != target->parent->child[0];
ffc0b160: 81 1e 00 00 lwz r8,0(r30)
leaf->parent = target->parent;
} else {
/* fix the tree here if the child is a null leaf. */
_RBTree_Extract_validate_unprotected(target);
}
victim_color = target->color;
ffc0b164: 81 5e 00 0c lwz r10,12(r30)
dir = target != target->parent->child[0];
ffc0b168: 81 28 00 04 lwz r9,4(r8)
ffc0b16c: 7f c9 4a 78 xor r9,r30,r9
ffc0b170: 7d 29 00 34 cntlzw r9,r9
ffc0b174: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc0b178: 69 29 00 01 xori r9,r9,1
target->parent->child[dir] = leaf;
ffc0b17c: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0b180: 7d 08 4a 14 add r8,r8,r9
ffc0b184: 93 a8 00 04 stw r29,4(r8)
/* now replace the_node with target */
dir = the_node != the_node->parent->child[0];
ffc0b188: 81 1f 00 00 lwz r8,0(r31)
ffc0b18c: 81 28 00 04 lwz r9,4(r8)
ffc0b190: 7f e9 4a 78 xor r9,r31,r9
ffc0b194: 7d 29 00 34 cntlzw r9,r9
ffc0b198: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc0b19c: 69 29 00 01 xori r9,r9,1
the_node->parent->child[dir] = target;
ffc0b1a0: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0b1a4: 7d 08 4a 14 add r8,r8,r9
ffc0b1a8: 93 c8 00 04 stw r30,4(r8)
/* set target's new children to the original node's children */
target->child[RBT_RIGHT] = the_node->child[RBT_RIGHT];
ffc0b1ac: 81 3f 00 08 lwz r9,8(r31)
ffc0b1b0: 91 3e 00 08 stw r9,8(r30)
if (the_node->child[RBT_RIGHT])
ffc0b1b4: 81 3f 00 08 lwz r9,8(r31)
ffc0b1b8: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b1bc: 41 9e 00 08 beq- cr7,ffc0b1c4 <_RBTree_Extract_unprotected+0x104><== NEVER TAKEN
the_node->child[RBT_RIGHT]->parent = target;
ffc0b1c0: 93 c9 00 00 stw r30,0(r9)
target->child[RBT_LEFT] = the_node->child[RBT_LEFT];
ffc0b1c4: 81 3f 00 04 lwz r9,4(r31)
ffc0b1c8: 91 3e 00 04 stw r9,4(r30)
if (the_node->child[RBT_LEFT])
ffc0b1cc: 81 3f 00 04 lwz r9,4(r31)
ffc0b1d0: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b1d4: 41 9e 00 08 beq- cr7,ffc0b1dc <_RBTree_Extract_unprotected+0x11c>
the_node->child[RBT_LEFT]->parent = target;
ffc0b1d8: 93 c9 00 00 stw r30,0(r9)
/* finally, update the parent node and recolor. target has completely
* replaced the_node, and target's child has moved up the tree if needed.
* the_node is no longer part of the tree, although it has valid pointers
* still.
*/
target->parent = the_node->parent;
ffc0b1dc: 81 3f 00 00 lwz r9,0(r31)
ffc0b1e0: 91 3e 00 00 stw r9,0(r30)
target->color = the_node->color;
ffc0b1e4: 81 3f 00 0c lwz r9,12(r31)
ffc0b1e8: 91 3e 00 0c stw r9,12(r30)
ffc0b1ec: 48 00 00 50 b ffc0b23c <_RBTree_Extract_unprotected+0x17c>
* violated. We will fix it later.
* For now we store the color of the node being deleted in victim_color.
*/
leaf = the_node->child[RBT_LEFT] ?
the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT];
if( leaf ) {
ffc0b1f0: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b1f4: 40 be 00 0c bne+ cr7,ffc0b200 <_RBTree_Extract_unprotected+0x140>
ffc0b1f8: 48 00 00 14 b ffc0b20c <_RBTree_Extract_unprotected+0x14c>
* either max in node->child[RBT_LEFT] or min in node->child[RBT_RIGHT],
* and replace the_node with the target node. This maintains the binary
* search tree property, but may violate the red-black properties.
*/
if (the_node->child[RBT_LEFT] && the_node->child[RBT_RIGHT]) {
ffc0b1fc: 7f dd f3 78 mr r29,r30
* For now we store the color of the node being deleted in victim_color.
*/
leaf = the_node->child[RBT_LEFT] ?
the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT];
if( leaf ) {
leaf->parent = the_node->parent;
ffc0b200: 81 3f 00 00 lwz r9,0(r31)
ffc0b204: 91 3d 00 00 stw r9,0(r29)
ffc0b208: 48 00 00 0c b ffc0b214 <_RBTree_Extract_unprotected+0x154>
} else {
/* fix the tree here if the child is a null leaf. */
_RBTree_Extract_validate_unprotected(the_node);
ffc0b20c: 7f e3 fb 78 mr r3,r31
ffc0b210: 4b ff fd 19 bl ffc0af28 <_RBTree_Extract_validate_unprotected>
}
victim_color = the_node->color;
/* remove the_node from the tree */
dir = the_node != the_node->parent->child[0];
ffc0b214: 81 1f 00 00 lwz r8,0(r31)
leaf->parent = the_node->parent;
} else {
/* fix the tree here if the child is a null leaf. */
_RBTree_Extract_validate_unprotected(the_node);
}
victim_color = the_node->color;
ffc0b218: 81 5f 00 0c lwz r10,12(r31)
/* remove the_node from the tree */
dir = the_node != the_node->parent->child[0];
ffc0b21c: 81 28 00 04 lwz r9,4(r8)
ffc0b220: 7f e9 4a 78 xor r9,r31,r9
ffc0b224: 7d 29 00 34 cntlzw r9,r9
ffc0b228: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc0b22c: 69 29 00 01 xori r9,r9,1
the_node->parent->child[dir] = leaf;
ffc0b230: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0b234: 7d 08 4a 14 add r8,r8,r9
ffc0b238: 93 a8 00 04 stw r29,4(r8)
/* fix coloring. leaf has moved up the tree. The color of the deleted
* node is in victim_color. There are two cases:
* 1. Deleted a red node, its child must be black. Nothing must be done.
* 2. Deleted a black node, its child must be red. Paint child black.
*/
if (victim_color == RBT_BLACK) { /* eliminate case 1 */
ffc0b23c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0b240: 40 9e 00 10 bne- cr7,ffc0b250 <_RBTree_Extract_unprotected+0x190>
if (leaf) {
ffc0b244: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b248: 41 9e 00 08 beq- cr7,ffc0b250 <_RBTree_Extract_unprotected+0x190>
leaf->color = RBT_BLACK; /* case 2 */
ffc0b24c: 91 5d 00 0c stw r10,12(r29)
/* Wipe the_node */
_RBTree_Set_off_rbtree(the_node);
/* set root to black, if it exists */
if (the_rbtree->root) the_rbtree->root->color = RBT_BLACK;
ffc0b250: 81 5c 00 04 lwz r10,4(r28)
*/
RTEMS_INLINE_ROUTINE void _RBTree_Set_off_rbtree(
RBTree_Node *node
)
{
node->parent = node->child[RBT_LEFT] = node->child[RBT_RIGHT] = NULL;
ffc0b254: 39 20 00 00 li r9,0
ffc0b258: 91 3f 00 08 stw r9,8(r31)
ffc0b25c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0b260: 91 3f 00 04 stw r9,4(r31)
ffc0b264: 91 3f 00 00 stw r9,0(r31)
ffc0b268: 41 9e 00 08 beq- cr7,ffc0b270 <_RBTree_Extract_unprotected+0x1b0>
ffc0b26c: 91 2a 00 0c stw r9,12(r10)
}
ffc0b270: 39 61 00 18 addi r11,r1,24
ffc0b274: 4b ff 5a f8 b ffc00d6c <_restgpr_28_x>
ffc0ba98 <_RBTree_Initialize>:
void *starting_address,
size_t number_nodes,
size_t node_size,
bool is_unique
)
{
ffc0ba98: 94 21 ff e8 stwu r1,-24(r1)
ffc0ba9c: 7c 08 02 a6 mflr r0
ffc0baa0: bf 81 00 08 stmw r28,8(r1)
size_t count;
RBTree_Node *next;
/* TODO: Error message? */
if (!the_rbtree) return;
ffc0baa4: 7c 7f 1b 79 mr. r31,r3
void *starting_address,
size_t number_nodes,
size_t node_size,
bool is_unique
)
{
ffc0baa8: 90 01 00 1c stw r0,28(r1)
size_t count;
RBTree_Node *next;
/* TODO: Error message? */
if (!the_rbtree) return;
ffc0baac: 41 82 00 4c beq- ffc0baf8 <_RBTree_Initialize+0x60> <== NEVER TAKEN
RBTree_Control *the_rbtree,
RBTree_Compare_function compare_function,
bool is_unique
)
{
the_rbtree->permanent_null = NULL;
ffc0bab0: 39 20 00 00 li r9,0
the_rbtree->root = NULL;
the_rbtree->first[0] = NULL;
the_rbtree->first[1] = NULL;
the_rbtree->compare_function = compare_function;
ffc0bab4: 90 9f 00 10 stw r4,16(r31)
ffc0bab8: 7c de 33 78 mr r30,r6
ffc0babc: 7c fc 3b 78 mr r28,r7
RBTree_Control *the_rbtree,
RBTree_Compare_function compare_function,
bool is_unique
)
{
the_rbtree->permanent_null = NULL;
ffc0bac0: 91 3f 00 00 stw r9,0(r31)
/* could do sanity checks here */
_RBTree_Initialize_empty(the_rbtree, compare_function, is_unique);
count = number_nodes;
next = starting_address;
ffc0bac4: 7c bd 2b 78 mr r29,r5
the_rbtree->root = NULL;
ffc0bac8: 91 3f 00 04 stw r9,4(r31)
the_rbtree->first[0] = NULL;
ffc0bacc: 91 3f 00 08 stw r9,8(r31)
the_rbtree->first[1] = NULL;
ffc0bad0: 91 3f 00 0c stw r9,12(r31)
the_rbtree->compare_function = compare_function;
the_rbtree->is_unique = is_unique;
ffc0bad4: 99 1f 00 14 stb r8,20(r31)
while ( count-- ) {
ffc0bad8: 48 00 00 18 b ffc0baf0 <_RBTree_Initialize+0x58>
_RBTree_Insert_unprotected(the_rbtree, next);
ffc0badc: 7f a4 eb 78 mr r4,r29
ffc0bae0: 7f e3 fb 78 mr r3,r31
ffc0bae4: 4b ff fc 91 bl ffc0b774 <_RBTree_Insert_unprotected>
#include <rtems/system.h>
#include <rtems/score/address.h>
#include <rtems/score/rbtree.h>
#include <rtems/score/isr.h>
void _RBTree_Initialize(
ffc0bae8: 7f bd e2 14 add r29,r29,r28
ffc0baec: 3b de ff ff addi r30,r30,-1
/* could do sanity checks here */
_RBTree_Initialize_empty(the_rbtree, compare_function, is_unique);
count = number_nodes;
next = starting_address;
while ( count-- ) {
ffc0baf0: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0baf4: 40 9e ff e8 bne+ cr7,ffc0badc <_RBTree_Initialize+0x44>
_RBTree_Insert_unprotected(the_rbtree, next);
next = (RBTree_Node *)
_Addresses_Add_offset( (void *) next, node_size );
}
}
ffc0baf8: 39 61 00 18 addi r11,r1,24
ffc0bafc: 4b ff 5e 6c b ffc01968 <_restgpr_28_x>
ffc0b328 <_RBTree_Insert_unprotected>:
*/
RBTree_Node *_RBTree_Insert_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
ffc0b328: 94 21 ff e0 stwu r1,-32(r1)
ffc0b32c: 7c 08 02 a6 mflr r0
ffc0b330: bf 41 00 08 stmw r26,8(r1)
if(!the_node) return (RBTree_Node*)-1;
ffc0b334: 7c 9f 23 79 mr. r31,r4
*/
RBTree_Node *_RBTree_Insert_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
ffc0b338: 90 01 00 24 stw r0,36(r1)
if(!the_node) return (RBTree_Node*)-1;
ffc0b33c: 41 82 01 d8 beq- ffc0b514 <_RBTree_Insert_unprotected+0x1ec>
RBTree_Node *iter_node = the_rbtree->root;
ffc0b340: 83 c3 00 04 lwz r30,4(r3)
ffc0b344: 7c 7d 1b 78 mr r29,r3
int compare_result;
if (!iter_node) { /* special case: first node inserted */
ffc0b348: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0b34c: 7f db f3 78 mr r27,r30
ffc0b350: 40 be 00 28 bne+ cr7,ffc0b378 <_RBTree_Insert_unprotected+0x50>
the_node->color = RBT_BLACK;
ffc0b354: 93 df 00 0c stw r30,12(r31)
the_rbtree->root = the_node;
ffc0b358: 93 e3 00 04 stw r31,4(r3)
the_rbtree->first[0] = the_rbtree->first[1] = the_node;
ffc0b35c: 93 e3 00 0c stw r31,12(r3)
ffc0b360: 93 e3 00 08 stw r31,8(r3)
the_node->parent = (RBTree_Node *) the_rbtree;
ffc0b364: 90 7f 00 00 stw r3,0(r31)
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
ffc0b368: 93 df 00 08 stw r30,8(r31)
ffc0b36c: 93 df 00 04 stw r30,4(r31)
ffc0b370: 48 00 01 c0 b ffc0b530 <_RBTree_Insert_unprotected+0x208>
(dir && _RBTree_Is_greater(compare_result)) ) {
the_rbtree->first[dir] = the_node;
}
break;
} else {
iter_node = iter_node->child[dir];
ffc0b374: 7f db f3 78 mr r27,r30
the_node->parent = (RBTree_Node *) the_rbtree;
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
} else {
/* typical binary search tree insert, descend tree to leaf and insert */
while (iter_node) {
compare_result = the_rbtree->compare_function(the_node, iter_node);
ffc0b378: 81 3d 00 10 lwz r9,16(r29)
ffc0b37c: 7f e3 fb 78 mr r3,r31
ffc0b380: 7f c4 f3 78 mr r4,r30
ffc0b384: 7d 29 03 a6 mtctr r9
ffc0b388: 4e 80 04 21 bctrl
if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) )
ffc0b38c: 89 3d 00 14 lbz r9,20(r29)
ffc0b390: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b394: 41 9e 00 0c beq- cr7,ffc0b3a0 <_RBTree_Insert_unprotected+0x78>
ffc0b398: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b39c: 41 9e 01 94 beq- cr7,ffc0b530 <_RBTree_Insert_unprotected+0x208>
return iter_node;
RBTree_Direction dir = !_RBTree_Is_lesser( compare_result );
ffc0b3a0: 7c 7c 18 f8 not r28,r3
ffc0b3a4: 57 9c 0f fe rlwinm r28,r28,1,31,31
if (!iter_node->child[dir]) {
ffc0b3a8: 57 89 10 3a rlwinm r9,r28,2,0,29
ffc0b3ac: 7f de 4a 14 add r30,r30,r9
ffc0b3b0: 39 5e 00 04 addi r10,r30,4
ffc0b3b4: 83 de 00 04 lwz r30,4(r30)
ffc0b3b8: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0b3bc: 40 9e ff b8 bne+ cr7,ffc0b374 <_RBTree_Insert_unprotected+0x4c>
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
ffc0b3c0: 93 df 00 08 stw r30,8(r31)
the_node->color = RBT_RED;
ffc0b3c4: 39 00 00 01 li r8,1
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_First(
const RBTree_Control *the_rbtree,
RBTree_Direction dir
)
{
return the_rbtree->first[dir];
ffc0b3c8: 7d 3d 4a 14 add r9,r29,r9
compare_result = the_rbtree->compare_function(the_node, iter_node);
if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) )
return iter_node;
RBTree_Direction dir = !_RBTree_Is_lesser( compare_result );
if (!iter_node->child[dir]) {
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
ffc0b3cc: 93 df 00 04 stw r30,4(r31)
the_node->color = RBT_RED;
iter_node->child[dir] = the_node;
the_node->parent = iter_node;
/* update min/max */
compare_result = the_rbtree->compare_function(
ffc0b3d0: 7f e3 fb 78 mr r3,r31
return iter_node;
RBTree_Direction dir = !_RBTree_Is_lesser( compare_result );
if (!iter_node->child[dir]) {
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
the_node->color = RBT_RED;
iter_node->child[dir] = the_node;
ffc0b3d4: 93 ea 00 00 stw r31,0(r10)
the_node->parent = iter_node;
/* update min/max */
compare_result = the_rbtree->compare_function(
ffc0b3d8: 81 5d 00 10 lwz r10,16(r29)
if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) )
return iter_node;
RBTree_Direction dir = !_RBTree_Is_lesser( compare_result );
if (!iter_node->child[dir]) {
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
the_node->color = RBT_RED;
ffc0b3dc: 91 1f 00 0c stw r8,12(r31)
iter_node->child[dir] = the_node;
the_node->parent = iter_node;
/* update min/max */
compare_result = the_rbtree->compare_function(
ffc0b3e0: 7d 49 03 a6 mtctr r10
RBTree_Direction dir = !_RBTree_Is_lesser( compare_result );
if (!iter_node->child[dir]) {
the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL;
the_node->color = RBT_RED;
iter_node->child[dir] = the_node;
the_node->parent = iter_node;
ffc0b3e4: 93 7f 00 00 stw r27,0(r31)
/* update min/max */
compare_result = the_rbtree->compare_function(
ffc0b3e8: 80 89 00 08 lwz r4,8(r9)
ffc0b3ec: 4e 80 04 21 bctrl
the_node,
_RBTree_First(the_rbtree, dir)
);
if ( (!dir && _RBTree_Is_lesser(compare_result)) ||
ffc0b3f0: 2f 1c 00 00 cmpwi cr6,r28,0
ffc0b3f4: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b3f8: 40 9a 00 0c bne- cr6,ffc0b404 <_RBTree_Insert_unprotected+0xdc>
ffc0b3fc: 40 bc 00 e4 bge+ cr7,ffc0b4e0 <_RBTree_Insert_unprotected+0x1b8>
ffc0b400: 48 00 00 08 b ffc0b408 <_RBTree_Insert_unprotected+0xe0>
(dir && _RBTree_Is_greater(compare_result)) ) {
ffc0b404: 40 9d 00 dc ble- cr7,ffc0b4e0 <_RBTree_Insert_unprotected+0x1b8>
the_rbtree->first[dir] = the_node;
ffc0b408: 57 9c 10 3a rlwinm r28,r28,2,0,29
ffc0b40c: 7f bd e2 14 add r29,r29,r28
ffc0b410: 93 fd 00 08 stw r31,8(r29)
ffc0b414: 48 00 00 cc b ffc0b4e0 <_RBTree_Insert_unprotected+0x1b8>
const RBTree_Node *the_node
)
{
if(!the_node) return NULL;
if(!(the_node->parent)) return NULL;
if(!(the_node->parent->parent)) return NULL;
ffc0b418: 41 9e 00 38 beq- cr7,ffc0b450 <_RBTree_Insert_unprotected+0x128><== NEVER TAKEN
if(!(the_node->parent->parent->parent)) return NULL;
ffc0b41c: 81 3d 00 00 lwz r9,0(r29)
ffc0b420: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b424: 41 9e 00 2c beq- cr7,ffc0b450 <_RBTree_Insert_unprotected+0x128><== NEVER TAKEN
{
if(!the_node) return NULL;
if(!(the_node->parent)) return NULL;
if(!(the_node->parent->parent)) return NULL;
if(the_node == the_node->parent->child[RBT_LEFT])
ffc0b428: 81 3d 00 04 lwz r9,4(r29)
ffc0b42c: 7f 83 48 00 cmpw cr7,r3,r9
ffc0b430: 40 be 00 08 bne+ cr7,ffc0b438 <_RBTree_Insert_unprotected+0x110>
return the_node->parent->child[RBT_RIGHT];
ffc0b434: 81 3d 00 08 lwz r9,8(r29)
*/
RTEMS_INLINE_ROUTINE bool _RBTree_Is_red(
const RBTree_Node *the_node
)
{
return (the_node && the_node->color == RBT_RED);
ffc0b438: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b43c: 41 9e 00 18 beq- cr7,ffc0b454 <_RBTree_Insert_unprotected+0x12c>
ffc0b440: 81 49 00 0c lwz r10,12(r9)
ffc0b444: 2f 8a 00 01 cmpwi cr7,r10,1
ffc0b448: 40 be 00 0c bne+ cr7,ffc0b454 <_RBTree_Insert_unprotected+0x12c>
ffc0b44c: 48 00 00 10 b ffc0b45c <_RBTree_Insert_unprotected+0x134>
)
{
if(!the_node) return NULL;
if(!(the_node->parent)) return NULL;
if(!(the_node->parent->parent)) return NULL;
if(!(the_node->parent->parent->parent)) return NULL;
ffc0b450: 39 20 00 00 li r9,0 <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE bool _RBTree_Is_red(
const RBTree_Node *the_node
)
{
return (the_node && the_node->color == RBT_RED);
ffc0b454: 39 40 00 00 li r10,0
ffc0b458: 48 00 00 08 b ffc0b460 <_RBTree_Insert_unprotected+0x138>
ffc0b45c: 39 40 00 01 li r10,1
while (_RBTree_Is_red(_RBTree_Parent(the_node))) {
u = _RBTree_Parent_sibling(the_node);
g = the_node->parent->parent;
/* if uncle is red, repaint uncle/parent black and grandparent red */
if(_RBTree_Is_red(u)) {
ffc0b460: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0b464: 41 9e 00 14 beq- cr7,ffc0b478 <_RBTree_Insert_unprotected+0x150>
the_node->parent->color = RBT_BLACK;
ffc0b468: 93 63 00 0c stw r27,12(r3)
u->color = RBT_BLACK;
ffc0b46c: 93 69 00 0c stw r27,12(r9)
g->color = RBT_RED;
ffc0b470: 93 5d 00 0c stw r26,12(r29)
ffc0b474: 48 00 00 64 b ffc0b4d8 <_RBTree_Insert_unprotected+0x1b0>
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
RBTree_Direction pdir = the_node->parent != g->child[0];
ffc0b478: 80 9d 00 04 lwz r4,4(r29)
the_node->parent->color = RBT_BLACK;
u->color = RBT_BLACK;
g->color = RBT_RED;
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
ffc0b47c: 81 23 00 04 lwz r9,4(r3)
RBTree_Direction pdir = the_node->parent != g->child[0];
ffc0b480: 7c 64 22 78 xor r4,r3,r4
the_node->parent->color = RBT_BLACK;
u->color = RBT_BLACK;
g->color = RBT_RED;
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
ffc0b484: 7f e9 4a 78 xor r9,r31,r9
RBTree_Direction pdir = the_node->parent != g->child[0];
ffc0b488: 7c 84 00 34 cntlzw r4,r4
the_node->parent->color = RBT_BLACK;
u->color = RBT_BLACK;
g->color = RBT_RED;
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
ffc0b48c: 7d 29 00 34 cntlzw r9,r9
RBTree_Direction pdir = the_node->parent != g->child[0];
ffc0b490: 54 84 d9 7e rlwinm r4,r4,27,5,31
the_node->parent->color = RBT_BLACK;
u->color = RBT_BLACK;
g->color = RBT_RED;
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
ffc0b494: 55 29 d9 7e rlwinm r9,r9,27,5,31
RBTree_Direction pdir = the_node->parent != g->child[0];
ffc0b498: 68 9c 00 01 xori r28,r4,1
the_node->parent->color = RBT_BLACK;
u->color = RBT_BLACK;
g->color = RBT_RED;
the_node = g;
} else { /* if uncle is black */
RBTree_Direction dir = the_node != the_node->parent->child[0];
ffc0b49c: 69 29 00 01 xori r9,r9,1
RBTree_Direction pdir = the_node->parent != g->child[0];
/* ensure node is on the same branch direction as parent */
if (dir != pdir) {
ffc0b4a0: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0b4a4: 41 9e 00 18 beq- cr7,ffc0b4bc <_RBTree_Insert_unprotected+0x194>
_RBTree_Rotate(the_node->parent, pdir);
ffc0b4a8: 7f 84 e3 78 mr r4,r28
ffc0b4ac: 4b ff fe 01 bl ffc0b2ac <_RBTree_Rotate>
the_node = the_node->child[pdir];
ffc0b4b0: 57 89 10 3a rlwinm r9,r28,2,0,29
ffc0b4b4: 7f ff 4a 14 add r31,r31,r9
ffc0b4b8: 83 ff 00 04 lwz r31,4(r31)
}
the_node->parent->color = RBT_BLACK;
ffc0b4bc: 81 3f 00 00 lwz r9,0(r31)
g->color = RBT_RED;
/* now rotate grandparent in the other branch direction (toward uncle) */
_RBTree_Rotate(g, (1-pdir));
ffc0b4c0: 7f a3 eb 78 mr r3,r29
ffc0b4c4: 20 9c 00 01 subfic r4,r28,1
/* ensure node is on the same branch direction as parent */
if (dir != pdir) {
_RBTree_Rotate(the_node->parent, pdir);
the_node = the_node->child[pdir];
}
the_node->parent->color = RBT_BLACK;
ffc0b4c8: 93 69 00 0c stw r27,12(r9)
g->color = RBT_RED;
ffc0b4cc: 93 5d 00 0c stw r26,12(r29)
/* now rotate grandparent in the other branch direction (toward uncle) */
_RBTree_Rotate(g, (1-pdir));
ffc0b4d0: 7f fd fb 78 mr r29,r31
ffc0b4d4: 4b ff fd d9 bl ffc0b2ac <_RBTree_Rotate>
ffc0b4d8: 7f bf eb 78 mr r31,r29
ffc0b4dc: 48 00 00 0c b ffc0b4e8 <_RBTree_Insert_unprotected+0x1c0>
ffc0b4e0: 3b 60 00 00 li r27,0
ffc0b4e4: 3b 40 00 01 li r26,1
_ISR_Disable( level );
return_node = _RBTree_Insert_unprotected( tree, node );
_ISR_Enable( level );
return return_node;
}
ffc0b4e8: 80 7f 00 00 lwz r3,0(r31)
*/
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent(
const RBTree_Node *the_node
)
{
if (!the_node->parent->parent) return NULL;
ffc0b4ec: 83 a3 00 00 lwz r29,0(r3)
ffc0b4f0: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b4f4: 40 be 00 28 bne+ cr7,ffc0b51c <_RBTree_Insert_unprotected+0x1f4>
*/
RTEMS_INLINE_ROUTINE bool _RBTree_Is_red(
const RBTree_Node *the_node
)
{
return (the_node && the_node->color == RBT_RED);
ffc0b4f8: 39 20 00 00 li r9,0
RBTree_Node *u,*g;
/* note: the insert root case is handled already */
/* if the parent is black, nothing needs to be done
* otherwise may need to loop a few times */
while (_RBTree_Is_red(_RBTree_Parent(the_node))) {
ffc0b4fc: 2f 09 00 00 cmpwi cr6,r9,0
ffc0b500: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b504: 40 9a ff 14 bne+ cr6,ffc0b418 <_RBTree_Insert_unprotected+0xf0>
/* now rotate grandparent in the other branch direction (toward uncle) */
_RBTree_Rotate(g, (1-pdir));
}
}
if(!the_node->parent->parent) the_node->color = RBT_BLACK;
ffc0b508: 40 be 00 28 bne+ cr7,ffc0b530 <_RBTree_Insert_unprotected+0x208>
ffc0b50c: 93 bf 00 0c stw r29,12(r31)
ffc0b510: 48 00 00 20 b ffc0b530 <_RBTree_Insert_unprotected+0x208>
RBTree_Node *_RBTree_Insert_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
if(!the_node) return (RBTree_Node*)-1;
ffc0b514: 3b c0 ff ff li r30,-1
ffc0b518: 48 00 00 18 b ffc0b530 <_RBTree_Insert_unprotected+0x208>
ffc0b51c: 81 23 00 0c lwz r9,12(r3)
ffc0b520: 69 29 00 01 xori r9,r9,1
ffc0b524: 7d 29 00 34 cntlzw r9,r9
ffc0b528: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc0b52c: 4b ff ff d0 b ffc0b4fc <_RBTree_Insert_unprotected+0x1d4>
/* verify red-black properties */
_RBTree_Validate_insert_unprotected(the_node);
}
return (RBTree_Node*)0;
}
ffc0b530: 39 61 00 20 addi r11,r1,32
ffc0b534: 7f c3 f3 78 mr r3,r30
ffc0b538: 4b ff 58 2c b ffc00d64 <_restgpr_26_x>
ffc0b570 <_RBTree_Iterate_unprotected>:
const RBTree_Control *rbtree,
RBTree_Direction dir,
RBTree_Visitor visitor,
void *visitor_arg
)
{
ffc0b570: 94 21 ff e0 stwu r1,-32(r1)
ffc0b574: 7c 08 02 a6 mflr r0
*/
RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction(
RBTree_Direction the_dir
)
{
return (RBTree_Direction) !((int) the_dir);
ffc0b578: 7c 89 00 34 cntlzw r9,r4
ffc0b57c: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc0b580: 90 01 00 24 stw r0,36(r1)
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_First(
const RBTree_Control *the_rbtree,
RBTree_Direction dir
)
{
return the_rbtree->first[dir];
ffc0b584: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0b588: 7c 63 4a 14 add r3,r3,r9
ffc0b58c: bf 61 00 0c stmw r27,12(r1)
ffc0b590: 7c bd 2b 78 mr r29,r5
ffc0b594: 7c dc 33 78 mr r28,r6
ffc0b598: 83 e3 00 08 lwz r31,8(r3)
*/
RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction(
RBTree_Direction the_dir
)
{
return (RBTree_Direction) !((int) the_dir);
ffc0b59c: 7c 9e 23 78 mr r30,r4
ffc0b5a0: 48 00 00 34 b ffc0b5d4 <_RBTree_Iterate_unprotected+0x64>
RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir );
const RBTree_Node *current = _RBTree_First( rbtree, opp_dir );
bool stop = false;
while ( !stop && current != NULL ) {
stop = (*visitor)( current, dir, visitor_arg );
ffc0b5a4: 7f e3 fb 78 mr r3,r31
ffc0b5a8: 7f a9 03 a6 mtctr r29
ffc0b5ac: 7f c4 f3 78 mr r4,r30
ffc0b5b0: 7f 85 e3 78 mr r5,r28
ffc0b5b4: 4e 80 04 21 bctrl
current = _RBTree_Next_unprotected( current, dir );
ffc0b5b8: 7f c4 f3 78 mr r4,r30
RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir );
const RBTree_Node *current = _RBTree_First( rbtree, opp_dir );
bool stop = false;
while ( !stop && current != NULL ) {
stop = (*visitor)( current, dir, visitor_arg );
ffc0b5bc: 7c 7b 1b 78 mr r27,r3
current = _RBTree_Next_unprotected( current, dir );
ffc0b5c0: 7f e3 fb 78 mr r3,r31
ffc0b5c4: 48 00 00 21 bl ffc0b5e4 <_RBTree_Next_unprotected>
{
RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir );
const RBTree_Node *current = _RBTree_First( rbtree, opp_dir );
bool stop = false;
while ( !stop && current != NULL ) {
ffc0b5c8: 2f 9b 00 00 cmpwi cr7,r27,0
stop = (*visitor)( current, dir, visitor_arg );
current = _RBTree_Next_unprotected( current, dir );
ffc0b5cc: 7c 7f 1b 78 mr r31,r3
{
RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir );
const RBTree_Node *current = _RBTree_First( rbtree, opp_dir );
bool stop = false;
while ( !stop && current != NULL ) {
ffc0b5d0: 40 9e 00 0c bne- cr7,ffc0b5dc <_RBTree_Iterate_unprotected+0x6c><== NEVER TAKEN
ffc0b5d4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0b5d8: 40 9e ff cc bne+ cr7,ffc0b5a4 <_RBTree_Iterate_unprotected+0x34>
stop = (*visitor)( current, dir, visitor_arg );
current = _RBTree_Next_unprotected( current, dir );
}
}
ffc0b5dc: 39 61 00 20 addi r11,r1,32
ffc0b5e0: 4b ff 57 88 b ffc00d68 <_restgpr_27_x>
ffc0ae70 <_RBTree_Sibling>:
*/
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling(
const RBTree_Node *the_node
)
{
if(!the_node) return NULL;
ffc0ae70: 7c 6a 1b 79 mr. r10,r3
ffc0ae74: 41 82 00 30 beq- ffc0aea4 <_RBTree_Sibling+0x34> <== NEVER TAKEN
if(!(the_node->parent)) return NULL;
ffc0ae78: 81 2a 00 00 lwz r9,0(r10)
ffc0ae7c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0ae80: 41 9e 00 24 beq- cr7,ffc0aea4 <_RBTree_Sibling+0x34> <== NEVER TAKEN
if(!(the_node->parent->parent)) return NULL;
ffc0ae84: 81 09 00 00 lwz r8,0(r9)
ffc0ae88: 2f 88 00 00 cmpwi cr7,r8,0
ffc0ae8c: 41 9e 00 18 beq- cr7,ffc0aea4 <_RBTree_Sibling+0x34>
if(the_node == the_node->parent->child[RBT_LEFT])
ffc0ae90: 80 69 00 04 lwz r3,4(r9)
ffc0ae94: 7f 8a 18 00 cmpw cr7,r10,r3
ffc0ae98: 4c be 00 20 bnelr+ cr7
return the_node->parent->child[RBT_RIGHT];
ffc0ae9c: 80 69 00 08 lwz r3,8(r9)
ffc0aea0: 4e 80 00 20 blr
*/
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling(
const RBTree_Node *the_node
)
{
if(!the_node) return NULL;
ffc0aea4: 38 60 00 00 li r3,0
if(the_node == the_node->parent->child[RBT_LEFT])
return the_node->parent->child[RBT_RIGHT];
else
return the_node->parent->child[RBT_LEFT];
}
ffc0aea8: 4e 80 00 20 blr
ffc099d8 <_RTEMS_signal_Post_switch_hook>:
#include <rtems/score/thread.h>
#include <rtems/score/apiext.h>
#include <rtems/rtems/tasks.h>
static void _RTEMS_signal_Post_switch_hook( Thread_Control *executing )
{
ffc099d8: 94 21 ff e0 stwu r1,-32(r1)
ffc099dc: 7c 08 02 a6 mflr r0
ffc099e0: 90 01 00 24 stw r0,36(r1)
ffc099e4: bf c1 00 18 stmw r30,24(r1)
RTEMS_API_Control *api;
ASR_Information *asr;
rtems_signal_set signal_set;
Modes_Control prev_mode;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
ffc099e8: 83 e3 01 4c lwz r31,332(r3)
if ( !api )
ffc099ec: 2f 9f 00 00 cmpwi cr7,r31,0
ffc099f0: 41 9e 00 7c beq- cr7,ffc09a6c <_RTEMS_signal_Post_switch_hook+0x94><== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc099f4: 7d 20 00 a6 mfmsr r9
ffc099f8: 7d 50 42 a6 mfsprg r10,0
ffc099fc: 7d 2a 50 78 andc r10,r9,r10
ffc09a00: 7d 40 01 24 mtmsr r10
asr = &api->Signal;
_ISR_Disable( level );
signal_set = asr->signals_posted;
asr->signals_posted = 0;
ffc09a04: 39 40 00 00 li r10,0
*/
asr = &api->Signal;
_ISR_Disable( level );
signal_set = asr->signals_posted;
ffc09a08: 83 df 00 14 lwz r30,20(r31)
asr->signals_posted = 0;
ffc09a0c: 91 5f 00 14 stw r10,20(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc09a10: 7d 20 01 24 mtmsr r9
_ISR_Enable( level );
if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */
ffc09a14: 2f 9e 00 00 cmpwi cr7,r30,0
ffc09a18: 41 be 00 54 beq+ cr7,ffc09a6c <_RTEMS_signal_Post_switch_hook+0x94>
return;
asr->nest_level += 1;
ffc09a1c: 81 3f 00 1c lwz r9,28(r31)
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
ffc09a20: 38 80 00 00 li r4,0
ffc09a24: 80 7f 00 10 lwz r3,16(r31)
ffc09a28: 60 84 ff ff ori r4,r4,65535
if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */
return;
asr->nest_level += 1;
ffc09a2c: 39 29 00 01 addi r9,r9,1
ffc09a30: 91 3f 00 1c stw r9,28(r31)
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
ffc09a34: 38 a1 00 08 addi r5,r1,8
ffc09a38: 48 00 04 41 bl ffc09e78 <rtems_task_mode>
(*asr->handler)( signal_set );
ffc09a3c: 81 3f 00 0c lwz r9,12(r31)
ffc09a40: 7f c3 f3 78 mr r3,r30
ffc09a44: 7d 29 03 a6 mtctr r9
ffc09a48: 4e 80 04 21 bctrl
asr->nest_level -= 1;
ffc09a4c: 81 3f 00 1c lwz r9,28(r31)
rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode );
ffc09a50: 38 80 00 00 li r4,0
ffc09a54: 80 61 00 08 lwz r3,8(r1)
asr->nest_level += 1;
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
(*asr->handler)( signal_set );
asr->nest_level -= 1;
ffc09a58: 39 29 ff ff addi r9,r9,-1
ffc09a5c: 91 3f 00 1c stw r9,28(r31)
rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode );
ffc09a60: 60 84 ff ff ori r4,r4,65535
ffc09a64: 38 a1 00 08 addi r5,r1,8
ffc09a68: 48 00 04 11 bl ffc09e78 <rtems_task_mode>
}
ffc09a6c: 39 61 00 20 addi r11,r1,32
ffc09a70: 4b ff 7a a0 b ffc01510 <_restgpr_30_x>
ffc3461c <_Rate_monotonic_Get_status>:
bool _Rate_monotonic_Get_status(
Rate_monotonic_Control *the_period,
Rate_monotonic_Period_time_t *wall_since_last_period,
Thread_CPU_usage_t *cpu_since_last_period
)
{
ffc3461c: 94 21 ff d8 stwu r1,-40(r1)
ffc34620: 7c 08 02 a6 mflr r0
ffc34624: 90 01 00 2c stw r0,44(r1)
ffc34628: bf 81 00 18 stmw r28,24(r1)
ffc3462c: 7c 9d 23 78 mr r29,r4
*/
static inline void _TOD_Get_uptime(
Timestamp_Control *time
)
{
_TOD_Get_with_nanoseconds( time, &_TOD.uptime );
ffc34630: 3c 80 00 00 lis r4,0
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
Timestamp_Control uptime;
#endif
Thread_Control *owning_thread = the_period->owner;
ffc34634: 83 c3 00 40 lwz r30,64(r3)
bool _Rate_monotonic_Get_status(
Rate_monotonic_Control *the_period,
Rate_monotonic_Period_time_t *wall_since_last_period,
Thread_CPU_usage_t *cpu_since_last_period
)
{
ffc34638: 7c 7f 1b 78 mr r31,r3
ffc3463c: 38 84 63 e8 addi r4,r4,25576
ffc34640: 38 61 00 08 addi r3,r1,8
ffc34644: 7c bc 2b 78 mr r28,r5
ffc34648: 4b fd 4b 35 bl ffc0917c <_TOD_Get_with_nanoseconds>
const Timestamp64_Control *_start,
const Timestamp64_Control *_end,
Timestamp64_Control *_result
)
{
*_result = *_end - *_start;
ffc3464c: 81 5f 00 50 lwz r10,80(r31)
ffc34650: 81 7f 00 54 lwz r11,84(r31)
/*
* Determine elapsed wall time since period initiated.
*/
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_TOD_Get_uptime( &uptime );
_Timestamp_Subtract(
ffc34654: 80 c1 00 08 lwz r6,8(r1)
ffc34658: 80 e1 00 0c lwz r7,12(r1)
ffc3465c: 7d 6b 38 10 subfc r11,r11,r7
ffc34660: 7d 4a 31 10 subfe r10,r10,r6
ffc34664: 91 5d 00 00 stw r10,0(r29)
* Determine cpu usage since period initiated.
*/
used = owning_thread->cpu_time_used;
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
if (owning_thread == _Thread_Executing) {
ffc34668: 3d 40 00 00 lis r10,0
ffc3466c: 39 4a 69 20 addi r10,r10,26912
ffc34670: 91 7d 00 04 stw r11,4(r29)
ffc34674: 80 aa 00 10 lwz r5,16(r10)
#endif
/*
* Determine cpu usage since period initiated.
*/
used = owning_thread->cpu_time_used;
ffc34678: 81 1e 00 80 lwz r8,128(r30)
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
if (owning_thread == _Thread_Executing) {
ffc3467c: 7f 9e 28 00 cmpw cr7,r30,r5
#endif
/*
* Determine cpu usage since period initiated.
*/
used = owning_thread->cpu_time_used;
ffc34680: 81 3e 00 84 lwz r9,132(r30)
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
if (owning_thread == _Thread_Executing) {
ffc34684: 40 be 00 48 bne+ cr7,ffc346cc <_Rate_monotonic_Get_status+0xb0>
ffc34688: 81 6a 00 24 lwz r11,36(r10)
ffc3468c: 81 4a 00 20 lwz r10,32(r10)
ffc34690: 7c eb 38 10 subfc r7,r11,r7
ffc34694: 7c ca 31 10 subfe r6,r10,r6
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
ffc34698: 81 5f 00 48 lwz r10,72(r31)
ffc3469c: 81 7f 00 4c lwz r11,76(r31)
static inline void _Timestamp64_implementation_Add_to(
Timestamp64_Control *_time,
const Timestamp64_Control *_add
)
{
*_time += *_add;
ffc346a0: 7d 29 38 14 addc r9,r9,r7
ffc346a4: 7d 08 31 14 adde r8,r8,r6
/*
* The cpu usage info was reset while executing. Can't
* determine a status.
*/
if (_Timestamp_Less_than(&used, &the_period->cpu_usage_period_initiated))
ffc346a8: 7f 8a 40 00 cmpw cr7,r10,r8
ffc346ac: 41 9d 00 28 bgt- cr7,ffc346d4 <_Rate_monotonic_Get_status+0xb8><== NEVER TAKEN
ffc346b0: 40 be 00 0c bne+ cr7,ffc346bc <_Rate_monotonic_Get_status+0xa0>
ffc346b4: 7f 8b 48 40 cmplw cr7,r11,r9
ffc346b8: 41 9d 00 1c bgt- cr7,ffc346d4 <_Rate_monotonic_Get_status+0xb8>
const Timestamp64_Control *_start,
const Timestamp64_Control *_end,
Timestamp64_Control *_result
)
{
*_result = *_end - *_start;
ffc346bc: 7d 6b 48 10 subfc r11,r11,r9
ffc346c0: 7d 4a 41 10 subfe r10,r10,r8
ffc346c4: 91 5c 00 00 stw r10,0(r28)
ffc346c8: 91 7c 00 04 stw r11,4(r28)
if (used < the_period->cpu_usage_period_initiated)
return false;
*cpu_since_last_period = used - the_period->cpu_usage_period_initiated;
#endif
return true;
ffc346cc: 38 60 00 01 li r3,1
ffc346d0: 48 00 00 08 b ffc346d8 <_Rate_monotonic_Get_status+0xbc>
/*
* The cpu usage info was reset while executing. Can't
* determine a status.
*/
if (_Timestamp_Less_than(&used, &the_period->cpu_usage_period_initiated))
return false;
ffc346d4: 38 60 00 00 li r3,0
return false;
*cpu_since_last_period = used - the_period->cpu_usage_period_initiated;
#endif
return true;
}
ffc346d8: 39 61 00 28 addi r11,r1,40
ffc346dc: 48 01 fe 24 b ffc54500 <_restgpr_28_x>
ffc34a78 <_Rate_monotonic_Timeout>:
void _Rate_monotonic_Timeout(
Objects_Id id,
void *ignored
)
{
ffc34a78: 7c 2b 0b 78 mr r11,r1
ffc34a7c: 94 21 ff e0 stwu r1,-32(r1)
ffc34a80: 7c 08 02 a6 mflr r0
ffc34a84: 7c 64 1b 78 mr r4,r3
ffc34a88: 3c 60 00 00 lis r3,0
ffc34a8c: 48 01 fa 35 bl ffc544c0 <_savegpr_31>
ffc34a90: 38 63 6f 3c addi r3,r3,28476
ffc34a94: 90 01 00 24 stw r0,36(r1)
ffc34a98: 38 a1 00 08 addi r5,r1,8
ffc34a9c: 4b fd 51 61 bl ffc09bfc <_Objects_Get>
/*
* When we get here, the Timer is already off the chain so we do not
* have to worry about that -- hence no _Watchdog_Remove().
*/
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
ffc34aa0: 81 21 00 08 lwz r9,8(r1)
ffc34aa4: 2f 89 00 00 cmpwi cr7,r9,0
ffc34aa8: 40 9e 00 88 bne- cr7,ffc34b30 <_Rate_monotonic_Timeout+0xb8><== NEVER TAKEN
ffc34aac: 7c 7f 1b 78 mr r31,r3
case OBJECTS_LOCAL:
the_thread = the_period->owner;
ffc34ab0: 80 63 00 40 lwz r3,64(r3)
*/
RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period (
States_Control the_states
)
{
return (the_states & STATES_WAITING_FOR_PERIOD);
ffc34ab4: 81 23 00 10 lwz r9,16(r3)
if ( _States_Is_waiting_for_period( the_thread->current_state ) &&
ffc34ab8: 71 2a 40 00 andi. r10,r9,16384
ffc34abc: 41 82 00 24 beq- ffc34ae0 <_Rate_monotonic_Timeout+0x68>
ffc34ac0: 81 43 00 20 lwz r10,32(r3)
ffc34ac4: 81 3f 00 08 lwz r9,8(r31)
ffc34ac8: 7f 8a 48 00 cmpw cr7,r10,r9
ffc34acc: 40 be 00 14 bne+ cr7,ffc34ae0 <_Rate_monotonic_Timeout+0x68>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc34ad0: 3c 80 10 07 lis r4,4103
ffc34ad4: 60 84 ff f8 ori r4,r4,65528
ffc34ad8: 4b fd 5b 59 bl ffc0a630 <_Thread_Clear_state>
ffc34adc: 48 00 00 18 b ffc34af4 <_Rate_monotonic_Timeout+0x7c>
_Thread_Unblock( the_thread );
_Rate_monotonic_Initiate_statistics( the_period );
_Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length );
} else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) {
ffc34ae0: 81 3f 00 38 lwz r9,56(r31)
ffc34ae4: 2f 89 00 01 cmpwi cr7,r9,1
ffc34ae8: 40 be 00 30 bne+ cr7,ffc34b18 <_Rate_monotonic_Timeout+0xa0>
the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING;
ffc34aec: 39 20 00 03 li r9,3
ffc34af0: 91 3f 00 38 stw r9,56(r31)
_Rate_monotonic_Initiate_statistics( the_period );
ffc34af4: 7f e3 fb 78 mr r3,r31
ffc34af8: 4b ff fd 15 bl ffc3480c <_Rate_monotonic_Initiate_statistics>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc34afc: 81 3f 00 3c lwz r9,60(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc34b00: 3c 60 00 00 lis r3,0
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc34b04: 91 3f 00 1c stw r9,28(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc34b08: 38 63 65 28 addi r3,r3,25896
ffc34b0c: 38 9f 00 10 addi r4,r31,16
ffc34b10: 4b fd 6c ad bl ffc0b7bc <_Watchdog_Insert>
ffc34b14: 48 00 00 0c b ffc34b20 <_Rate_monotonic_Timeout+0xa8>
_Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length );
} else
the_period->state = RATE_MONOTONIC_EXPIRED;
ffc34b18: 39 20 00 04 li r9,4
ffc34b1c: 91 3f 00 38 stw r9,56(r31)
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc34b20: 3d 20 00 00 lis r9,0
ffc34b24: 81 49 34 e4 lwz r10,13540(r9)
--level;
ffc34b28: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc34b2c: 91 49 34 e4 stw r10,13540(r9)
case OBJECTS_REMOTE: /* impossible */
#endif
case OBJECTS_ERROR:
break;
}
}
ffc34b30: 39 61 00 20 addi r11,r1,32
ffc34b34: 48 01 f9 d8 b ffc5450c <_restgpr_31_x>
ffc346e0 <_Rate_monotonic_Update_statistics>:
}
static void _Rate_monotonic_Update_statistics(
Rate_monotonic_Control *the_period
)
{
ffc346e0: 7c 2b 0b 78 mr r11,r1
ffc346e4: 7c 08 02 a6 mflr r0
ffc346e8: 94 21 ff e0 stwu r1,-32(r1)
ffc346ec: 90 01 00 24 stw r0,36(r1)
ffc346f0: 48 01 fd d1 bl ffc544c0 <_savegpr_31>
ffc346f4: 7c 7f 1b 78 mr r31,r3
/*
* Update the counts.
*/
stats = &the_period->Statistics;
stats->count++;
ffc346f8: 81 23 00 58 lwz r9,88(r3)
ffc346fc: 39 29 00 01 addi r9,r9,1
ffc34700: 91 23 00 58 stw r9,88(r3)
if ( the_period->state == RATE_MONOTONIC_EXPIRED )
ffc34704: 81 23 00 38 lwz r9,56(r3)
ffc34708: 2f 89 00 04 cmpwi cr7,r9,4
ffc3470c: 40 be 00 10 bne+ cr7,ffc3471c <_Rate_monotonic_Update_statistics+0x3c>
stats->missed_count++;
ffc34710: 81 23 00 5c lwz r9,92(r3)
ffc34714: 39 29 00 01 addi r9,r9,1
ffc34718: 91 23 00 5c stw r9,92(r3)
/*
* Grab status for time statistics.
*/
valid_status =
ffc3471c: 7f e3 fb 78 mr r3,r31
ffc34720: 38 81 00 08 addi r4,r1,8
ffc34724: 38 a1 00 10 addi r5,r1,16
ffc34728: 4b ff fe f5 bl ffc3461c <_Rate_monotonic_Get_status>
_Rate_monotonic_Get_status( the_period, &since_last_period, &executed );
if (!valid_status)
ffc3472c: 2f 83 00 00 cmpwi cr7,r3,0
ffc34730: 41 9e 00 d4 beq- cr7,ffc34804 <_Rate_monotonic_Update_statistics+0x124>
/*
* Update CPU time
*/
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_Add_to( &stats->total_cpu_time, &executed );
ffc34734: 81 41 00 10 lwz r10,16(r1)
static inline void _Timestamp64_implementation_Add_to(
Timestamp64_Control *_time,
const Timestamp64_Control *_add
)
{
*_time += *_add;
ffc34738: 81 1f 00 70 lwz r8,112(r31)
ffc3473c: 81 3f 00 74 lwz r9,116(r31)
ffc34740: 81 61 00 14 lwz r11,20(r1)
ffc34744: 7d 29 58 14 addc r9,r9,r11
ffc34748: 7d 08 51 14 adde r8,r8,r10
ffc3474c: 91 3f 00 74 stw r9,116(r31)
if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) )
ffc34750: 81 3f 00 60 lwz r9,96(r31)
ffc34754: 91 1f 00 70 stw r8,112(r31)
ffc34758: 7f 89 50 00 cmpw cr7,r9,r10
ffc3475c: 41 9d 00 14 bgt- cr7,ffc34770 <_Rate_monotonic_Update_statistics+0x90>
ffc34760: 40 9e 00 18 bne- cr7,ffc34778 <_Rate_monotonic_Update_statistics+0x98><== NEVER TAKEN
ffc34764: 81 3f 00 64 lwz r9,100(r31)
ffc34768: 7f 89 58 40 cmplw cr7,r9,r11
ffc3476c: 40 9d 00 0c ble- cr7,ffc34778 <_Rate_monotonic_Update_statistics+0x98>
stats->min_cpu_time = executed;
ffc34770: 91 5f 00 60 stw r10,96(r31)
ffc34774: 91 7f 00 64 stw r11,100(r31)
if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) )
ffc34778: 81 3f 00 68 lwz r9,104(r31)
ffc3477c: 7f 89 50 00 cmpw cr7,r9,r10
ffc34780: 41 9c 00 14 blt- cr7,ffc34794 <_Rate_monotonic_Update_statistics+0xb4><== NEVER TAKEN
ffc34784: 40 9e 00 18 bne- cr7,ffc3479c <_Rate_monotonic_Update_statistics+0xbc><== NEVER TAKEN
ffc34788: 81 3f 00 6c lwz r9,108(r31)
ffc3478c: 7f 89 58 40 cmplw cr7,r9,r11
ffc34790: 40 9c 00 0c bge- cr7,ffc3479c <_Rate_monotonic_Update_statistics+0xbc>
stats->max_cpu_time = executed;
ffc34794: 91 5f 00 68 stw r10,104(r31)
ffc34798: 91 7f 00 6c stw r11,108(r31)
/*
* Update Wall time
*/
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_Add_to( &stats->total_wall_time, &since_last_period );
ffc3479c: 81 41 00 08 lwz r10,8(r1)
ffc347a0: 81 1f 00 88 lwz r8,136(r31)
ffc347a4: 81 3f 00 8c lwz r9,140(r31)
ffc347a8: 81 61 00 0c lwz r11,12(r1)
ffc347ac: 7d 29 58 14 addc r9,r9,r11
ffc347b0: 7d 08 51 14 adde r8,r8,r10
ffc347b4: 91 3f 00 8c stw r9,140(r31)
if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) )
ffc347b8: 81 3f 00 78 lwz r9,120(r31)
ffc347bc: 91 1f 00 88 stw r8,136(r31)
ffc347c0: 7f 89 50 00 cmpw cr7,r9,r10
ffc347c4: 41 9d 00 14 bgt- cr7,ffc347d8 <_Rate_monotonic_Update_statistics+0xf8>
ffc347c8: 40 9e 00 18 bne- cr7,ffc347e0 <_Rate_monotonic_Update_statistics+0x100><== NEVER TAKEN
ffc347cc: 81 3f 00 7c lwz r9,124(r31)
ffc347d0: 7f 89 58 40 cmplw cr7,r9,r11
ffc347d4: 40 9d 00 0c ble- cr7,ffc347e0 <_Rate_monotonic_Update_statistics+0x100>
stats->min_wall_time = since_last_period;
ffc347d8: 91 5f 00 78 stw r10,120(r31)
ffc347dc: 91 7f 00 7c stw r11,124(r31)
if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) )
ffc347e0: 81 3f 00 80 lwz r9,128(r31)
ffc347e4: 7f 89 50 00 cmpw cr7,r9,r10
ffc347e8: 41 bc 00 14 blt+ cr7,ffc347fc <_Rate_monotonic_Update_statistics+0x11c><== NEVER TAKEN
ffc347ec: 40 9e 00 18 bne- cr7,ffc34804 <_Rate_monotonic_Update_statistics+0x124>
ffc347f0: 81 3f 00 84 lwz r9,132(r31)
ffc347f4: 7f 89 58 40 cmplw cr7,r9,r11
ffc347f8: 40 9c 00 0c bge- cr7,ffc34804 <_Rate_monotonic_Update_statistics+0x124>
stats->max_wall_time = since_last_period;
ffc347fc: 91 5f 00 80 stw r10,128(r31)
ffc34800: 91 7f 00 84 stw r11,132(r31)
stats->min_wall_time = since_last_period;
if ( since_last_period > stats->max_wall_time )
stats->max_wall_time = since_last_period;
#endif
}
ffc34804: 39 61 00 20 addi r11,r1,32
ffc34808: 48 01 fd 04 b ffc5450c <_restgpr_31_x>
ffc0b0c8 <_Scheduler_CBS_Allocate>:
#include <rtems/score/wkspace.h>
void *_Scheduler_CBS_Allocate(
Thread_Control *the_thread
)
{
ffc0b0c8: 7c 2b 0b 78 mr r11,r1
ffc0b0cc: 94 21 ff f0 stwu r1,-16(r1)
ffc0b0d0: 7c 08 02 a6 mflr r0
ffc0b0d4: 48 01 17 9d bl ffc1c870 <_savegpr_31>
ffc0b0d8: 7c 7f 1b 78 mr r31,r3
void *sched;
Scheduler_CBS_Per_thread *schinfo;
sched = _Workspace_Allocate(sizeof(Scheduler_CBS_Per_thread));
ffc0b0dc: 38 60 00 1c li r3,28
#include <rtems/score/wkspace.h>
void *_Scheduler_CBS_Allocate(
Thread_Control *the_thread
)
{
ffc0b0e0: 90 01 00 14 stw r0,20(r1)
void *sched;
Scheduler_CBS_Per_thread *schinfo;
sched = _Workspace_Allocate(sizeof(Scheduler_CBS_Per_thread));
ffc0b0e4: 48 00 1c c9 bl ffc0cdac <_Workspace_Allocate>
if ( sched ) {
ffc0b0e8: 2c 03 00 00 cmpwi r3,0
ffc0b0ec: 41 82 00 1c beq- ffc0b108 <_Scheduler_CBS_Allocate+0x40><== NEVER TAKEN
the_thread->scheduler_info = sched;
schinfo = (Scheduler_CBS_Per_thread *)(the_thread->scheduler_info);
schinfo->edf_per_thread.thread = the_thread;
schinfo->edf_per_thread.queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN;
ffc0b0f0: 39 40 00 02 li r10,2
void *sched;
Scheduler_CBS_Per_thread *schinfo;
sched = _Workspace_Allocate(sizeof(Scheduler_CBS_Per_thread));
if ( sched ) {
the_thread->scheduler_info = sched;
ffc0b0f4: 90 7f 00 88 stw r3,136(r31)
schinfo = (Scheduler_CBS_Per_thread *)(the_thread->scheduler_info);
schinfo->edf_per_thread.thread = the_thread;
schinfo->edf_per_thread.queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN;
ffc0b0f8: 91 43 00 14 stw r10,20(r3)
schinfo->cbs_server = NULL;
ffc0b0fc: 39 40 00 00 li r10,0
sched = _Workspace_Allocate(sizeof(Scheduler_CBS_Per_thread));
if ( sched ) {
the_thread->scheduler_info = sched;
schinfo = (Scheduler_CBS_Per_thread *)(the_thread->scheduler_info);
schinfo->edf_per_thread.thread = the_thread;
ffc0b100: 93 e3 00 00 stw r31,0(r3)
schinfo->edf_per_thread.queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN;
schinfo->cbs_server = NULL;
ffc0b104: 91 43 00 18 stw r10,24(r3)
}
return sched;
}
ffc0b108: 39 61 00 10 addi r11,r1,16
ffc0b10c: 4b ff 5a c0 b ffc00bcc <_restgpr_31_x>
ffc0c784 <_Scheduler_CBS_Budget_callout>:
Scheduler_CBS_Server **_Scheduler_CBS_Server_list;
void _Scheduler_CBS_Budget_callout(
Thread_Control *the_thread
)
{
ffc0c784: 7c 2b 0b 78 mr r11,r1
ffc0c788: 7c 08 02 a6 mflr r0
ffc0c78c: 94 21 ff e0 stwu r1,-32(r1)
ffc0c790: 90 01 00 24 stw r0,36(r1)
ffc0c794: 48 01 17 f1 bl ffc1df84 <_savegpr_31>
ffc0c798: 7c 7f 1b 78 mr r31,r3
Priority_Control new_priority;
Scheduler_CBS_Per_thread *sched_info;
Scheduler_CBS_Server_id server_id;
/* Put violating task to background until the end of period. */
new_priority = the_thread->Start.initial_priority;
ffc0c79c: 80 83 00 ac lwz r4,172(r3)
if ( the_thread->real_priority != new_priority )
ffc0c7a0: 81 23 00 18 lwz r9,24(r3)
ffc0c7a4: 7f 89 20 00 cmpw cr7,r9,r4
ffc0c7a8: 41 9e 00 08 beq- cr7,ffc0c7b0 <_Scheduler_CBS_Budget_callout+0x2c><== NEVER TAKEN
the_thread->real_priority = new_priority;
ffc0c7ac: 90 83 00 18 stw r4,24(r3)
if ( the_thread->current_priority != new_priority )
ffc0c7b0: 81 3f 00 14 lwz r9,20(r31)
ffc0c7b4: 7f 89 20 00 cmpw cr7,r9,r4
ffc0c7b8: 41 9e 00 10 beq- cr7,ffc0c7c8 <_Scheduler_CBS_Budget_callout+0x44><== NEVER TAKEN
_Thread_Change_priority(the_thread, new_priority, true);
ffc0c7bc: 7f e3 fb 78 mr r3,r31
ffc0c7c0: 38 a0 00 01 li r5,1
ffc0c7c4: 48 00 06 69 bl ffc0ce2c <_Thread_Change_priority>
/* Invoke callback function if any. */
sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
ffc0c7c8: 83 ff 00 88 lwz r31,136(r31)
if ( sched_info->cbs_server->cbs_budget_overrun ) {
ffc0c7cc: 81 3f 00 18 lwz r9,24(r31)
ffc0c7d0: 81 49 00 0c lwz r10,12(r9)
ffc0c7d4: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0c7d8: 41 9e 00 24 beq- cr7,ffc0c7fc <_Scheduler_CBS_Budget_callout+0x78><== NEVER TAKEN
_Scheduler_CBS_Get_server_id(
ffc0c7dc: 80 69 00 00 lwz r3,0(r9)
ffc0c7e0: 38 81 00 08 addi r4,r1,8
ffc0c7e4: 4b ff ff 49 bl ffc0c72c <_Scheduler_CBS_Get_server_id>
sched_info->cbs_server->task_id,
&server_id
);
sched_info->cbs_server->cbs_budget_overrun( server_id );
ffc0c7e8: 81 3f 00 18 lwz r9,24(r31)
ffc0c7ec: 80 61 00 08 lwz r3,8(r1)
ffc0c7f0: 81 29 00 0c lwz r9,12(r9)
ffc0c7f4: 7d 29 03 a6 mtctr r9
ffc0c7f8: 4e 80 04 21 bctrl
}
}
ffc0c7fc: 39 61 00 20 addi r11,r1,32
ffc0c800: 4b ff 50 b8 b ffc018b8 <_restgpr_31_x>
ffc0c340 <_Scheduler_CBS_Create_server>:
int _Scheduler_CBS_Create_server (
Scheduler_CBS_Parameters *params,
Scheduler_CBS_Budget_overrun budget_overrun_callback,
rtems_id *server_id
)
{
ffc0c340: 94 21 ff e0 stwu r1,-32(r1)
ffc0c344: 7c 08 02 a6 mflr r0
ffc0c348: 90 01 00 24 stw r0,36(r1)
unsigned int i;
Scheduler_CBS_Server *the_server;
if ( params->budget <= 0 ||
ffc0c34c: 81 23 00 04 lwz r9,4(r3)
int _Scheduler_CBS_Create_server (
Scheduler_CBS_Parameters *params,
Scheduler_CBS_Budget_overrun budget_overrun_callback,
rtems_id *server_id
)
{
ffc0c350: bf 41 00 08 stmw r26,8(r1)
ffc0c354: 7c 7f 1b 78 mr r31,r3
unsigned int i;
Scheduler_CBS_Server *the_server;
if ( params->budget <= 0 ||
ffc0c358: 2f 89 00 00 cmpwi cr7,r9,0
ffc0c35c: 40 9d 00 7c ble- cr7,ffc0c3d8 <_Scheduler_CBS_Create_server+0x98>
ffc0c360: 81 23 00 00 lwz r9,0(r3)
ffc0c364: 2f 89 00 00 cmpwi cr7,r9,0
ffc0c368: 40 9d 00 70 ble- cr7,ffc0c3d8 <_Scheduler_CBS_Create_server+0x98>
params->deadline <= 0 ||
params->budget >= SCHEDULER_EDF_PRIO_MSB ||
params->deadline >= SCHEDULER_EDF_PRIO_MSB )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) {
ffc0c36c: 3d 20 00 00 lis r9,0
ffc0c370: 81 49 27 d4 lwz r10,10196(r9)
if ( !_Scheduler_CBS_Server_list[i] )
ffc0c374: 3d 20 00 00 lis r9,0
ffc0c378: 81 09 28 f4 lwz r8,10484(r9)
ffc0c37c: 7c 9a 23 78 mr r26,r4
ffc0c380: 39 4a 00 01 addi r10,r10,1
ffc0c384: 7c bd 2b 78 mr r29,r5
ffc0c388: 7d 49 03 a6 mtctr r10
ffc0c38c: 39 20 00 00 li r9,0
ffc0c390: 48 00 00 18 b ffc0c3a8 <_Scheduler_CBS_Create_server+0x68>
#include <rtems/system.h>
#include <rtems/config.h>
#include <rtems/score/scheduler.h>
#include <rtems/score/schedulercbs.h>
int _Scheduler_CBS_Create_server (
ffc0c394: 55 3c 10 3a rlwinm r28,r9,2,0,29
params->budget >= SCHEDULER_EDF_PRIO_MSB ||
params->deadline >= SCHEDULER_EDF_PRIO_MSB )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) {
if ( !_Scheduler_CBS_Server_list[i] )
ffc0c398: 7d 48 e0 2e lwzx r10,r8,r28
ffc0c39c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0c3a0: 41 9e 00 48 beq- cr7,ffc0c3e8 <_Scheduler_CBS_Create_server+0xa8>
params->deadline <= 0 ||
params->budget >= SCHEDULER_EDF_PRIO_MSB ||
params->deadline >= SCHEDULER_EDF_PRIO_MSB )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) {
ffc0c3a4: 39 29 00 01 addi r9,r9,1
ffc0c3a8: 42 00 ff ec bdnz+ ffc0c394 <_Scheduler_CBS_Create_server+0x54>
if ( !_Scheduler_CBS_Server_list[i] )
break;
}
if ( i == _Scheduler_CBS_Maximum_servers )
return SCHEDULER_CBS_ERROR_FULL;
ffc0c3ac: 38 60 ff e6 li r3,-26
ffc0c3b0: 48 00 00 6c b ffc0c41c <_Scheduler_CBS_Create_server+0xdc>
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
the_server = _Scheduler_CBS_Server_list[*server_id];
if ( !the_server )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
the_server->parameters = *params;
ffc0c3b4: 81 5f 00 00 lwz r10,0(r31)
the_server->task_id = -1;
the_server->cbs_budget_overrun = budget_overrun_callback;
return SCHEDULER_CBS_OK;
ffc0c3b8: 38 60 00 00 li r3,0
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
the_server = _Scheduler_CBS_Server_list[*server_id];
if ( !the_server )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
the_server->parameters = *params;
ffc0c3bc: 81 7f 00 04 lwz r11,4(r31)
ffc0c3c0: 91 49 00 04 stw r10,4(r9)
the_server->task_id = -1;
ffc0c3c4: 39 40 ff ff li r10,-1
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
the_server = _Scheduler_CBS_Server_list[*server_id];
if ( !the_server )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
the_server->parameters = *params;
ffc0c3c8: 91 69 00 08 stw r11,8(r9)
the_server->task_id = -1;
ffc0c3cc: 91 49 00 00 stw r10,0(r9)
the_server->cbs_budget_overrun = budget_overrun_callback;
ffc0c3d0: 93 49 00 0c stw r26,12(r9)
return SCHEDULER_CBS_OK;
ffc0c3d4: 48 00 00 48 b ffc0c41c <_Scheduler_CBS_Create_server+0xdc>
if ( params->budget <= 0 ||
params->deadline <= 0 ||
params->budget >= SCHEDULER_EDF_PRIO_MSB ||
params->deadline >= SCHEDULER_EDF_PRIO_MSB )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
ffc0c3d8: 38 60 ff ee li r3,-18
ffc0c3dc: 48 00 00 40 b ffc0c41c <_Scheduler_CBS_Create_server+0xdc>
*server_id = i;
_Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *)
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
the_server = _Scheduler_CBS_Server_list[*server_id];
if ( !the_server )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
ffc0c3e0: 38 60 ff ef li r3,-17 <== NOT EXECUTED
ffc0c3e4: 48 00 00 38 b ffc0c41c <_Scheduler_CBS_Create_server+0xdc><== NOT EXECUTED
}
if ( i == _Scheduler_CBS_Maximum_servers )
return SCHEDULER_CBS_ERROR_FULL;
*server_id = i;
ffc0c3e8: 91 3d 00 00 stw r9,0(r29)
_Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *)
ffc0c3ec: 3f c0 00 00 lis r30,0
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
ffc0c3f0: 38 60 00 10 li r3,16
if ( i == _Scheduler_CBS_Maximum_servers )
return SCHEDULER_CBS_ERROR_FULL;
*server_id = i;
_Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *)
ffc0c3f4: 83 7e 28 f4 lwz r27,10484(r30)
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
ffc0c3f8: 48 00 20 c9 bl ffc0e4c0 <_Workspace_Allocate>
the_server = _Scheduler_CBS_Server_list[*server_id];
ffc0c3fc: 81 3d 00 00 lwz r9,0(r29)
if ( i == _Scheduler_CBS_Maximum_servers )
return SCHEDULER_CBS_ERROR_FULL;
*server_id = i;
_Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *)
ffc0c400: 7c 7b e1 2e stwx r3,r27,r28
_Workspace_Allocate( sizeof(Scheduler_CBS_Server) );
the_server = _Scheduler_CBS_Server_list[*server_id];
ffc0c404: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0c408: 81 5e 28 f4 lwz r10,10484(r30)
ffc0c40c: 7d 2a 48 2e lwzx r9,r10,r9
if ( !the_server )
ffc0c410: 2f 89 00 00 cmpwi cr7,r9,0
ffc0c414: 40 9e ff a0 bne+ cr7,ffc0c3b4 <_Scheduler_CBS_Create_server+0x74><== ALWAYS TAKEN
ffc0c418: 4b ff ff c8 b ffc0c3e0 <_Scheduler_CBS_Create_server+0xa0><== NOT EXECUTED
the_server->parameters = *params;
the_server->task_id = -1;
the_server->cbs_budget_overrun = budget_overrun_callback;
return SCHEDULER_CBS_OK;
}
ffc0c41c: 39 61 00 20 addi r11,r1,32
ffc0c420: 4b ff 54 84 b ffc018a4 <_restgpr_26_x>
ffc0c4a8 <_Scheduler_CBS_Detach_thread>:
int _Scheduler_CBS_Detach_thread (
Scheduler_CBS_Server_id server_id,
rtems_id task_id
)
{
ffc0c4a8: 94 21 ff d8 stwu r1,-40(r1)
ffc0c4ac: 7c 08 02 a6 mflr r0
ffc0c4b0: bf a1 00 1c stmw r29,28(r1)
ffc0c4b4: 7c 7d 1b 78 mr r29,r3
ffc0c4b8: 7c 9e 23 78 mr r30,r4
Objects_Locations location;
Thread_Control *the_thread;
Scheduler_CBS_Per_thread *sched_info;
the_thread = _Thread_Get(task_id, &location);
ffc0c4bc: 7c 83 23 78 mr r3,r4
int _Scheduler_CBS_Detach_thread (
Scheduler_CBS_Server_id server_id,
rtems_id task_id
)
{
ffc0c4c0: 90 01 00 2c stw r0,44(r1)
Objects_Locations location;
Thread_Control *the_thread;
Scheduler_CBS_Per_thread *sched_info;
the_thread = _Thread_Get(task_id, &location);
ffc0c4c4: 38 81 00 08 addi r4,r1,8
ffc0c4c8: 48 00 0e c5 bl ffc0d38c <_Thread_Get>
/* The routine _Thread_Get may disable dispatch and not enable again. */
if ( the_thread ) {
ffc0c4cc: 7c 7f 1b 79 mr. r31,r3
ffc0c4d0: 41 82 00 08 beq- ffc0c4d8 <_Scheduler_CBS_Detach_thread+0x30>
_Thread_Enable_dispatch();
ffc0c4d4: 48 00 0e 9d bl ffc0d370 <_Thread_Enable_dispatch>
}
if ( server_id >= _Scheduler_CBS_Maximum_servers )
ffc0c4d8: 3d 20 00 00 lis r9,0
ffc0c4dc: 81 29 27 d4 lwz r9,10196(r9)
ffc0c4e0: 7f 9d 48 40 cmplw cr7,r29,r9
ffc0c4e4: 40 9c 00 6c bge- cr7,ffc0c550 <_Scheduler_CBS_Detach_thread+0xa8>
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
if ( !the_thread )
ffc0c4e8: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0c4ec: 41 9e 00 64 beq- cr7,ffc0c550 <_Scheduler_CBS_Detach_thread+0xa8>
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
/* Server is not valid. */
if ( !_Scheduler_CBS_Server_list[server_id] )
ffc0c4f0: 3d 20 00 00 lis r9,0
ffc0c4f4: 81 29 28 f4 lwz r9,10484(r9)
ffc0c4f8: 57 bd 10 3a rlwinm r29,r29,2,0,29
ffc0c4fc: 7d 29 e8 2e lwzx r9,r9,r29
ffc0c500: 2f 89 00 00 cmpwi cr7,r9,0
ffc0c504: 41 9e 00 44 beq- cr7,ffc0c548 <_Scheduler_CBS_Detach_thread+0xa0>
return SCHEDULER_CBS_ERROR_NOSERVER;
/* Thread and server are not attached. */
if ( _Scheduler_CBS_Server_list[server_id]->task_id != task_id )
ffc0c508: 81 49 00 00 lwz r10,0(r9)
ffc0c50c: 7f 8a f0 00 cmpw cr7,r10,r30
ffc0c510: 40 9e 00 40 bne- cr7,ffc0c550 <_Scheduler_CBS_Detach_thread+0xa8><== NEVER TAKEN
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
_Scheduler_CBS_Server_list[server_id]->task_id = -1;
ffc0c514: 39 40 ff ff li r10,-1
ffc0c518: 91 49 00 00 stw r10,0(r9)
sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
sched_info->cbs_server = NULL;
ffc0c51c: 39 40 00 00 li r10,0
the_thread->budget_algorithm = the_thread->Start.budget_algorithm;
the_thread->budget_callout = the_thread->Start.budget_callout;
the_thread->is_preemptible = the_thread->Start.is_preemptible;
return SCHEDULER_CBS_OK;
ffc0c520: 38 60 00 00 li r3,0
if ( _Scheduler_CBS_Server_list[server_id]->task_id != task_id )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
_Scheduler_CBS_Server_list[server_id]->task_id = -1;
sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
sched_info->cbs_server = NULL;
ffc0c524: 81 3f 00 88 lwz r9,136(r31)
ffc0c528: 91 49 00 18 stw r10,24(r9)
the_thread->budget_algorithm = the_thread->Start.budget_algorithm;
ffc0c52c: 81 3f 00 a0 lwz r9,160(r31)
ffc0c530: 91 3f 00 78 stw r9,120(r31)
the_thread->budget_callout = the_thread->Start.budget_callout;
ffc0c534: 81 3f 00 a4 lwz r9,164(r31)
ffc0c538: 91 3f 00 7c stw r9,124(r31)
the_thread->is_preemptible = the_thread->Start.is_preemptible;
ffc0c53c: 89 3f 00 9c lbz r9,156(r31)
ffc0c540: 99 3f 00 70 stb r9,112(r31)
ffc0c544: 48 00 00 10 b ffc0c554 <_Scheduler_CBS_Detach_thread+0xac>
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
if ( !the_thread )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
/* Server is not valid. */
if ( !_Scheduler_CBS_Server_list[server_id] )
return SCHEDULER_CBS_ERROR_NOSERVER;
ffc0c548: 38 60 ff e7 li r3,-25
ffc0c54c: 48 00 00 08 b ffc0c554 <_Scheduler_CBS_Detach_thread+0xac>
if ( the_thread ) {
_Thread_Enable_dispatch();
}
if ( server_id >= _Scheduler_CBS_Maximum_servers )
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
ffc0c550: 38 60 ff ee li r3,-18
the_thread->budget_algorithm = the_thread->Start.budget_algorithm;
the_thread->budget_callout = the_thread->Start.budget_callout;
the_thread->is_preemptible = the_thread->Start.is_preemptible;
return SCHEDULER_CBS_OK;
}
ffc0c554: 39 61 00 28 addi r11,r1,40
ffc0c558: 4b ff 53 58 b ffc018b0 <_restgpr_29_x>
ffc0c804 <_Scheduler_CBS_Initialize>:
int _Scheduler_CBS_Initialize(void)
{
ffc0c804: 7c 2b 0b 78 mr r11,r1
ffc0c808: 94 21 ff f0 stwu r1,-16(r1)
ffc0c80c: 7c 08 02 a6 mflr r0
ffc0c810: 48 01 17 75 bl ffc1df84 <_savegpr_31>
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
ffc0c814: 3f e0 00 00 lis r31,0
ffc0c818: 80 7f 27 d4 lwz r3,10196(r31)
sched_info->cbs_server->cbs_budget_overrun( server_id );
}
}
int _Scheduler_CBS_Initialize(void)
{
ffc0c81c: 90 01 00 14 stw r0,20(r1)
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
ffc0c820: 54 63 10 3a rlwinm r3,r3,2,0,29
ffc0c824: 48 00 1c 9d bl ffc0e4c0 <_Workspace_Allocate>
ffc0c828: 3d 40 00 00 lis r10,0
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
if ( !_Scheduler_CBS_Server_list )
ffc0c82c: 2f 83 00 00 cmpwi cr7,r3,0
}
int _Scheduler_CBS_Initialize(void)
{
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
ffc0c830: 90 6a 28 f4 stw r3,10484(r10)
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
if ( !_Scheduler_CBS_Server_list )
ffc0c834: 41 9e 00 38 beq- cr7,ffc0c86c <_Scheduler_CBS_Initialize+0x68><== NEVER TAKEN
return SCHEDULER_CBS_ERROR_NO_MEMORY;
for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) {
ffc0c838: 81 1f 27 d4 lwz r8,10196(r31)
ffc0c83c: 39 20 00 00 li r9,0
_Scheduler_CBS_Server_list[i] = NULL;
ffc0c840: 38 e0 00 00 li r7,0
ffc0c844: 39 08 00 01 addi r8,r8,1
ffc0c848: 7d 09 03 a6 mtctr r8
ffc0c84c: 48 00 00 14 b ffc0c860 <_Scheduler_CBS_Initialize+0x5c>
ffc0c850: 81 0a 28 f4 lwz r8,10484(r10)
ffc0c854: 55 26 10 3a rlwinm r6,r9,2,0,29
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
if ( !_Scheduler_CBS_Server_list )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) {
ffc0c858: 39 29 00 01 addi r9,r9,1
_Scheduler_CBS_Server_list[i] = NULL;
ffc0c85c: 7c e8 31 2e stwx r7,r8,r6
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
if ( !_Scheduler_CBS_Server_list )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) {
ffc0c860: 42 00 ff f0 bdnz+ ffc0c850 <_Scheduler_CBS_Initialize+0x4c>
_Scheduler_CBS_Server_list[i] = NULL;
}
return SCHEDULER_CBS_OK;
ffc0c864: 38 60 00 00 li r3,0
ffc0c868: 48 00 00 08 b ffc0c870 <_Scheduler_CBS_Initialize+0x6c>
{
unsigned int i;
_Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
_Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
if ( !_Scheduler_CBS_Server_list )
return SCHEDULER_CBS_ERROR_NO_MEMORY;
ffc0c86c: 38 60 ff ef li r3,-17 <== NOT EXECUTED
for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) {
_Scheduler_CBS_Server_list[i] = NULL;
}
return SCHEDULER_CBS_OK;
}
ffc0c870: 39 61 00 10 addi r11,r1,16
ffc0c874: 4b ff 50 44 b ffc018b8 <_restgpr_31_x>
ffc0b110 <_Scheduler_CBS_Release_job>:
Scheduler_CBS_Per_thread *sched_info =
(Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
Scheduler_CBS_Server *serv_info =
(Scheduler_CBS_Server *) sched_info->cbs_server;
if (deadline) {
ffc0b110: 2c 04 00 00 cmpwi r4,0
{
Priority_Control new_priority;
Scheduler_CBS_Per_thread *sched_info =
(Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
Scheduler_CBS_Server *serv_info =
(Scheduler_CBS_Server *) sched_info->cbs_server;
ffc0b114: 81 23 00 88 lwz r9,136(r3)
)
{
Priority_Control new_priority;
Scheduler_CBS_Per_thread *sched_info =
(Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
Scheduler_CBS_Server *serv_info =
ffc0b118: 81 29 00 18 lwz r9,24(r9)
ffc0b11c: 2f 89 00 00 cmpwi cr7,r9,0
(Scheduler_CBS_Server *) sched_info->cbs_server;
if (deadline) {
ffc0b120: 41 82 00 30 beq- ffc0b150 <_Scheduler_CBS_Release_job+0x40>
ffc0b124: 3d 40 00 00 lis r10,0
/* Initializing or shifting deadline. */
if (serv_info)
ffc0b128: 41 9e 00 18 beq- cr7,ffc0b140 <_Scheduler_CBS_Release_job+0x30>
new_priority = (_Watchdog_Ticks_since_boot + serv_info->parameters.deadline)
ffc0b12c: 80 8a 28 e8 lwz r4,10472(r10)
ffc0b130: 81 49 00 04 lwz r10,4(r9)
ffc0b134: 7c 84 52 14 add r4,r4,r10
ffc0b138: 54 84 00 7e clrlwi r4,r4,1
ffc0b13c: 48 00 00 1c b ffc0b158 <_Scheduler_CBS_Release_job+0x48>
& ~SCHEDULER_EDF_PRIO_MSB;
else
new_priority = (_Watchdog_Ticks_since_boot + deadline)
ffc0b140: 81 2a 28 e8 lwz r9,10472(r10)
ffc0b144: 7c 84 4a 14 add r4,r4,r9
ffc0b148: 54 84 00 7e clrlwi r4,r4,1
ffc0b14c: 48 00 00 14 b ffc0b160 <_Scheduler_CBS_Release_job+0x50>
& ~SCHEDULER_EDF_PRIO_MSB;
}
else {
/* Switch back to background priority. */
new_priority = the_thread->Start.initial_priority;
ffc0b150: 80 83 00 ac lwz r4,172(r3)
}
/* Budget replenishment for the next job. */
if (serv_info)
ffc0b154: 41 9e 00 0c beq- cr7,ffc0b160 <_Scheduler_CBS_Release_job+0x50><== NEVER TAKEN
the_thread->cpu_time_budget = serv_info->parameters.budget;
ffc0b158: 81 29 00 08 lwz r9,8(r9)
ffc0b15c: 91 23 00 74 stw r9,116(r3)
the_thread->real_priority = new_priority;
ffc0b160: 90 83 00 18 stw r4,24(r3)
_Thread_Change_priority(the_thread, new_priority, true);
ffc0b164: 38 a0 00 01 li r5,1
ffc0b168: 48 00 04 f4 b ffc0b65c <_Thread_Change_priority>
ffc0b16c <_Scheduler_CBS_Unblock>:
#include <rtems/score/schedulercbs.h>
void _Scheduler_CBS_Unblock(
Thread_Control *the_thread
)
{
ffc0b16c: 94 21 ff f0 stwu r1,-16(r1)
ffc0b170: 7c 08 02 a6 mflr r0
ffc0b174: bf c1 00 08 stmw r30,8(r1)
ffc0b178: 7c 7f 1b 78 mr r31,r3
ffc0b17c: 90 01 00 14 stw r0,20(r1)
Scheduler_CBS_Per_thread *sched_info;
Scheduler_CBS_Server *serv_info;
Priority_Control new_priority;
_Scheduler_EDF_Enqueue(the_thread);
ffc0b180: 48 00 01 1d bl ffc0b29c <_Scheduler_EDF_Enqueue>
/* TODO: flash critical section? */
sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
serv_info = (Scheduler_CBS_Server *) sched_info->cbs_server;
ffc0b184: 81 3f 00 88 lwz r9,136(r31)
ffc0b188: 81 29 00 18 lwz r9,24(r9)
* Late unblock rule for deadline-driven tasks. The remaining time to
* deadline must be sufficient to serve the remaining computation time
* without increased utilization of this task. It might cause a deadline
* miss of another task.
*/
if (serv_info) {
ffc0b18c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b190: 41 9e 00 58 beq- cr7,ffc0b1e8 <_Scheduler_CBS_Unblock+0x7c>
time_t deadline = serv_info->parameters.deadline;
time_t budget = serv_info->parameters.budget;
time_t deadline_left = the_thread->cpu_time_budget;
time_t budget_left = the_thread->real_priority -
ffc0b194: 3d 00 00 00 lis r8,0
ffc0b198: 81 5f 00 18 lwz r10,24(r31)
ffc0b19c: 80 e8 28 e8 lwz r7,10472(r8)
_Watchdog_Ticks_since_boot;
if ( deadline*budget_left > budget*deadline_left ) {
ffc0b1a0: 81 09 00 04 lwz r8,4(r9)
*/
if (serv_info) {
time_t deadline = serv_info->parameters.deadline;
time_t budget = serv_info->parameters.budget;
time_t deadline_left = the_thread->cpu_time_budget;
time_t budget_left = the_thread->real_priority -
ffc0b1a4: 7c e7 50 50 subf r7,r7,r10
_Watchdog_Ticks_since_boot;
if ( deadline*budget_left > budget*deadline_left ) {
ffc0b1a8: 7d 07 41 d6 mullw r8,r7,r8
ffc0b1ac: 80 e9 00 08 lwz r7,8(r9)
ffc0b1b0: 81 3f 00 74 lwz r9,116(r31)
ffc0b1b4: 7d 27 49 d6 mullw r9,r7,r9
ffc0b1b8: 7f 88 48 00 cmpw cr7,r8,r9
ffc0b1bc: 40 9d 00 2c ble- cr7,ffc0b1e8 <_Scheduler_CBS_Unblock+0x7c>
/* Put late unblocked task to background until the end of period. */
new_priority = the_thread->Start.initial_priority;
ffc0b1c0: 80 9f 00 ac lwz r4,172(r31)
if ( the_thread->real_priority != new_priority )
ffc0b1c4: 7f 8a 20 00 cmpw cr7,r10,r4
ffc0b1c8: 41 9e 00 08 beq- cr7,ffc0b1d0 <_Scheduler_CBS_Unblock+0x64>
the_thread->real_priority = new_priority;
ffc0b1cc: 90 9f 00 18 stw r4,24(r31)
if ( the_thread->current_priority != new_priority )
ffc0b1d0: 81 3f 00 14 lwz r9,20(r31)
ffc0b1d4: 7f 89 20 00 cmpw cr7,r9,r4
ffc0b1d8: 41 9e 00 10 beq- cr7,ffc0b1e8 <_Scheduler_CBS_Unblock+0x7c>
_Thread_Change_priority(the_thread, new_priority, true);
ffc0b1dc: 7f e3 fb 78 mr r3,r31
ffc0b1e0: 38 a0 00 01 li r5,1
ffc0b1e4: 48 00 04 79 bl ffc0b65c <_Thread_Change_priority>
* a context switch.
* Pseudo-ISR case:
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_higher_than( the_thread->current_priority,
ffc0b1e8: 3f c0 00 00 lis r30,0
ffc0b1ec: 80 7f 00 14 lwz r3,20(r31)
ffc0b1f0: 3b de 32 40 addi r30,r30,12864
ffc0b1f4: 3d 40 00 00 lis r10,0
ffc0b1f8: 81 3e 00 14 lwz r9,20(r30)
ffc0b1fc: 81 4a 20 b0 lwz r10,8368(r10)
ffc0b200: 80 89 00 14 lwz r4,20(r9)
ffc0b204: 7d 49 03 a6 mtctr r10
ffc0b208: 4e 80 04 21 bctrl
ffc0b20c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b210: 40 9d 00 34 ble- cr7,ffc0b244 <_Scheduler_CBS_Unblock+0xd8>
_Thread_Heir->current_priority)) {
_Thread_Heir = the_thread;
if ( _Thread_Executing->is_preemptible ||
ffc0b214: 81 3e 00 10 lwz r9,16(r30)
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_higher_than( the_thread->current_priority,
_Thread_Heir->current_priority)) {
_Thread_Heir = the_thread;
ffc0b218: 93 fe 00 14 stw r31,20(r30)
if ( _Thread_Executing->is_preemptible ||
ffc0b21c: 89 29 00 70 lbz r9,112(r9)
ffc0b220: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b224: 40 9e 00 10 bne- cr7,ffc0b234 <_Scheduler_CBS_Unblock+0xc8>
ffc0b228: 81 3f 00 14 lwz r9,20(r31)
ffc0b22c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b230: 40 9e 00 14 bne- cr7,ffc0b244 <_Scheduler_CBS_Unblock+0xd8><== ALWAYS TAKEN
the_thread->current_priority == 0 )
_Thread_Dispatch_necessary = true;
ffc0b234: 3d 20 00 00 lis r9,0
ffc0b238: 39 40 00 01 li r10,1
ffc0b23c: 39 29 32 40 addi r9,r9,12864
ffc0b240: 99 49 00 0c stb r10,12(r9)
}
}
ffc0b244: 39 61 00 10 addi r11,r1,16
ffc0b248: 4b ff 59 80 b ffc00bc8 <_restgpr_30_x>
ffc0b0c8 <_Scheduler_EDF_Allocate>:
#include <rtems/score/wkspace.h>
void *_Scheduler_EDF_Allocate(
Thread_Control *the_thread
)
{
ffc0b0c8: 7c 2b 0b 78 mr r11,r1
ffc0b0cc: 94 21 ff f0 stwu r1,-16(r1)
ffc0b0d0: 7c 08 02 a6 mflr r0
ffc0b0d4: 48 01 17 01 bl ffc1c7d4 <_savegpr_31>
ffc0b0d8: 7c 7f 1b 78 mr r31,r3
void *sched;
Scheduler_EDF_Per_thread *schinfo;
sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) );
ffc0b0dc: 38 60 00 18 li r3,24
#include <rtems/score/wkspace.h>
void *_Scheduler_EDF_Allocate(
Thread_Control *the_thread
)
{
ffc0b0e0: 90 01 00 14 stw r0,20(r1)
void *sched;
Scheduler_EDF_Per_thread *schinfo;
sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) );
ffc0b0e4: 48 00 1c 2d bl ffc0cd10 <_Workspace_Allocate>
if ( sched ) {
ffc0b0e8: 2c 03 00 00 cmpwi r3,0
ffc0b0ec: 41 82 00 14 beq- ffc0b100 <_Scheduler_EDF_Allocate+0x38><== NEVER TAKEN
the_thread->scheduler_info = sched;
schinfo = (Scheduler_EDF_Per_thread *)(the_thread->scheduler_info);
schinfo->thread = the_thread;
schinfo->queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN;
ffc0b0f0: 39 40 00 02 li r10,2
Scheduler_EDF_Per_thread *schinfo;
sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) );
if ( sched ) {
the_thread->scheduler_info = sched;
ffc0b0f4: 90 7f 00 88 stw r3,136(r31)
schinfo = (Scheduler_EDF_Per_thread *)(the_thread->scheduler_info);
schinfo->thread = the_thread;
ffc0b0f8: 93 e3 00 00 stw r31,0(r3)
schinfo->queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN;
ffc0b0fc: 91 43 00 14 stw r10,20(r3)
}
return sched;
}
ffc0b100: 39 61 00 10 addi r11,r1,16
ffc0b104: 4b ff 5a c8 b ffc00bcc <_restgpr_31_x>
ffc0b2c8 <_Scheduler_EDF_Unblock>:
#include <rtems/score/scheduleredf.h>
void _Scheduler_EDF_Unblock(
Thread_Control *the_thread
)
{
ffc0b2c8: 94 21 ff f0 stwu r1,-16(r1)
ffc0b2cc: 7c 08 02 a6 mflr r0
ffc0b2d0: bf c1 00 08 stmw r30,8(r1)
* a context switch.
* Pseudo-ISR case:
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_lower_than(
ffc0b2d4: 3f c0 00 00 lis r30,0
#include <rtems/score/scheduleredf.h>
void _Scheduler_EDF_Unblock(
Thread_Control *the_thread
)
{
ffc0b2d8: 7c 7f 1b 78 mr r31,r3
ffc0b2dc: 90 01 00 14 stw r0,20(r1)
* a context switch.
* Pseudo-ISR case:
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_lower_than(
ffc0b2e0: 3b de 32 40 addi r30,r30,12864
void _Scheduler_EDF_Unblock(
Thread_Control *the_thread
)
{
_Scheduler_EDF_Enqueue(the_thread);
ffc0b2e4: 4b ff fe 75 bl ffc0b158 <_Scheduler_EDF_Enqueue>
ffc0b2e8: 3d 20 00 00 lis r9,0
* a context switch.
* Pseudo-ISR case:
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_lower_than(
ffc0b2ec: 81 5e 00 14 lwz r10,20(r30)
ffc0b2f0: 81 29 20 b0 lwz r9,8368(r9)
ffc0b2f4: 80 6a 00 14 lwz r3,20(r10)
ffc0b2f8: 80 9f 00 14 lwz r4,20(r31)
ffc0b2fc: 7d 29 03 a6 mtctr r9
ffc0b300: 4e 80 04 21 bctrl
ffc0b304: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b308: 40 bc 00 34 bge+ cr7,ffc0b33c <_Scheduler_EDF_Unblock+0x74>
_Thread_Heir->current_priority,
the_thread->current_priority )) {
_Thread_Heir = the_thread;
if ( _Thread_Executing->is_preemptible ||
ffc0b30c: 81 3e 00 10 lwz r9,16(r30)
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( _Scheduler_Is_priority_lower_than(
_Thread_Heir->current_priority,
the_thread->current_priority )) {
_Thread_Heir = the_thread;
ffc0b310: 93 fe 00 14 stw r31,20(r30)
if ( _Thread_Executing->is_preemptible ||
ffc0b314: 89 29 00 70 lbz r9,112(r9)
ffc0b318: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b31c: 40 9e 00 10 bne- cr7,ffc0b32c <_Scheduler_EDF_Unblock+0x64>
ffc0b320: 81 3f 00 14 lwz r9,20(r31)
ffc0b324: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b328: 40 9e 00 14 bne- cr7,ffc0b33c <_Scheduler_EDF_Unblock+0x74><== ALWAYS TAKEN
the_thread->current_priority == 0 )
_Thread_Dispatch_necessary = true;
ffc0b32c: 3d 20 00 00 lis r9,0
ffc0b330: 39 40 00 01 li r10,1
ffc0b334: 39 29 32 40 addi r9,r9,12864
ffc0b338: 99 49 00 0c stb r10,12(r9)
}
}
ffc0b33c: 39 61 00 10 addi r11,r1,16
ffc0b340: 4b ff 58 88 b ffc00bc8 <_restgpr_30_x>
ffc0a708 <_Scheduler_priority_Block>:
)
{
Scheduler_priority_Per_thread *sched_info;
Chain_Control *ready;
sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info;
ffc0a708: 81 43 00 88 lwz r10,136(r3)
ready = sched_info->ready_chain;
ffc0a70c: 81 2a 00 00 lwz r9,0(r10)
if ( _Chain_Has_only_one_node( ready ) ) {
ffc0a710: 80 e9 00 00 lwz r7,0(r9)
ffc0a714: 81 09 00 08 lwz r8,8(r9)
ffc0a718: 7f 87 40 00 cmpw cr7,r7,r8
ffc0a71c: 40 be 00 4c bne+ cr7,ffc0a768 <_Scheduler_priority_Block+0x60>
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
ffc0a720: 39 09 00 04 addi r8,r9,4
head->next = tail;
head->previous = NULL;
tail->previous = head;
ffc0a724: 91 29 00 08 stw r9,8(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc0a728: 91 09 00 00 stw r8,0(r9)
head->previous = NULL;
ffc0a72c: 39 00 00 00 li r8,0
ffc0a730: 91 09 00 04 stw r8,4(r9)
RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove (
Priority_bit_map_Information *the_priority_map
)
{
*the_priority_map->minor &= the_priority_map->block_minor;
ffc0a734: 81 0a 00 04 lwz r8,4(r10)
ffc0a738: 81 2a 00 14 lwz r9,20(r10)
ffc0a73c: 80 e8 00 00 lwz r7,0(r8)
ffc0a740: 7c e9 48 38 and r9,r7,r9
if ( *the_priority_map->minor == 0 )
ffc0a744: 2f 89 00 00 cmpwi cr7,r9,0
RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove (
Priority_bit_map_Information *the_priority_map
)
{
*the_priority_map->minor &= the_priority_map->block_minor;
ffc0a748: 91 28 00 00 stw r9,0(r8)
if ( *the_priority_map->minor == 0 )
ffc0a74c: 40 9e 00 2c bne- cr7,ffc0a778 <_Scheduler_priority_Block+0x70>
_Priority_Major_bit_map &= the_priority_map->block_major;
ffc0a750: 3d 20 00 00 lis r9,0
ffc0a754: 81 4a 00 10 lwz r10,16(r10)
ffc0a758: 81 09 28 94 lwz r8,10388(r9)
ffc0a75c: 7d 0a 50 38 and r10,r8,r10
ffc0a760: 91 49 28 94 stw r10,10388(r9)
ffc0a764: 48 00 00 14 b ffc0a778 <_Scheduler_priority_Block+0x70>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
ffc0a768: 81 23 00 00 lwz r9,0(r3)
previous = the_node->previous;
ffc0a76c: 81 43 00 04 lwz r10,4(r3)
next->previous = previous;
ffc0a770: 91 49 00 04 stw r10,4(r9)
previous->next = next;
ffc0a774: 91 2a 00 00 stw r9,0(r10)
RTEMS_INLINE_ROUTINE bool _Thread_Is_heir (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Heir );
ffc0a778: 3d 20 00 00 lis r9,0
{
_Scheduler_priority_Ready_queue_extract( the_thread );
/* TODO: flash critical section? */
if ( _Thread_Is_heir( the_thread ) )
ffc0a77c: 81 29 31 b4 lwz r9,12724(r9)
ffc0a780: 7f 83 48 00 cmpw cr7,r3,r9
ffc0a784: 40 be 00 60 bne+ cr7,ffc0a7e4 <_Scheduler_priority_Block+0xdc>
* @param[in] the_thread - pointer to thread
*/
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
(Chain_Control *) _Scheduler.information
ffc0a788: 3d 20 00 00 lis r9,0
RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void )
{
Priority_bit_map_Control minor;
Priority_bit_map_Control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
ffc0a78c: 3c e0 00 00 lis r7,0
ffc0a790: 81 49 20 80 lwz r10,8320(r9)
ffc0a794: 81 27 28 94 lwz r9,10388(r7)
ffc0a798: 7d 28 00 34 cntlzw r8,r9
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0a79c: 3c c0 00 00 lis r6,0
RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void )
{
Priority_bit_map_Control minor;
Priority_bit_map_Control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
ffc0a7a0: 91 27 28 94 stw r9,10388(r7)
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0a7a4: 38 c6 31 e0 addi r6,r6,12768
ffc0a7a8: 55 07 10 3a rlwinm r7,r8,2,0,29
ffc0a7ac: 7d 26 38 2e lwzx r9,r6,r7
ffc0a7b0: 7d 25 00 34 cntlzw r5,r9
ffc0a7b4: 7d 26 39 2e stwx r9,r6,r7
return (_Priority_Bits_index( major ) << 4) +
ffc0a7b8: 55 09 20 36 rlwinm r9,r8,4,0,27
ffc0a7bc: 7d 29 2a 14 add r9,r9,r5
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc0a7c0: 1d 29 00 0c mulli r9,r9,12
ffc0a7c4: 7d 0a 4a 14 add r8,r10,r9
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc0a7c8: 7d 2a 48 2e lwzx r9,r10,r9
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc0a7cc: 39 48 00 04 addi r10,r8,4
ffc0a7d0: 7f 89 50 00 cmpw cr7,r9,r10
ffc0a7d4: 40 be 00 08 bne+ cr7,ffc0a7dc <_Scheduler_priority_Block+0xd4><== ALWAYS TAKEN
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
return NULL;
ffc0a7d8: 39 20 00 00 li r9,0 <== NOT EXECUTED
*
* @param[in] the_thread - pointer to thread
*/
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
ffc0a7dc: 3d 40 00 00 lis r10,0
ffc0a7e0: 91 2a 31 b4 stw r9,12724(r10)
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc0a7e4: 3d 20 00 00 lis r9,0
ffc0a7e8: 39 29 31 a0 addi r9,r9,12704
_Scheduler_priority_Schedule_body();
if ( _Thread_Is_executing( the_thread ) )
ffc0a7ec: 81 49 00 10 lwz r10,16(r9)
ffc0a7f0: 7f 83 50 00 cmpw cr7,r3,r10
ffc0a7f4: 4c be 00 20 bnelr+ cr7
_Thread_Dispatch_necessary = true;
ffc0a7f8: 39 40 00 01 li r10,1
ffc0a7fc: 99 49 00 0c stb r10,12(r9)
ffc0a800: 4e 80 00 20 blr
ffc0a9b8 <_Scheduler_priority_Schedule>:
* @param[in] the_thread - pointer to thread
*/
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
(Chain_Control *) _Scheduler.information
ffc0a9b8: 3d 20 00 00 lis r9,0
RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void )
{
Priority_bit_map_Control minor;
Priority_bit_map_Control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
ffc0a9bc: 3c e0 00 00 lis r7,0
ffc0a9c0: 81 49 20 80 lwz r10,8320(r9)
ffc0a9c4: 81 27 28 94 lwz r9,10388(r7)
ffc0a9c8: 7d 28 00 34 cntlzw r8,r9
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0a9cc: 3c c0 00 00 lis r6,0
RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void )
{
Priority_bit_map_Control minor;
Priority_bit_map_Control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
ffc0a9d0: 91 27 28 94 stw r9,10388(r7)
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0a9d4: 38 c6 31 e0 addi r6,r6,12768
ffc0a9d8: 55 07 10 3a rlwinm r7,r8,2,0,29
ffc0a9dc: 7d 26 38 2e lwzx r9,r6,r7
ffc0a9e0: 7d 25 00 34 cntlzw r5,r9
ffc0a9e4: 7d 26 39 2e stwx r9,r6,r7
return (_Priority_Bits_index( major ) << 4) +
ffc0a9e8: 55 09 20 36 rlwinm r9,r8,4,0,27
ffc0a9ec: 7d 29 2a 14 add r9,r9,r5
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc0a9f0: 1d 29 00 0c mulli r9,r9,12
ffc0a9f4: 7d 0a 4a 14 add r8,r10,r9
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc0a9f8: 7d 2a 48 2e lwzx r9,r10,r9
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc0a9fc: 39 48 00 04 addi r10,r8,4
ffc0aa00: 7f 89 50 00 cmpw cr7,r9,r10
ffc0aa04: 40 be 00 08 bne+ cr7,ffc0aa0c <_Scheduler_priority_Schedule+0x54><== ALWAYS TAKEN
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
return NULL;
ffc0aa08: 39 20 00 00 li r9,0 <== NOT EXECUTED
*
* @param[in] the_thread - pointer to thread
*/
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
ffc0aa0c: 3d 40 00 00 lis r10,0
ffc0aa10: 91 2a 31 b4 stw r9,12724(r10)
ffc0aa14: 4e 80 00 20 blr
ffc0aa18 <_Scheduler_priority_Tick>:
#include <rtems/system.h>
#include <rtems/score/schedulerpriority.h>
void _Scheduler_priority_Tick( void )
{
ffc0aa18: 7c 2b 0b 78 mr r11,r1
ffc0aa1c: 7c 08 02 a6 mflr r0
ffc0aa20: 94 21 ff f0 stwu r1,-16(r1)
Thread_Control *executing;
executing = _Thread_Executing;
ffc0aa24: 3d 20 00 00 lis r9,0
#include <rtems/system.h>
#include <rtems/score/schedulerpriority.h>
void _Scheduler_priority_Tick( void )
{
ffc0aa28: 90 01 00 14 stw r0,20(r1)
ffc0aa2c: 48 01 03 91 bl ffc1adbc <_savegpr_31>
Thread_Control *executing;
executing = _Thread_Executing;
ffc0aa30: 83 e9 31 b0 lwz r31,12720(r9)
/*
* If the thread is not preemptible or is not ready, then
* just return.
*/
if ( !executing->is_preemptible )
ffc0aa34: 89 3f 00 70 lbz r9,112(r31)
ffc0aa38: 2f 89 00 00 cmpwi cr7,r9,0
ffc0aa3c: 41 9e 00 98 beq- cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc>
return;
if ( !_States_Is_ready( executing->current_state ) )
ffc0aa40: 81 3f 00 10 lwz r9,16(r31)
ffc0aa44: 2f 89 00 00 cmpwi cr7,r9,0
ffc0aa48: 40 9e 00 8c bne- cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc>
/*
* The cpu budget algorithm determines what happens next.
*/
switch ( executing->budget_algorithm ) {
ffc0aa4c: 81 3f 00 78 lwz r9,120(r31)
ffc0aa50: 2b 89 00 01 cmplwi cr7,r9,1
ffc0aa54: 41 9c 00 80 blt- cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc>
ffc0aa58: 2b 89 00 02 cmplwi cr7,r9,2
ffc0aa5c: 40 9d 00 10 ble- cr7,ffc0aa6c <_Scheduler_priority_Tick+0x54>
ffc0aa60: 2f 89 00 03 cmpwi cr7,r9,3
ffc0aa64: 40 be 00 70 bne+ cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc><== NEVER TAKEN
ffc0aa68: 48 00 00 38 b ffc0aaa0 <_Scheduler_priority_Tick+0x88>
case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE:
#if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE)
case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE:
#endif
if ( (int)(--executing->cpu_time_budget) <= 0 ) {
ffc0aa6c: 81 3f 00 74 lwz r9,116(r31)
ffc0aa70: 39 29 ff ff addi r9,r9,-1
ffc0aa74: 2f 89 00 00 cmpwi cr7,r9,0
ffc0aa78: 91 3f 00 74 stw r9,116(r31)
ffc0aa7c: 41 bd 00 58 bgt+ cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc>
* always operates on the scheduler that 'owns' the currently executing
* thread.
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void )
{
_Scheduler.Operations.yield();
ffc0aa80: 3d 20 00 00 lis r9,0
ffc0aa84: 81 29 20 8c lwz r9,8332(r9)
ffc0aa88: 7d 29 03 a6 mtctr r9
ffc0aa8c: 4e 80 04 21 bctrl
* executing thread's timeslice is reset. Otherwise, the
* currently executing thread is placed at the rear of the
* FIFO for this priority and a new heir is selected.
*/
_Scheduler_Yield();
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0aa90: 3d 20 00 00 lis r9,0
ffc0aa94: 81 29 28 64 lwz r9,10340(r9)
ffc0aa98: 91 3f 00 74 stw r9,116(r31)
ffc0aa9c: 48 00 00 38 b ffc0aad4 <_Scheduler_priority_Tick+0xbc>
}
break;
#if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
if ( --executing->cpu_time_budget == 0 )
ffc0aaa0: 81 3f 00 74 lwz r9,116(r31)
ffc0aaa4: 39 29 ff ff addi r9,r9,-1
ffc0aaa8: 2f 89 00 00 cmpwi cr7,r9,0
ffc0aaac: 91 3f 00 74 stw r9,116(r31)
ffc0aab0: 40 be 00 24 bne+ cr7,ffc0aad4 <_Scheduler_priority_Tick+0xbc>
(*executing->budget_callout)( executing );
ffc0aab4: 81 3f 00 7c lwz r9,124(r31)
ffc0aab8: 7f e3 fb 78 mr r3,r31
break;
#endif
}
}
ffc0aabc: 80 01 00 14 lwz r0,20(r1)
break;
#if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
if ( --executing->cpu_time_budget == 0 )
(*executing->budget_callout)( executing );
ffc0aac0: 7d 29 03 a6 mtctr r9
break;
#endif
}
}
ffc0aac4: 83 e1 00 0c lwz r31,12(r1)
ffc0aac8: 7c 08 03 a6 mtlr r0
ffc0aacc: 38 21 00 10 addi r1,r1,16
break;
#if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
if ( --executing->cpu_time_budget == 0 )
(*executing->budget_callout)( executing );
ffc0aad0: 4e 80 04 20 bctr
break;
#endif
}
}
ffc0aad4: 39 61 00 10 addi r11,r1,16
ffc0aad8: 4b ff 5a ec b ffc005c4 <_restgpr_31_x>
ffc095c8 <_TOD_Validate>:
{
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
ffc095c8: 3d 20 ff c2 lis r9,-62
)
{
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
ffc095cc: 81 29 e2 04 lwz r9,-7676(r9)
ffc095d0: 3d 00 00 0f lis r8,15
ffc095d4: 61 08 42 40 ori r8,r8,16960
ffc095d8: 7d 08 4b 96 divwu r8,r8,r9
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
ffc095dc: 7c 69 1b 79 mr. r9,r3
ffc095e0: 41 82 00 90 beq- ffc09670 <_TOD_Validate+0xa8> <== NEVER TAKEN
ffc095e4: 81 49 00 18 lwz r10,24(r9)
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
return false;
ffc095e8: 38 60 00 00 li r3,0
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
ffc095ec: 7f 8a 40 40 cmplw cr7,r10,r8
ffc095f0: 4c 9c 00 20 bgelr cr7
(the_tod->ticks >= ticks_per_second) ||
ffc095f4: 81 49 00 14 lwz r10,20(r9)
ffc095f8: 2b 8a 00 3b cmplwi cr7,r10,59
ffc095fc: 4d 9d 00 20 bgtlr cr7
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
ffc09600: 81 49 00 10 lwz r10,16(r9)
ffc09604: 2b 8a 00 3b cmplwi cr7,r10,59
ffc09608: 4d 9d 00 20 bgtlr cr7
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
ffc0960c: 81 49 00 0c lwz r10,12(r9)
ffc09610: 2b 8a 00 17 cmplwi cr7,r10,23
ffc09614: 4d 9d 00 20 bgtlr cr7
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
ffc09618: 81 49 00 04 lwz r10,4(r9)
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
(the_tod->ticks >= ticks_per_second) ||
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
ffc0961c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc09620: 4d 9e 00 20 beqlr cr7
(the_tod->month == 0) ||
ffc09624: 2b 8a 00 0c cmplwi cr7,r10,12
ffc09628: 4d 9d 00 20 bgtlr cr7
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
ffc0962c: 81 09 00 00 lwz r8,0(r9)
(the_tod->ticks >= ticks_per_second) ||
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
ffc09630: 2b 88 07 c3 cmplwi cr7,r8,1987
ffc09634: 4c 9d 00 20 blelr cr7
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
ffc09638: 81 29 00 08 lwz r9,8(r9)
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
ffc0963c: 2f 89 00 00 cmpwi cr7,r9,0
ffc09640: 4d 9e 00 20 beqlr cr7
(the_tod->day == 0) )
return false;
if ( (the_tod->year % 4) == 0 )
ffc09644: 71 07 00 03 andi. r7,r8,3
ffc09648: 3c e0 ff c2 lis r7,-62
ffc0964c: 39 07 f9 48 addi r8,r7,-1720
ffc09650: 40 82 00 08 bne- ffc09658 <_TOD_Validate+0x90>
days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ];
ffc09654: 39 4a 00 0d addi r10,r10,13
else
days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ];
ffc09658: 55 4a 10 3a rlwinm r10,r10,2,0,29
ffc0965c: 7c 68 50 2e lwzx r3,r8,r10
if ( the_tod->day > days_in_month )
ffc09660: 7c 69 18 10 subfc r3,r9,r3
ffc09664: 38 60 00 00 li r3,0
ffc09668: 7c 63 19 14 adde r3,r3,r3
ffc0966c: 4e 80 00 20 blr
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
return false;
ffc09670: 38 60 00 00 li r3,0 <== NOT EXECUTED
if ( the_tod->day > days_in_month )
return false;
return true;
}
ffc09674: 4e 80 00 20 blr <== NOT EXECUTED
ffc0ace4 <_Thread_Change_priority>:
void _Thread_Change_priority(
Thread_Control *the_thread,
Priority_Control new_priority,
bool prepend_it
)
{
ffc0ace4: 94 21 ff e0 stwu r1,-32(r1)
ffc0ace8: 7c 08 02 a6 mflr r0
ffc0acec: 90 01 00 24 stw r0,36(r1)
ffc0acf0: bf 81 00 10 stmw r28,16(r1)
ffc0acf4: 7c 7f 1b 78 mr r31,r3
ffc0acf8: 7c bd 2b 78 mr r29,r5
States_Control state, original_state;
/*
* Save original state
*/
original_state = the_thread->current_state;
ffc0acfc: 83 83 00 10 lwz r28,16(r3)
/*
* Set a transient state for the thread so it is pulled off the Ready chains.
* This will prevent it from being scheduled no matter what happens in an
* ISR.
*/
_Thread_Set_transient( the_thread );
ffc0ad00: 90 81 00 08 stw r4,8(r1)
ffc0ad04: 48 00 0e dd bl ffc0bbe0 <_Thread_Set_transient>
/*
* Do not bother recomputing all the priority related information if
* we are not REALLY changing priority.
*/
if ( the_thread->current_priority != new_priority )
ffc0ad08: 81 3f 00 14 lwz r9,20(r31)
ffc0ad0c: 80 81 00 08 lwz r4,8(r1)
ffc0ad10: 7f 89 20 00 cmpw cr7,r9,r4
ffc0ad14: 41 9e 00 0c beq- cr7,ffc0ad20 <_Thread_Change_priority+0x3c>
_Thread_Set_priority( the_thread, new_priority );
ffc0ad18: 7f e3 fb 78 mr r3,r31
ffc0ad1c: 48 00 0e 55 bl ffc0bb70 <_Thread_Set_priority>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0ad20: 7f c0 00 a6 mfmsr r30
ffc0ad24: 7d 30 42 a6 mfsprg r9,0
ffc0ad28: 7f c9 48 78 andc r9,r30,r9
ffc0ad2c: 7d 20 01 24 mtmsr r9
/*
* If the thread has more than STATES_TRANSIENT set, then it is blocked,
* If it is blocked on a thread queue, then we need to requeue it.
*/
state = the_thread->current_state;
ffc0ad30: 81 5f 00 10 lwz r10,16(r31)
ffc0ad34: 57 89 07 7a rlwinm r9,r28,0,29,29
if ( state != STATES_TRANSIENT ) {
ffc0ad38: 2f 8a 00 04 cmpwi cr7,r10,4
ffc0ad3c: 41 9e 00 44 beq- cr7,ffc0ad80 <_Thread_Change_priority+0x9c>
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) )
ffc0ad40: 2f 89 00 00 cmpwi cr7,r9,0
ffc0ad44: 40 9e 00 0c bne- cr7,ffc0ad50 <_Thread_Change_priority+0x6c><== NEVER TAKEN
RTEMS_INLINE_ROUTINE States_Control _States_Clear (
States_Control states_to_clear,
States_Control current_state
)
{
return (current_state & ~states_to_clear);
ffc0ad48: 55 49 07 b8 rlwinm r9,r10,0,30,28
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
ffc0ad4c: 91 3f 00 10 stw r9,16(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0ad50: 7f c0 01 24 mtmsr r30
_ISR_Enable( level );
if ( _States_Is_waiting_on_thread_queue( state ) ) {
ffc0ad54: 3d 20 00 03 lis r9,3
ffc0ad58: 61 29 be e0 ori r9,r9,48864
ffc0ad5c: 7d 48 48 39 and. r8,r10,r9
ffc0ad60: 41 a2 00 a0 beq+ ffc0ae00 <_Thread_Change_priority+0x11c>
if ( !_Thread_Is_executing_also_the_heir() &&
_Thread_Executing->is_preemptible )
_Thread_Dispatch_necessary = true;
_ISR_Enable( level );
}
ffc0ad64: 80 01 00 24 lwz r0,36(r1)
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) )
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
_ISR_Enable( level );
if ( _States_Is_waiting_on_thread_queue( state ) ) {
_Thread_queue_Requeue( the_thread->Wait.queue, the_thread );
ffc0ad68: 7f e4 fb 78 mr r4,r31
ffc0ad6c: 80 7f 00 44 lwz r3,68(r31)
if ( !_Thread_Is_executing_also_the_heir() &&
_Thread_Executing->is_preemptible )
_Thread_Dispatch_necessary = true;
_ISR_Enable( level );
}
ffc0ad70: 7c 08 03 a6 mtlr r0
ffc0ad74: bb 81 00 10 lmw r28,16(r1)
ffc0ad78: 38 21 00 20 addi r1,r1,32
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) )
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
_ISR_Enable( level );
if ( _States_Is_waiting_on_thread_queue( state ) ) {
_Thread_queue_Requeue( the_thread->Wait.queue, the_thread );
ffc0ad7c: 48 00 0d 3c b ffc0bab8 <_Thread_queue_Requeue>
}
return;
}
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) ) {
ffc0ad80: 2f 89 00 00 cmpwi cr7,r9,0
ffc0ad84: 40 9e 00 30 bne- cr7,ffc0adb4 <_Thread_Change_priority+0xd0><== NEVER TAKEN
* the TRANSIENT state. So we have to place it on the appropriate
* Ready Queue with interrupts off.
*/
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
if ( prepend_it )
ffc0ad88: 2f 9d 00 00 cmpwi cr7,r29,0
* Interrupts are STILL disabled.
* We now know the thread will be in the READY state when we remove
* the TRANSIENT state. So we have to place it on the appropriate
* Ready Queue with interrupts off.
*/
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
ffc0ad8c: 91 3f 00 10 stw r9,16(r31)
ffc0ad90: 3d 20 00 00 lis r9,0
ffc0ad94: 39 29 20 80 addi r9,r9,8320
if ( prepend_it )
ffc0ad98: 41 9e 00 0c beq- cr7,ffc0ada4 <_Thread_Change_priority+0xc0>
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first(
Thread_Control *the_thread
)
{
_Scheduler.Operations.enqueue_first( the_thread );
ffc0ad9c: 81 29 00 28 lwz r9,40(r9)
ffc0ada0: 48 00 00 08 b ffc0ada8 <_Thread_Change_priority+0xc4>
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue(
Thread_Control *the_thread
)
{
_Scheduler.Operations.enqueue( the_thread );
ffc0ada4: 81 29 00 24 lwz r9,36(r9)
ffc0ada8: 7f e3 fb 78 mr r3,r31
ffc0adac: 7d 29 03 a6 mtctr r9
ffc0adb0: 4e 80 04 21 bctrl
static inline void ppc_interrupt_flash( uint32_t level )
{
uint32_t current_level;
__asm__ volatile (
ffc0adb4: 7d 20 00 a6 mfmsr r9
ffc0adb8: 7f c0 01 24 mtmsr r30
ffc0adbc: 7d 20 01 24 mtmsr r9
* This kernel routine implements the scheduling decision logic for
* the scheduler. It does NOT dispatch.
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void )
{
_Scheduler.Operations.schedule();
ffc0adc0: 3d 20 00 00 lis r9,0
ffc0adc4: 81 29 20 88 lwz r9,8328(r9)
ffc0adc8: 7d 29 03 a6 mtctr r9
ffc0adcc: 4e 80 04 21 bctrl
* is also the heir thread, and false otherwise.
*/
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void )
{
return ( _Thread_Executing == _Thread_Heir );
ffc0add0: 3d 20 00 00 lis r9,0
ffc0add4: 39 29 31 a0 addi r9,r9,12704
ffc0add8: 81 49 00 10 lwz r10,16(r9)
* We altered the set of thread priorities. So let's figure out
* who is the heir and if we need to switch to them.
*/
_Scheduler_Schedule();
if ( !_Thread_Is_executing_also_the_heir() &&
ffc0addc: 81 09 00 14 lwz r8,20(r9)
ffc0ade0: 7f 8a 40 00 cmpw cr7,r10,r8
ffc0ade4: 41 9e 00 18 beq- cr7,ffc0adfc <_Thread_Change_priority+0x118>
ffc0ade8: 89 4a 00 70 lbz r10,112(r10)
ffc0adec: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0adf0: 41 9e 00 0c beq- cr7,ffc0adfc <_Thread_Change_priority+0x118>
_Thread_Executing->is_preemptible )
_Thread_Dispatch_necessary = true;
ffc0adf4: 39 40 00 01 li r10,1
ffc0adf8: 99 49 00 0c stb r10,12(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0adfc: 7f c0 01 24 mtmsr r30
_ISR_Enable( level );
}
ffc0ae00: 39 61 00 20 addi r11,r1,32
ffc0ae04: 4b ff 57 b4 b ffc005b8 <_restgpr_28_x>
ffc0b020 <_Thread_Delay_ended>:
void _Thread_Delay_ended(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0b020: 94 21 ff e8 stwu r1,-24(r1)
ffc0b024: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b028: 38 81 00 08 addi r4,r1,8
void _Thread_Delay_ended(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0b02c: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b030: 48 00 02 15 bl ffc0b244 <_Thread_Get>
switch ( location ) {
ffc0b034: 81 21 00 08 lwz r9,8(r1)
ffc0b038: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b03c: 40 9e 00 20 bne- cr7,ffc0b05c <_Thread_Delay_ended+0x3c><== NEVER TAKEN
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_Clear_state(
ffc0b040: 3c 80 10 00 lis r4,4096
ffc0b044: 60 84 00 18 ori r4,r4,24
ffc0b048: 4b ff fd c1 bl ffc0ae08 <_Thread_Clear_state>
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0b04c: 3d 20 00 00 lis r9,0
ffc0b050: 81 49 28 68 lwz r10,10344(r9)
--level;
ffc0b054: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc0b058: 91 49 28 68 stw r10,10344(r9)
| STATES_INTERRUPTIBLE_BY_SIGNAL
);
_Thread_Unnest_dispatch();
break;
}
}
ffc0b05c: 80 01 00 1c lwz r0,28(r1)
ffc0b060: 38 21 00 18 addi r1,r1,24
ffc0b064: 7c 08 03 a6 mtlr r0
ffc0b068: 4e 80 00 20 blr
ffc0b06c <_Thread_Dispatch>:
#if defined(RTEMS_SMP)
#include <rtems/score/smp.h>
#endif
void _Thread_Dispatch( void )
{
ffc0b06c: 94 21 ff b8 stwu r1,-72(r1)
ffc0b070: 7c 08 02 a6 mflr r0
ffc0b074: be 81 00 18 stmw r20,24(r1)
#endif
/*
* Now determine if we need to perform a dispatch on the current CPU.
*/
executing = _Thread_Executing;
ffc0b078: 3f e0 00 00 lis r31,0
ffc0b07c: 39 3f 31 a0 addi r9,r31,12704
#if defined(RTEMS_SMP)
#include <rtems/score/smp.h>
#endif
void _Thread_Dispatch( void )
{
ffc0b080: 90 01 00 4c stw r0,76(r1)
#endif
/*
* Now determine if we need to perform a dispatch on the current CPU.
*/
executing = _Thread_Executing;
ffc0b084: 82 c9 00 10 lwz r22,16(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0b088: 7d 40 00 a6 mfmsr r10
ffc0b08c: 7d 30 42 a6 mfsprg r9,0
ffc0b090: 7d 49 48 78 andc r9,r10,r9
ffc0b094: 7d 20 01 24 mtmsr r9
*/
static inline void _TOD_Get_uptime(
Timestamp_Control *time
)
{
_TOD_Get_with_nanoseconds( time, &_TOD.uptime );
ffc0b098: 3f 40 00 00 lis r26,0
{
const Chain_Control *chain = &_User_extensions_Switches_list;
const Chain_Node *tail = _Chain_Immutable_tail( chain );
const Chain_Node *node = _Chain_Immutable_first( chain );
while ( node != tail ) {
ffc0b09c: 3e e0 00 00 lis r23,0
* This routine sets thread dispatch level to the
* value passed in.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_set_disable_level(uint32_t value)
{
_Thread_Dispatch_disable_level = value;
ffc0b0a0: 3f c0 00 00 lis r30,0
ffc0b0a4: 3b a0 00 01 li r29,1
while ( _Thread_Dispatch_necessary == true ) {
heir = _Thread_Heir;
#ifndef RTEMS_SMP
_Thread_Dispatch_set_disable_level( 1 );
#endif
_Thread_Dispatch_necessary = false;
ffc0b0a8: 3b 80 00 00 li r28,0
#if __RTEMS_ADA__
executing->rtems_ada_self = rtems_ada_self;
rtems_ada_self = heir->rtems_ada_self;
#endif
if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE )
heir->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b0ac: 3f 60 00 00 lis r27,0
ffc0b0b0: 3b 5a 2c 68 addi r26,r26,11368
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b0b4: 3f 20 00 00 lis r25,0
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc0b0b8: 3f 00 00 00 lis r24,0
ffc0b0bc: 3a f7 22 0c addi r23,r23,8716
/*
* Now determine if we need to perform a dispatch on the current CPU.
*/
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
ffc0b0c0: 48 00 01 30 b ffc0b1f0 <_Thread_Dispatch+0x184>
heir = _Thread_Heir;
ffc0b0c4: 82 a9 00 14 lwz r21,20(r9)
ffc0b0c8: 93 be 28 68 stw r29,10344(r30)
/*
* When the heir and executing are the same, then we are being
* requested to do the post switch dispatching. This is normally
* done to dispatch signals.
*/
if ( heir == executing )
ffc0b0cc: 7f 95 b0 00 cmpw cr7,r21,r22
while ( _Thread_Dispatch_necessary == true ) {
heir = _Thread_Heir;
#ifndef RTEMS_SMP
_Thread_Dispatch_set_disable_level( 1 );
#endif
_Thread_Dispatch_necessary = false;
ffc0b0d0: 9b 89 00 0c stb r28,12(r9)
_Thread_Executing = heir;
ffc0b0d4: 92 a9 00 10 stw r21,16(r9)
/*
* When the heir and executing are the same, then we are being
* requested to do the post switch dispatching. This is normally
* done to dispatch signals.
*/
if ( heir == executing )
ffc0b0d8: 40 be 00 28 bne+ cr7,ffc0b100 <_Thread_Dispatch+0x94>
ffc0b0dc: 39 00 00 00 li r8,0
ffc0b0e0: 3d 20 00 00 lis r9,0
ffc0b0e4: 91 09 28 68 stw r8,10344(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0b0e8: 7d 40 01 24 mtmsr r10
ffc0b0ec: 3d 20 00 00 lis r9,0
{
const Chain_Control *chain = &_API_extensions_Post_switch_list;
const Chain_Node *tail = _Chain_Immutable_tail( chain );
const Chain_Node *node = _Chain_Immutable_first( chain );
while ( node != tail ) {
ffc0b0f0: 3f c0 00 00 lis r30,0
ffc0b0f4: 83 e9 2d 90 lwz r31,11664(r9)
ffc0b0f8: 3b de 2d 94 addi r30,r30,11668
ffc0b0fc: 48 00 01 1c b ffc0b218 <_Thread_Dispatch+0x1ac>
*/
#if __RTEMS_ADA__
executing->rtems_ada_self = rtems_ada_self;
rtems_ada_self = heir->rtems_ada_self;
#endif
if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE )
ffc0b100: 81 35 00 78 lwz r9,120(r21)
ffc0b104: 2f 89 00 01 cmpwi cr7,r9,1
ffc0b108: 40 be 00 0c bne+ cr7,ffc0b114 <_Thread_Dispatch+0xa8>
heir->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b10c: 81 3b 28 64 lwz r9,10340(r27)
ffc0b110: 91 35 00 74 stw r9,116(r21)
ffc0b114: 7d 40 01 24 mtmsr r10
ffc0b118: 38 61 00 08 addi r3,r1,8
ffc0b11c: 7f 44 d3 78 mr r4,r26
ffc0b120: 4b ff e7 9d bl ffc098bc <_TOD_Get_with_nanoseconds>
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
{
Timestamp_Control uptime, ran;
_TOD_Get_uptime( &uptime );
_Timestamp_Subtract(
ffc0b124: 38 bf 31 a0 addi r5,r31,12704
const Timestamp64_Control *_start,
const Timestamp64_Control *_end,
Timestamp64_Control *_result
)
{
*_result = *_end - *_start;
ffc0b128: 81 05 00 20 lwz r8,32(r5)
ffc0b12c: 81 25 00 24 lwz r9,36(r5)
ffc0b130: 81 41 00 08 lwz r10,8(r1)
ffc0b134: 81 61 00 0c lwz r11,12(r1)
ffc0b138: 7c e9 58 10 subfc r7,r9,r11
ffc0b13c: 7c c8 51 10 subfe r6,r8,r10
static inline void _Timestamp64_implementation_Add_to(
Timestamp64_Control *_time,
const Timestamp64_Control *_add
)
{
*_time += *_add;
ffc0b140: 81 16 00 80 lwz r8,128(r22)
ffc0b144: 81 36 00 84 lwz r9,132(r22)
ffc0b148: 7d 29 38 14 addc r9,r9,r7
ffc0b14c: 7d 08 31 14 adde r8,r8,r6
ffc0b150: 91 36 00 84 stw r9,132(r22)
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b154: 81 39 28 70 lwz r9,10352(r25)
ffc0b158: 91 16 00 80 stw r8,128(r22)
ffc0b15c: 2f 89 00 00 cmpwi cr7,r9,0
&_Thread_Time_of_last_context_switch,
&uptime,
&ran
);
_Timestamp_Add_to( &executing->cpu_time_used, &ran );
_Thread_Time_of_last_context_switch = uptime;
ffc0b160: 91 45 00 20 stw r10,32(r5)
ffc0b164: 91 65 00 24 stw r11,36(r5)
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b168: 41 9e 00 14 beq- cr7,ffc0b17c <_Thread_Dispatch+0x110> <== NEVER TAKEN
executing->libc_reent = *_Thread_libc_reent;
ffc0b16c: 81 49 00 00 lwz r10,0(r9)
ffc0b170: 91 56 01 48 stw r10,328(r22)
*_Thread_libc_reent = heir->libc_reent;
ffc0b174: 81 55 01 48 lwz r10,328(r21)
ffc0b178: 91 49 00 00 stw r10,0(r9)
ffc0b17c: 82 98 22 08 lwz r20,8712(r24)
ffc0b180: 48 00 00 1c b ffc0b19c <_Thread_Dispatch+0x130>
const User_extensions_Switch_control *extension =
(const User_extensions_Switch_control *) node;
(*extension->thread_switch)( executing, heir );
ffc0b184: 81 34 00 08 lwz r9,8(r20)
ffc0b188: 7e c3 b3 78 mr r3,r22
ffc0b18c: 7e a4 ab 78 mr r4,r21
ffc0b190: 7d 29 03 a6 mtctr r9
ffc0b194: 4e 80 04 21 bctrl
#ifdef RTEMS_SMP
_Thread_Unnest_dispatch();
#endif
_API_extensions_Run_post_switch( executing );
}
ffc0b198: 82 94 00 00 lwz r20,0(r20)
{
const Chain_Control *chain = &_User_extensions_Switches_list;
const Chain_Node *tail = _Chain_Immutable_tail( chain );
const Chain_Node *node = _Chain_Immutable_first( chain );
while ( node != tail ) {
ffc0b19c: 7f 94 b8 00 cmpw cr7,r20,r23
ffc0b1a0: 40 9e ff e4 bne+ cr7,ffc0b184 <_Thread_Dispatch+0x118>
* operations.
*/
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
#if ( CPU_USE_DEFERRED_FP_SWITCH != TRUE )
if ( executing->fp_context != NULL )
ffc0b1a4: 81 36 01 44 lwz r9,324(r22)
ffc0b1a8: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b1ac: 41 9e 00 0c beq- cr7,ffc0b1b8 <_Thread_Dispatch+0x14c>
_Context_Save_fp( &executing->fp_context );
ffc0b1b0: 38 76 01 44 addi r3,r22,324
ffc0b1b4: 48 00 fc cd bl ffc1ae80 <_CPU_Context_save_fp>
#endif
#endif
_Context_Switch( &executing->Registers, &heir->Registers );
ffc0b1b8: 38 76 00 c4 addi r3,r22,196
ffc0b1bc: 38 95 00 c4 addi r4,r21,196
ffc0b1c0: 48 00 fe 41 bl ffc1b000 <_CPU_Context_switch>
_Context_Save_fp( &_Thread_Allocated_fp->fp_context );
_Context_Restore_fp( &executing->fp_context );
_Thread_Allocated_fp = executing;
}
#else
if ( executing->fp_context != NULL )
ffc0b1c4: 81 36 01 44 lwz r9,324(r22)
ffc0b1c8: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b1cc: 41 9e 00 0c beq- cr7,ffc0b1d8 <_Thread_Dispatch+0x16c>
_Context_Restore_fp( &executing->fp_context );
ffc0b1d0: 38 76 01 44 addi r3,r22,324
ffc0b1d4: 48 00 fd 6d bl ffc1af40 <_CPU_Context_restore_fp>
#endif
#endif
executing = _Thread_Executing;
ffc0b1d8: 39 3f 31 a0 addi r9,r31,12704
ffc0b1dc: 82 c9 00 10 lwz r22,16(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0b1e0: 7d 40 00 a6 mfmsr r10
ffc0b1e4: 7d 30 42 a6 mfsprg r9,0
ffc0b1e8: 7d 49 48 78 andc r9,r10,r9
ffc0b1ec: 7d 20 01 24 mtmsr r9
/*
* Now determine if we need to perform a dispatch on the current CPU.
*/
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
ffc0b1f0: 39 3f 31 a0 addi r9,r31,12704
ffc0b1f4: 89 09 00 0c lbz r8,12(r9)
ffc0b1f8: 2f 88 00 00 cmpwi cr7,r8,0
ffc0b1fc: 40 9e fe c8 bne+ cr7,ffc0b0c4 <_Thread_Dispatch+0x58>
ffc0b200: 4b ff fe dc b ffc0b0dc <_Thread_Dispatch+0x70>
const API_extensions_Post_switch_control *post_switch =
(const API_extensions_Post_switch_control *) node;
(*post_switch->hook)( executing );
ffc0b204: 81 3f 00 08 lwz r9,8(r31)
ffc0b208: 7e c3 b3 78 mr r3,r22
ffc0b20c: 7d 29 03 a6 mtctr r9
ffc0b210: 4e 80 04 21 bctrl
#ifdef RTEMS_SMP
_Thread_Unnest_dispatch();
#endif
_API_extensions_Run_post_switch( executing );
}
ffc0b214: 83 ff 00 00 lwz r31,0(r31)
{
const Chain_Control *chain = &_API_extensions_Post_switch_list;
const Chain_Node *tail = _Chain_Immutable_tail( chain );
const Chain_Node *node = _Chain_Immutable_first( chain );
while ( node != tail ) {
ffc0b218: 7f 9f f0 00 cmpw cr7,r31,r30
ffc0b21c: 40 9e ff e8 bne+ cr7,ffc0b204 <_Thread_Dispatch+0x198>
ffc0b220: 39 61 00 48 addi r11,r1,72
ffc0b224: 4b ff 53 74 b ffc00598 <_restgpr_20_x>
ffc1035c <_Thread_Handler>:
#define INIT_NAME __main
#define EXECUTE_GLOBAL_CONSTRUCTORS
#endif
void _Thread_Handler( void )
{
ffc1035c: 94 21 ff f0 stwu r1,-16(r1)
ffc10360: 7c 08 02 a6 mflr r0
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
static bool doneConstructors;
bool doCons;
#endif
executing = _Thread_Executing;
ffc10364: 3d 20 00 00 lis r9,0
#define INIT_NAME __main
#define EXECUTE_GLOBAL_CONSTRUCTORS
#endif
void _Thread_Handler( void )
{
ffc10368: 90 01 00 14 stw r0,20(r1)
ffc1036c: bf c1 00 08 stmw r30,8(r1)
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
static bool doneConstructors;
bool doCons;
#endif
executing = _Thread_Executing;
ffc10370: 83 e9 31 b0 lwz r31,12720(r9)
/*
* have to put level into a register for those cpu's that use
* inline asm here
*/
level = executing->Start.isr_level;
ffc10374: 81 5f 00 a8 lwz r10,168(r31)
}
static inline void _CPU_ISR_Set_level( uint32_t level )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc10378: 39 20 00 00 li r9,0
ffc1037c: 7d 20 00 a6 mfmsr r9
if (!(level & CPU_MODES_INTERRUPT_MASK)) {
ffc10380: 71 48 00 01 andi. r8,r10,1
static inline uint32_t ppc_interrupt_get_disable_mask( void )
{
uint32_t mask;
__asm__ volatile (
ffc10384: 7d 50 42 a6 mfsprg r10,0
ffc10388: 40 a2 00 0c bne+ ffc10394 <_Thread_Handler+0x38>
msr |= ppc_interrupt_get_disable_mask();
ffc1038c: 7d 49 4b 78 or r9,r10,r9
ffc10390: 48 00 00 08 b ffc10398 <_Thread_Handler+0x3c>
}
else {
msr &= ~ppc_interrupt_get_disable_mask();
ffc10394: 7d 29 50 78 andc r9,r9,r10
}
_CPU_MSR_SET(msr);
ffc10398: 7d 20 01 24 mtmsr r9
doCons = !doneConstructors
&& _Objects_Get_API( executing->Object.id ) != OBJECTS_INTERNAL_API;
if (doCons)
doneConstructors = true;
#else
doCons = !doneConstructors;
ffc1039c: 3d 20 00 00 lis r9,0
ffc103a0: 8b c9 2a 3c lbz r30,10812(r9)
);
}
static inline void _User_extensions_Thread_begin( Thread_Control *executing )
{
_User_extensions_Iterate(
ffc103a4: 3c 80 ff c1 lis r4,-63
doneConstructors = true;
ffc103a8: 39 40 00 01 li r10,1
ffc103ac: 7f e3 fb 78 mr r3,r31
ffc103b0: 99 49 2a 3c stb r10,10812(r9)
ffc103b4: 38 84 be 24 addi r4,r4,-16860
ffc103b8: 4b ff ba b9 bl ffc0be70 <_User_extensions_Iterate>
_User_extensions_Thread_begin( executing );
/*
* At this point, the dispatch disable level BETTER be 1.
*/
_Thread_Enable_dispatch();
ffc103bc: 4b ff ae 6d bl ffc0b228 <_Thread_Enable_dispatch>
/*
* _init could be a weak symbol and we SHOULD test it but it isn't
* in any configuration I know of and it generates a warning on every
* RTEMS target configuration. --joel (12 May 2007)
*/
if (doCons) /* && (volatile void *)_init) */ {
ffc103c0: 2f 9e 00 00 cmpwi cr7,r30,0
ffc103c4: 40 be 00 08 bne+ cr7,ffc103cc <_Thread_Handler+0x70>
INIT_NAME ();
ffc103c8: 48 00 bb 75 bl ffc1bf3c <_init>
_Thread_Enable_dispatch();
#endif
}
#endif
if ( executing->Start.prototype == THREAD_START_NUMERIC ) {
ffc103cc: 81 3f 00 90 lwz r9,144(r31)
ffc103d0: 2f 89 00 00 cmpwi cr7,r9,0
ffc103d4: 40 be 00 10 bne+ cr7,ffc103e4 <_Thread_Handler+0x88>
executing->Wait.return_argument =
(*(Thread_Entry_numeric) executing->Start.entry_point)(
ffc103d8: 81 3f 00 8c lwz r9,140(r31)
ffc103dc: 80 7f 00 98 lwz r3,152(r31)
ffc103e0: 48 00 00 14 b ffc103f4 <_Thread_Handler+0x98>
executing->Start.numeric_argument
);
}
#if defined(RTEMS_POSIX_API)
else if ( executing->Start.prototype == THREAD_START_POINTER ) {
ffc103e4: 2f 89 00 01 cmpwi cr7,r9,1
ffc103e8: 40 be 00 18 bne+ cr7,ffc10400 <_Thread_Handler+0xa4> <== NEVER TAKEN
executing->Wait.return_argument =
(*(Thread_Entry_pointer) executing->Start.entry_point)(
ffc103ec: 81 3f 00 8c lwz r9,140(r31)
ffc103f0: 80 7f 00 94 lwz r3,148(r31)
ffc103f4: 7d 29 03 a6 mtctr r9
ffc103f8: 4e 80 04 21 bctrl
executing->Start.numeric_argument
);
}
#if defined(RTEMS_POSIX_API)
else if ( executing->Start.prototype == THREAD_START_POINTER ) {
executing->Wait.return_argument =
ffc103fc: 90 7f 00 28 stw r3,40(r31)
}
}
static inline void _User_extensions_Thread_exitted( Thread_Control *executing )
{
_User_extensions_Iterate(
ffc10400: 3c 80 ff c1 lis r4,-63
ffc10404: 7f e3 fb 78 mr r3,r31
ffc10408: 38 84 be 38 addi r4,r4,-16840
ffc1040c: 4b ff ba 65 bl ffc0be70 <_User_extensions_Iterate>
* able to fit in a (void *).
*/
_User_extensions_Thread_exitted( executing );
_Internal_error_Occurred(
ffc10410: 38 60 00 00 li r3,0
ffc10414: 38 80 00 01 li r4,1
ffc10418: 38 a0 00 05 li r5,5
ffc1041c: 4b ff 99 b5 bl ffc09dd0 <_Internal_error_Occurred>
ffc0b518 <_Thread_Handler_initialization>:
#include <rtems/bspsmp.h>
#endif
void _Thread_Handler_initialization(void)
{
uint32_t ticks_per_timeslice =
ffc0b518: 3d 20 ff c2 lis r9,-62
#if defined(RTEMS_SMP)
#include <rtems/bspsmp.h>
#endif
void _Thread_Handler_initialization(void)
{
ffc0b51c: 94 21 ff f0 stwu r1,-16(r1)
uint32_t ticks_per_timeslice =
ffc0b520: 39 29 bf 98 addi r9,r9,-16488
#if defined(RTEMS_SMP)
#include <rtems/bspsmp.h>
#endif
void _Thread_Handler_initialization(void)
{
ffc0b524: 7c 08 02 a6 mflr r0
#if defined(RTEMS_MULTIPROCESSING)
uint32_t maximum_proxies =
_Configuration_MP_table->maximum_proxies;
#endif
if ( rtems_configuration_get_stack_allocate_hook() == NULL ||
ffc0b528: 81 09 00 28 lwz r8,40(r9)
#if defined(RTEMS_SMP)
#include <rtems/bspsmp.h>
#endif
void _Thread_Handler_initialization(void)
{
ffc0b52c: bf c1 00 08 stmw r30,8(r1)
#if defined(RTEMS_MULTIPROCESSING)
uint32_t maximum_proxies =
_Configuration_MP_table->maximum_proxies;
#endif
if ( rtems_configuration_get_stack_allocate_hook() == NULL ||
ffc0b530: 2f 88 00 00 cmpwi cr7,r8,0
#if defined(RTEMS_SMP)
#include <rtems/bspsmp.h>
#endif
void _Thread_Handler_initialization(void)
{
ffc0b534: 90 01 00 14 stw r0,20(r1)
uint32_t ticks_per_timeslice =
ffc0b538: 83 e9 00 14 lwz r31,20(r9)
rtems_configuration_get_ticks_per_timeslice();
uint32_t maximum_extensions =
ffc0b53c: 83 c9 00 08 lwz r30,8(r9)
rtems_configuration_get_maximum_extensions();
rtems_stack_allocate_init_hook stack_allocate_init_hook =
ffc0b540: 81 49 00 24 lwz r10,36(r9)
#if defined(RTEMS_MULTIPROCESSING)
uint32_t maximum_proxies =
_Configuration_MP_table->maximum_proxies;
#endif
if ( rtems_configuration_get_stack_allocate_hook() == NULL ||
ffc0b544: 41 9e 00 10 beq- cr7,ffc0b554 <_Thread_Handler_initialization+0x3c><== NEVER TAKEN
ffc0b548: 81 09 00 2c lwz r8,44(r9)
ffc0b54c: 2f 88 00 00 cmpwi cr7,r8,0
ffc0b550: 40 be 00 14 bne+ cr7,ffc0b564 <_Thread_Handler_initialization+0x4c>
rtems_configuration_get_stack_free_hook() == NULL)
_Internal_error_Occurred(
ffc0b554: 38 60 00 00 li r3,0
ffc0b558: 38 80 00 01 li r4,1
ffc0b55c: 38 a0 00 0e li r5,14
ffc0b560: 4b ff e8 71 bl ffc09dd0 <_Internal_error_Occurred>
INTERNAL_ERROR_CORE,
true,
INTERNAL_ERROR_BAD_STACK_HOOK
);
if ( stack_allocate_init_hook != NULL )
ffc0b564: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0b568: 41 9e 00 10 beq- cr7,ffc0b578 <_Thread_Handler_initialization+0x60>
(*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() );
ffc0b56c: 80 69 00 04 lwz r3,4(r9)
ffc0b570: 7d 49 03 a6 mtctr r10
ffc0b574: 4e 80 04 21 bctrl
_Thread_Dispatch_necessary = false;
ffc0b578: 3d 40 00 00 lis r10,0
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
ffc0b57c: 80 01 00 14 lwz r0,20(r1)
);
if ( stack_allocate_init_hook != NULL )
(*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() );
_Thread_Dispatch_necessary = false;
ffc0b580: 39 4a 31 a0 addi r10,r10,12704
ffc0b584: 39 20 00 00 li r9,0
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
ffc0b588: 7c 08 03 a6 mtlr r0
);
if ( stack_allocate_init_hook != NULL )
(*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() );
_Thread_Dispatch_necessary = false;
ffc0b58c: 99 2a 00 0c stb r9,12(r10)
_Thread_Executing = NULL;
ffc0b590: 39 20 00 00 li r9,0
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b594: 3c 60 00 00 lis r3,0
if ( stack_allocate_init_hook != NULL )
(*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() );
_Thread_Dispatch_necessary = false;
_Thread_Executing = NULL;
ffc0b598: 91 2a 00 10 stw r9,16(r10)
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b59c: 38 63 2d f4 addi r3,r3,11764
ffc0b5a0: 38 80 00 01 li r4,1
if ( stack_allocate_init_hook != NULL )
(*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() );
_Thread_Dispatch_necessary = false;
_Thread_Executing = NULL;
_Thread_Heir = NULL;
ffc0b5a4: 91 2a 00 14 stw r9,20(r10)
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
_Thread_Allocated_fp = NULL;
ffc0b5a8: 3d 40 00 00 lis r10,0
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b5ac: 38 a0 00 01 li r5,1
_Thread_Dispatch_necessary = false;
_Thread_Executing = NULL;
_Thread_Heir = NULL;
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
_Thread_Allocated_fp = NULL;
ffc0b5b0: 91 2a 28 6c stw r9,10348(r10)
#endif
_Thread_Maximum_extensions = maximum_extensions;
ffc0b5b4: 3d 20 00 00 lis r9,0
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b5b8: 38 c0 00 01 li r6,1
_Thread_Heir = NULL;
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
_Thread_Allocated_fp = NULL;
#endif
_Thread_Maximum_extensions = maximum_extensions;
ffc0b5bc: 93 c9 28 74 stw r30,10356(r9)
_Thread_Ticks_per_timeslice = ticks_per_timeslice;
ffc0b5c0: 3d 20 00 00 lis r9,0
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b5c4: 38 e0 01 60 li r7,352
_Thread_Allocated_fp = NULL;
#endif
_Thread_Maximum_extensions = maximum_extensions;
_Thread_Ticks_per_timeslice = ticks_per_timeslice;
ffc0b5c8: 93 e9 28 64 stw r31,10340(r9)
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b5cc: 39 00 00 00 li r8,0
ffc0b5d0: 39 20 00 08 li r9,8
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
ffc0b5d4: bb c1 00 08 lmw r30,8(r1)
ffc0b5d8: 38 21 00 10 addi r1,r1,16
#if defined(RTEMS_MULTIPROCESSING)
if ( _System_state_Is_multiprocessing )
maximum_internal_threads += 1;
#endif
_Objects_Initialize_information(
ffc0b5dc: 4b ff ed e0 b ffc0a3bc <_Objects_Initialize_information>
ffc0b2d8 <_Thread_Initialize>:
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b2d8: 94 21 ff c0 stwu r1,-64(r1)
ffc0b2dc: 7c 08 02 a6 mflr r0
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b2e0: 39 60 00 00 li r11,0
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b2e4: be e1 00 1c stmw r23,28(r1)
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
ffc0b2e8: 7c bd 2b 79 mr. r29,r5
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b2ec: 7d 3a 4b 78 mr r26,r9
ffc0b2f0: 90 01 00 44 stw r0,68(r1)
ffc0b2f4: 7c 78 1b 78 mr r24,r3
ffc0b2f8: 7c 9f 23 78 mr r31,r4
ffc0b2fc: 81 21 00 50 lwz r9,80(r1)
ffc0b300: 7c de 33 78 mr r30,r6
ffc0b304: 7c f7 3b 78 mr r23,r7
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b308: 91 64 01 4c stw r11,332(r4)
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b30c: 7d 1c 43 78 mr r28,r8
ffc0b310: 7d 5b 53 78 mr r27,r10
ffc0b314: 83 29 00 00 lwz r25,0(r9)
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b318: 91 64 01 50 stw r11,336(r4)
extensions_area = NULL;
the_thread->libc_reent = NULL;
ffc0b31c: 91 64 01 48 stw r11,328(r4)
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
ffc0b320: 40 a2 00 38 bne+ ffc0b358 <_Thread_Initialize+0x80>
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
ffc0b324: 7c 83 23 78 mr r3,r4
ffc0b328: 7c c4 33 78 mr r4,r6
ffc0b32c: 48 00 09 09 bl ffc0bc34 <_Thread_Stack_Allocate>
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
ffc0b330: 39 60 00 00 li r11,0
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
if ( !actual_stack_size || actual_stack_size < stack_size )
ffc0b334: 2c 03 00 00 cmpwi r3,0
ffc0b338: 41 82 01 d4 beq- ffc0b50c <_Thread_Initialize+0x234>
ffc0b33c: 7f 83 f0 40 cmplw cr7,r3,r30
return false; /* stack allocation failed */
ffc0b340: 7f ab eb 78 mr r11,r29
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
if ( !actual_stack_size || actual_stack_size < stack_size )
ffc0b344: 41 9c 01 c8 blt- cr7,ffc0b50c <_Thread_Initialize+0x234><== NEVER TAKEN
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
the_thread->Start.core_allocated_stack = true;
ffc0b348: 39 20 00 01 li r9,1
if ( !stack_area ) {
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
ffc0b34c: 83 bf 00 c0 lwz r29,192(r31)
the_thread->Start.core_allocated_stack = true;
ffc0b350: 99 3f 00 b0 stb r9,176(r31)
ffc0b354: 48 00 00 0c b ffc0b360 <_Thread_Initialize+0x88>
} else {
stack = stack_area;
actual_stack_size = stack_size;
the_thread->Start.core_allocated_stack = false;
ffc0b358: 99 64 00 b0 stb r11,176(r4)
ffc0b35c: 7c c3 33 78 mr r3,r6
/*
* Allocate the floating point area for this thread
*/
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( is_fp ) {
ffc0b360: 2f 97 00 00 cmpwi cr7,r23,0
Stack_Control *the_stack,
void *starting_address,
size_t size
)
{
the_stack->area = starting_address;
ffc0b364: 93 bf 00 b8 stw r29,184(r31)
extensions_area = NULL;
the_thread->libc_reent = NULL;
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
fp_area = NULL;
ffc0b368: 3b a0 00 00 li r29,0
the_stack->size = size;
ffc0b36c: 90 7f 00 b4 stw r3,180(r31)
/*
* Allocate the floating point area for this thread
*/
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( is_fp ) {
ffc0b370: 41 be 00 14 beq+ cr7,ffc0b384 <_Thread_Initialize+0xac>
fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE );
ffc0b374: 38 60 01 08 li r3,264
ffc0b378: 48 00 10 01 bl ffc0c378 <_Workspace_Allocate>
if ( !fp_area )
ffc0b37c: 7c 7d 1b 79 mr. r29,r3
ffc0b380: 41 82 01 48 beq- ffc0b4c8 <_Thread_Initialize+0x1f0>
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b384: 3d 20 00 00 lis r9,0
fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE );
if ( !fp_area )
goto failed;
fp_area = _Context_Fp_start( fp_area, 0 );
}
the_thread->fp_context = fp_area;
ffc0b388: 93 bf 01 44 stw r29,324(r31)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0b38c: 38 e0 00 00 li r7,0
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b390: 80 69 28 74 lwz r3,10356(r9)
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
extensions_area = NULL;
ffc0b394: 3b c0 00 00 li r30,0
if ( !fp_area )
goto failed;
fp_area = _Context_Fp_start( fp_area, 0 );
}
the_thread->fp_context = fp_area;
the_thread->Start.fp_context = fp_area;
ffc0b398: 93 bf 00 bc stw r29,188(r31)
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b39c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b3a0: 90 ff 00 50 stw r7,80(r31)
the_watchdog->routine = routine;
ffc0b3a4: 90 ff 00 64 stw r7,100(r31)
the_watchdog->id = id;
ffc0b3a8: 90 ff 00 68 stw r7,104(r31)
the_watchdog->user_data = user_data;
ffc0b3ac: 90 ff 00 6c stw r7,108(r31)
ffc0b3b0: 41 be 00 18 beq+ cr7,ffc0b3c8 <_Thread_Initialize+0xf0>
extensions_area = _Workspace_Allocate(
ffc0b3b4: 38 63 00 01 addi r3,r3,1
ffc0b3b8: 54 63 10 3a rlwinm r3,r3,2,0,29
ffc0b3bc: 48 00 0f bd bl ffc0c378 <_Workspace_Allocate>
(_Thread_Maximum_extensions + 1) * sizeof( void * )
);
if ( !extensions_area )
ffc0b3c0: 7c 7e 1b 79 mr. r30,r3
ffc0b3c4: 41 82 01 08 beq- ffc0b4cc <_Thread_Initialize+0x1f4>
* if they are linked to the thread. An extension user may
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
ffc0b3c8: 2f 9e 00 00 cmpwi cr7,r30,0
(_Thread_Maximum_extensions + 1) * sizeof( void * )
);
if ( !extensions_area )
goto failed;
}
the_thread->extensions = (void **) extensions_area;
ffc0b3cc: 93 df 01 54 stw r30,340(r31)
* if they are linked to the thread. An extension user may
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
ffc0b3d0: 40 be 00 20 bne+ cr7,ffc0b3f0 <_Thread_Initialize+0x118>
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
switch ( budget_algorithm ) {
ffc0b3d4: 2f 9b 00 02 cmpwi cr7,r27,2
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
ffc0b3d8: 81 21 00 48 lwz r9,72(r1)
/*
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
ffc0b3dc: 9b 5f 00 9c stb r26,156(r31)
the_thread->Start.budget_algorithm = budget_algorithm;
ffc0b3e0: 93 7f 00 a0 stw r27,160(r31)
the_thread->Start.budget_callout = budget_callout;
ffc0b3e4: 91 3f 00 a4 stw r9,164(r31)
switch ( budget_algorithm ) {
ffc0b3e8: 40 be 00 44 bne+ cr7,ffc0b42c <_Thread_Initialize+0x154>
ffc0b3ec: 48 00 00 34 b ffc0b420 <_Thread_Initialize+0x148>
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
for ( i = 0; i <= _Thread_Maximum_extensions ; i++ )
ffc0b3f0: 3d 20 00 00 lis r9,0
ffc0b3f4: 81 49 28 74 lwz r10,10356(r9)
ffc0b3f8: 38 e0 00 00 li r7,0
the_thread->extensions[i] = NULL;
ffc0b3fc: 39 00 00 00 li r8,0
ffc0b400: 48 00 00 14 b ffc0b414 <_Thread_Initialize+0x13c>
ffc0b404: 81 3f 01 54 lwz r9,340(r31)
ffc0b408: 54 e6 10 3a rlwinm r6,r7,2,0,29
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
for ( i = 0; i <= _Thread_Maximum_extensions ; i++ )
ffc0b40c: 38 e7 00 01 addi r7,r7,1
the_thread->extensions[i] = NULL;
ffc0b410: 7d 09 31 2e stwx r8,r9,r6
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
for ( i = 0; i <= _Thread_Maximum_extensions ; i++ )
ffc0b414: 7f 87 50 40 cmplw cr7,r7,r10
ffc0b418: 40 9d ff ec ble+ cr7,ffc0b404 <_Thread_Initialize+0x12c>
ffc0b41c: 4b ff ff b8 b ffc0b3d4 <_Thread_Initialize+0xfc>
case THREAD_CPU_BUDGET_ALGORITHM_NONE:
case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE:
break;
#if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE)
case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b420: 3d 20 00 00 lis r9,0
ffc0b424: 81 29 28 64 lwz r9,10340(r9)
ffc0b428: 91 3f 00 74 stw r9,116(r31)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
#endif
}
the_thread->Start.isr_level = isr_level;
ffc0b42c: 81 21 00 4c lwz r9,76(r1)
the_thread->current_state = STATES_DORMANT;
ffc0b430: 3b 40 00 01 li r26,1
ffc0b434: 93 5f 00 10 stw r26,16(r31)
*/
RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate(
Thread_Control *the_thread
)
{
return _Scheduler.Operations.allocate( the_thread );
ffc0b438: 7f e3 fb 78 mr r3,r31
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
#endif
}
the_thread->Start.isr_level = isr_level;
ffc0b43c: 91 3f 00 a8 stw r9,168(r31)
the_thread->current_state = STATES_DORMANT;
the_thread->Wait.queue = NULL;
ffc0b440: 39 20 00 00 li r9,0
ffc0b444: 91 3f 00 44 stw r9,68(r31)
the_thread->resource_count = 0;
ffc0b448: 91 3f 00 1c stw r9,28(r31)
ffc0b44c: 3d 20 00 00 lis r9,0
ffc0b450: 81 29 20 98 lwz r9,8344(r9)
the_thread->real_priority = priority;
ffc0b454: 93 9f 00 18 stw r28,24(r31)
ffc0b458: 7d 29 03 a6 mtctr r9
the_thread->Start.initial_priority = priority;
ffc0b45c: 93 9f 00 ac stw r28,172(r31)
ffc0b460: 4e 80 04 21 bctrl
sched =_Scheduler_Allocate( the_thread );
if ( !sched )
ffc0b464: 7c 7b 1b 79 mr. r27,r3
ffc0b468: 41 82 00 68 beq- ffc0b4d0 <_Thread_Initialize+0x1f8>
goto failed;
_Thread_Set_priority( the_thread, priority );
ffc0b46c: 7f e3 fb 78 mr r3,r31
ffc0b470: 7f 84 e3 78 mr r4,r28
ffc0b474: 48 00 06 fd bl ffc0bb70 <_Thread_Set_priority>
Objects_Information *information,
Objects_Control *the_object,
Objects_Name name
)
{
_Objects_Set_local_object(
ffc0b478: a1 3f 00 0a lhz r9,10(r31)
static inline void _Timestamp64_implementation_Set_to_zero(
Timestamp64_Control *_time
)
{
*_time = 0;
ffc0b47c: 39 40 00 00 li r10,0
ffc0b480: 91 5f 00 80 stw r10,128(r31)
ffc0b484: 39 60 00 00 li r11,0
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc0b488: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0b48c: 81 58 00 1c lwz r10,28(r24)
static inline bool _User_extensions_Thread_create( Thread_Control *created )
{
User_extensions_Thread_create_context ctx = { created, true };
_User_extensions_Iterate( &ctx, _User_extensions_Thread_create_visitor );
ffc0b490: 3c 80 ff c1 lis r4,-63
ffc0b494: 91 7f 00 84 stw r11,132(r31)
ffc0b498: 38 61 00 08 addi r3,r1,8
ffc0b49c: 38 84 bd 94 addi r4,r4,-17004
ffc0b4a0: 7f ea 49 2e stwx r31,r10,r9
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
ffc0b4a4: 93 3f 00 0c stw r25,12(r31)
* @{
*/
static inline bool _User_extensions_Thread_create( Thread_Control *created )
{
User_extensions_Thread_create_context ctx = { created, true };
ffc0b4a8: 93 e1 00 08 stw r31,8(r1)
ffc0b4ac: 9b 41 00 0c stb r26,12(r1)
_User_extensions_Iterate( &ctx, _User_extensions_Thread_create_visitor );
ffc0b4b0: 48 00 09 c1 bl ffc0be70 <_User_extensions_Iterate>
* Mutex provides sufficient protection to let the user extensions
* run safely.
*/
extension_status = _User_extensions_Thread_create( the_thread );
if ( extension_status )
return true;
ffc0b4b4: 39 60 00 01 li r11,1
return ctx.ok;
ffc0b4b8: 89 21 00 0c lbz r9,12(r1)
* user extensions with dispatching enabled. The Allocator
* Mutex provides sufficient protection to let the user extensions
* run safely.
*/
extension_status = _User_extensions_Thread_create( the_thread );
if ( extension_status )
ffc0b4bc: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b4c0: 41 be 00 10 beq+ cr7,ffc0b4d0 <_Thread_Initialize+0x1f8>
ffc0b4c4: 48 00 00 48 b ffc0b50c <_Thread_Initialize+0x234>
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
extensions_area = NULL;
ffc0b4c8: 3b c0 00 00 li r30,0
size_t actual_stack_size = 0;
void *stack = NULL;
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
void *fp_area;
#endif
void *sched = NULL;
ffc0b4cc: 3b 60 00 00 li r27,0
extension_status = _User_extensions_Thread_create( the_thread );
if ( extension_status )
return true;
failed:
_Workspace_Free( the_thread->libc_reent );
ffc0b4d0: 80 7f 01 48 lwz r3,328(r31)
ffc0b4d4: 48 00 0e bd bl ffc0c390 <_Workspace_Free>
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
_Workspace_Free( the_thread->API_Extensions[i] );
ffc0b4d8: 80 7f 01 4c lwz r3,332(r31)
ffc0b4dc: 48 00 0e b5 bl ffc0c390 <_Workspace_Free>
ffc0b4e0: 80 7f 01 50 lwz r3,336(r31)
ffc0b4e4: 48 00 0e ad bl ffc0c390 <_Workspace_Free>
_Workspace_Free( extensions_area );
ffc0b4e8: 7f c3 f3 78 mr r3,r30
ffc0b4ec: 48 00 0e a5 bl ffc0c390 <_Workspace_Free>
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
_Workspace_Free( fp_area );
ffc0b4f0: 7f a3 eb 78 mr r3,r29
ffc0b4f4: 48 00 0e 9d bl ffc0c390 <_Workspace_Free>
#endif
_Workspace_Free( sched );
ffc0b4f8: 7f 63 db 78 mr r3,r27
ffc0b4fc: 48 00 0e 95 bl ffc0c390 <_Workspace_Free>
_Thread_Stack_Free( the_thread );
ffc0b500: 7f e3 fb 78 mr r3,r31
ffc0b504: 48 00 07 8d bl ffc0bc90 <_Thread_Stack_Free>
return false;
ffc0b508: 39 60 00 00 li r11,0
}
ffc0b50c: 7d 63 5b 78 mr r3,r11
ffc0b510: 39 61 00 40 addi r11,r1,64
ffc0b514: 4b ff 50 90 b ffc005a4 <_restgpr_23_x>
ffc0c3c4 <_Thread_Restart>:
bool _Thread_Restart(
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
ffc0c3c4: 94 21 ff e8 stwu r1,-24(r1)
ffc0c3c8: 7c 08 02 a6 mflr r0
ffc0c3cc: 90 01 00 1c stw r0,28(r1)
*/
RTEMS_INLINE_ROUTINE bool _States_Is_dormant (
States_Control the_states
)
{
return (the_states & STATES_DORMANT);
ffc0c3d0: 81 23 00 10 lwz r9,16(r3)
ffc0c3d4: bf c1 00 10 stmw r30,16(r1)
ffc0c3d8: 7c 7f 1b 78 mr r31,r3
if ( !_States_Is_dormant( the_thread->current_state ) ) {
ffc0c3dc: 71 2a 00 01 andi. r10,r9,1
ffc0c3e0: 40 a2 00 7c bne+ ffc0c45c <_Thread_Restart+0x98>
_Thread_Set_transient( the_thread );
ffc0c3e4: 90 81 00 08 stw r4,8(r1)
ffc0c3e8: 90 a1 00 0c stw r5,12(r1)
ffc0c3ec: 48 00 00 ed bl ffc0c4d8 <_Thread_Set_transient>
_Thread_Reset( the_thread, pointer_argument, numeric_argument );
ffc0c3f0: 7f e3 fb 78 mr r3,r31
ffc0c3f4: 80 81 00 08 lwz r4,8(r1)
ffc0c3f8: 80 a1 00 0c lwz r5,12(r1)
ffc0c3fc: 48 00 30 21 bl ffc0f41c <_Thread_Reset>
_Thread_Load_environment( the_thread );
ffc0c400: 7f e3 fb 78 mr r3,r31
ffc0c404: 48 00 2c fd bl ffc0f100 <_Thread_Load_environment>
_Thread_Ready( the_thread );
ffc0c408: 7f e3 fb 78 mr r3,r31
ffc0c40c: 48 00 2f c9 bl ffc0f3d4 <_Thread_Ready>
);
}
static inline void _User_extensions_Thread_restart( Thread_Control *restarted )
{
_User_extensions_Iterate(
ffc0c410: 3c 80 ff c1 lis r4,-63
ffc0c414: 7f e3 fb 78 mr r3,r31
ffc0c418: 38 84 c7 08 addi r4,r4,-14584
ffc0c41c: 48 00 03 4d bl ffc0c768 <_User_extensions_Iterate>
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc0c420: 3d 20 00 00 lis r9,0
ffc0c424: 39 29 31 e0 addi r9,r9,12768
_User_extensions_Thread_restart( the_thread );
if ( _Thread_Is_executing ( the_thread ) )
ffc0c428: 81 49 00 10 lwz r10,16(r9)
_Thread_Restart_self();
return true;
ffc0c42c: 38 60 00 01 li r3,1
ffc0c430: 7d 3e 4b 78 mr r30,r9
_Thread_Ready( the_thread );
_User_extensions_Thread_restart( the_thread );
if ( _Thread_Is_executing ( the_thread ) )
ffc0c434: 7f 9f 50 00 cmpw cr7,r31,r10
ffc0c438: 40 be 00 28 bne+ cr7,ffc0c460 <_Thread_Restart+0x9c>
*/
RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void )
{
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( _Thread_Executing->fp_context != NULL )
ffc0c43c: 81 3f 01 44 lwz r9,324(r31)
ffc0c440: 2f 89 00 00 cmpwi cr7,r9,0
ffc0c444: 41 9e 00 0c beq- cr7,ffc0c450 <_Thread_Restart+0x8c> <== NEVER TAKEN
_Context_Restore_fp( &_Thread_Executing->fp_context );
ffc0c448: 38 7f 01 44 addi r3,r31,324
ffc0c44c: 48 00 f4 75 bl ffc1b8c0 <_CPU_Context_restore_fp>
#endif
_CPU_Context_Restart_self( &_Thread_Executing->Registers );
ffc0c450: 80 7e 00 10 lwz r3,16(r30)
ffc0c454: 38 63 00 c4 addi r3,r3,196
ffc0c458: 48 00 f5 fd bl ffc1ba54 <_CPU_Context_restore>
_Thread_Restart_self();
return true;
}
return false;
ffc0c45c: 38 60 00 00 li r3,0
}
ffc0c460: 39 61 00 18 addi r11,r1,24
ffc0c464: 4b ff 49 bc b ffc00e20 <_restgpr_30_x>
ffc0bab8 <_Thread_queue_Requeue>:
void _Thread_queue_Requeue(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread
)
{
ffc0bab8: 94 21 ff d8 stwu r1,-40(r1)
ffc0babc: 7c 08 02 a6 mflr r0
ffc0bac0: bf a1 00 1c stmw r29,28(r1)
/*
* Just in case the thread really wasn't blocked on a thread queue
* when we get here.
*/
if ( !the_thread_queue )
ffc0bac4: 7c 7f 1b 79 mr. r31,r3
void _Thread_queue_Requeue(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread
)
{
ffc0bac8: 90 01 00 2c stw r0,44(r1)
/*
* Just in case the thread really wasn't blocked on a thread queue
* when we get here.
*/
if ( !the_thread_queue )
ffc0bacc: 41 82 00 58 beq- ffc0bb24 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN
/*
* If queueing by FIFO, there is nothing to do. This only applies to
* priority blocking discipline.
*/
if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) {
ffc0bad0: 81 3f 00 34 lwz r9,52(r31)
ffc0bad4: 2f 89 00 01 cmpwi cr7,r9,1
ffc0bad8: 40 be 00 4c bne+ cr7,ffc0bb24 <_Thread_queue_Requeue+0x6c><== NEVER TAKEN
ffc0badc: 7c 9e 23 78 mr r30,r4
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0bae0: 7f a0 00 a6 mfmsr r29
ffc0bae4: 7d 50 42 a6 mfsprg r10,0
ffc0bae8: 7f aa 50 78 andc r10,r29,r10
ffc0baec: 7d 40 01 24 mtmsr r10
Thread_queue_Control *tq = the_thread_queue;
ISR_Level level;
ISR_Level level_ignored;
_ISR_Disable( level );
if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) {
ffc0baf0: 3d 00 00 03 lis r8,3
ffc0baf4: 81 44 00 10 lwz r10,16(r4)
ffc0baf8: 61 08 be e0 ori r8,r8,48864
ffc0bafc: 7d 07 50 39 and. r7,r8,r10
ffc0bb00: 41 a2 00 20 beq+ ffc0bb20 <_Thread_queue_Requeue+0x68> <== NEVER TAKEN
RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section (
Thread_queue_Control *the_thread_queue
)
{
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
ffc0bb04: 91 3f 00 30 stw r9,48(r31)
_Thread_queue_Enter_critical_section( tq );
_Thread_queue_Extract_priority_helper( tq, the_thread, true );
ffc0bb08: 38 a0 00 01 li r5,1
ffc0bb0c: 48 00 2e 81 bl ffc0e98c <_Thread_queue_Extract_priority_helper>
(void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored );
ffc0bb10: 7f e3 fb 78 mr r3,r31
ffc0bb14: 7f c4 f3 78 mr r4,r30
ffc0bb18: 38 a1 00 08 addi r5,r1,8
ffc0bb1c: 4b ff fd 11 bl ffc0b82c <_Thread_queue_Enqueue_priority>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0bb20: 7f a0 01 24 mtmsr r29
}
_ISR_Enable( level );
}
}
ffc0bb24: 39 61 00 28 addi r11,r1,40
ffc0bb28: 4b ff 4a 94 b ffc005bc <_restgpr_29_x>
ffc0bb2c <_Thread_queue_Timeout>:
void _Thread_queue_Timeout(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0bb2c: 94 21 ff e8 stwu r1,-24(r1)
ffc0bb30: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0bb34: 38 81 00 08 addi r4,r1,8
void _Thread_queue_Timeout(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0bb38: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0bb3c: 4b ff f7 09 bl ffc0b244 <_Thread_Get>
switch ( location ) {
ffc0bb40: 81 21 00 08 lwz r9,8(r1)
ffc0bb44: 2f 89 00 00 cmpwi cr7,r9,0
ffc0bb48: 40 9e 00 18 bne- cr7,ffc0bb60 <_Thread_queue_Timeout+0x34><== NEVER TAKEN
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_queue_Process_timeout( the_thread );
ffc0bb4c: 48 00 2f 45 bl ffc0ea90 <_Thread_queue_Process_timeout>
*
* This routine decrements the thread dispatch level.
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0bb50: 3d 20 00 00 lis r9,0
ffc0bb54: 81 49 28 68 lwz r10,10344(r9)
--level;
ffc0bb58: 39 4a ff ff addi r10,r10,-1
_Thread_Dispatch_disable_level = level;
ffc0bb5c: 91 49 28 68 stw r10,10344(r9)
_Thread_Unnest_dispatch();
break;
}
}
ffc0bb60: 80 01 00 1c lwz r0,28(r1)
ffc0bb64: 38 21 00 18 addi r1,r1,24
ffc0bb68: 7c 08 03 a6 mtlr r0
ffc0bb6c: 4e 80 00 20 blr
ffc19d40 <_Timer_server_Body>:
* @a arg points to the corresponding timer server control block.
*/
static rtems_task _Timer_server_Body(
rtems_task_argument arg
)
{
ffc19d40: 94 21 ff a0 stwu r1,-96(r1)
ffc19d44: 7c 08 02 a6 mflr r0
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
head->previous = NULL;
ffc19d48: 39 20 00 00 li r9,0
ffc19d4c: be 41 00 28 stmw r18,40(r1)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc19d50: 3a c1 00 14 addi r22,r1,20
ffc19d54: 3a 61 00 18 addi r19,r1,24
ffc19d58: 3b 21 00 0c addi r25,r1,12
ffc19d5c: 90 01 00 64 stw r0,100(r1)
head->previous = NULL;
tail->previous = head;
ffc19d60: 3b a1 00 08 addi r29,r1,8
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc19d64: 92 61 00 14 stw r19,20(r1)
ffc19d68: 7c 7f 1b 78 mr r31,r3
static void _Timer_server_Process_interval_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
ffc19d6c: 3e a0 00 00 lis r21,0
head->previous = NULL;
ffc19d70: 91 21 00 18 stw r9,24(r1)
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19d74: 3b 43 00 30 addi r26,r3,48
static void _Timer_server_Process_tod_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
ffc19d78: 3e 80 00 00 lis r20,0
tail->previous = head;
ffc19d7c: 92 c1 00 1c stw r22,28(r1)
/*
* The current TOD is before the last TOD which indicates that
* TOD has been set backwards.
*/
delta = last_snapshot - snapshot;
_Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta );
ffc19d80: 3b 83 00 68 addi r28,r3,104
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
if ( watchdog != NULL ) {
watchdog->state = WATCHDOG_INACTIVE;
ffc19d84: 3a 40 00 00 li r18,0
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc19d88: 93 21 00 08 stw r25,8(r1)
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc19d8c: 3f 60 00 00 lis r27,0
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
ffc19d90: 3a e3 00 08 addi r23,r3,8
head->previous = NULL;
ffc19d94: 91 21 00 0c stw r9,12(r1)
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
ffc19d98: 3b 03 00 40 addi r24,r3,64
tail->previous = head;
ffc19d9c: 93 a1 00 10 stw r29,16(r1)
{
/*
* Afterwards all timer inserts are directed to this chain and the interval
* and TOD chains will be no more modified by other parties.
*/
ts->insert_chain = insert_chain;
ffc19da0: 92 df 00 78 stw r22,120(r31)
static void _Timer_server_Process_interval_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
ffc19da4: 81 35 29 5c lwz r9,10588(r21)
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19da8: 7f 43 d3 78 mr r3,r26
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
/*
* We assume adequate unsigned arithmetic here.
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
ffc19dac: 80 9f 00 3c lwz r4,60(r31)
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19db0: 7f a5 eb 78 mr r5,r29
/*
* We assume adequate unsigned arithmetic here.
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
ffc19db4: 91 3f 00 3c stw r9,60(r31)
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19db8: 7c 84 48 50 subf r4,r4,r9
ffc19dbc: 48 00 48 5d bl ffc1e618 <_Watchdog_Adjust_to_chain>
static void _Timer_server_Process_tod_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
ffc19dc0: 39 34 70 80 addi r9,r20,28800
ffc19dc4: 80 69 00 00 lwz r3,0(r9)
ffc19dc8: 3c c0 3b 9a lis r6,15258
ffc19dcc: 80 89 00 04 lwz r4,4(r9)
ffc19dd0: 38 a0 00 00 li r5,0
ffc19dd4: 60 c6 ca 00 ori r6,r6,51712
ffc19dd8: 48 01 46 b1 bl ffc2e488 <__divdi3>
Watchdog_Interval last_snapshot = watchdogs->last_snapshot;
ffc19ddc: 80 bf 00 74 lwz r5,116(r31)
ffc19de0: 7c 9e 23 78 mr r30,r4
/*
* Process the seconds chain. Start by checking that the Time
* of Day (TOD) has not been set backwards. If it has then
* we want to adjust the watchdogs->Chain to indicate this.
*/
if ( snapshot > last_snapshot ) {
ffc19de4: 7f 84 28 40 cmplw cr7,r4,r5
ffc19de8: 40 bd 00 18 ble+ cr7,ffc19e00 <_Timer_server_Body+0xc0>
/*
* This path is for normal forward movement and cases where the
* TOD has been set forward.
*/
delta = snapshot - last_snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19dec: 7c 85 20 50 subf r4,r5,r4
ffc19df0: 7f 83 e3 78 mr r3,r28
ffc19df4: 7f a5 eb 78 mr r5,r29
ffc19df8: 48 00 48 21 bl ffc1e618 <_Watchdog_Adjust_to_chain>
ffc19dfc: 48 00 00 18 b ffc19e14 <_Timer_server_Body+0xd4>
} else if ( snapshot < last_snapshot ) {
ffc19e00: 40 bc 00 14 bge+ cr7,ffc19e14 <_Timer_server_Body+0xd4>
/*
* The current TOD is before the last TOD which indicates that
* TOD has been set backwards.
*/
delta = last_snapshot - snapshot;
_Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta );
ffc19e04: 7f 83 e3 78 mr r3,r28
ffc19e08: 38 80 00 01 li r4,1
ffc19e0c: 7c be 28 50 subf r5,r30,r5
ffc19e10: 48 00 47 4d bl ffc1e55c <_Watchdog_Adjust>
}
watchdogs->last_snapshot = snapshot;
ffc19e14: 93 df 00 74 stw r30,116(r31)
}
static void _Timer_server_Process_insertions( Timer_server_Control *ts )
{
while ( true ) {
Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain );
ffc19e18: 80 7f 00 78 lwz r3,120(r31)
ffc19e1c: 48 00 0b 45 bl ffc1a960 <_Chain_Get>
if ( timer == NULL ) {
ffc19e20: 7c 7e 1b 79 mr. r30,r3
ffc19e24: 41 82 00 2c beq- ffc19e50 <_Timer_server_Body+0x110>
static void _Timer_server_Insert_timer(
Timer_server_Control *ts,
Timer_Control *timer
)
{
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
ffc19e28: 81 3e 00 38 lwz r9,56(r30)
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
ffc19e2c: 7f 43 d3 78 mr r3,r26
static void _Timer_server_Insert_timer(
Timer_server_Control *ts,
Timer_Control *timer
)
{
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
ffc19e30: 2f 89 00 01 cmpwi cr7,r9,1
ffc19e34: 41 9e 00 10 beq- cr7,ffc19e44 <_Timer_server_Body+0x104>
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
ffc19e38: 2f 89 00 03 cmpwi cr7,r9,3
ffc19e3c: 40 9e ff dc bne+ cr7,ffc19e18 <_Timer_server_Body+0xd8> <== NEVER TAKEN
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
ffc19e40: 7f 83 e3 78 mr r3,r28
ffc19e44: 38 9e 00 10 addi r4,r30,16
ffc19e48: 48 00 48 6d bl ffc1e6b4 <_Watchdog_Insert>
ffc19e4c: 4b ff ff cc b ffc19e18 <_Timer_server_Body+0xd8>
* of zero it will be processed in the next iteration of the timer server
* body loop.
*/
_Timer_server_Process_insertions( ts );
_ISR_Disable( level );
ffc19e50: 4b ff fe 05 bl ffc19c54 <ppc_interrupt_disable>
if ( _Chain_Is_empty( insert_chain ) ) {
ffc19e54: 81 21 00 14 lwz r9,20(r1)
ffc19e58: 7f 89 98 00 cmpw cr7,r9,r19
ffc19e5c: 40 be 00 1c bne+ cr7,ffc19e78 <_Timer_server_Body+0x138><== NEVER TAKEN
ts->insert_chain = NULL;
ffc19e60: 93 df 00 78 stw r30,120(r31)
ffc19e64: 7c 60 01 24 mtmsr r3
_Chain_Initialize_empty( &fire_chain );
while ( true ) {
_Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain );
if ( !_Chain_Is_empty( &fire_chain ) ) {
ffc19e68: 81 21 00 08 lwz r9,8(r1)
ffc19e6c: 7f 89 c8 00 cmpw cr7,r9,r25
ffc19e70: 40 be 00 10 bne+ cr7,ffc19e80 <_Timer_server_Body+0x140>
ffc19e74: 48 00 00 50 b ffc19ec4 <_Timer_server_Body+0x184>
ffc19e78: 7c 60 01 24 mtmsr r3 <== NOT EXECUTED
ffc19e7c: 4b ff ff 28 b ffc19da4 <_Timer_server_Body+0x64> <== NOT EXECUTED
/*
* It is essential that interrupts are disable here since an interrupt
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
ffc19e80: 4b ff fd d5 bl ffc19c54 <ppc_interrupt_disable>
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc19e84: 81 21 00 08 lwz r9,8(r1)
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
Chain_Control *the_chain
)
{
if ( !_Chain_Is_empty(the_chain))
ffc19e88: 7f 89 c8 00 cmpw cr7,r9,r25
ffc19e8c: 41 9e 00 30 beq- cr7,ffc19ebc <_Timer_server_Body+0x17c>
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *old_first = head->next;
Chain_Node *new_first = old_first->next;
ffc19e90: 81 49 00 00 lwz r10,0(r9)
head->next = new_first;
new_first->previous = head;
ffc19e94: 93 aa 00 04 stw r29,4(r10)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *old_first = head->next;
Chain_Node *new_first = old_first->next;
head->next = new_first;
ffc19e98: 91 41 00 08 stw r10,8(r1)
watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
if ( watchdog != NULL ) {
watchdog->state = WATCHDOG_INACTIVE;
ffc19e9c: 92 49 00 08 stw r18,8(r9)
ffc19ea0: 7c 60 01 24 mtmsr r3
/*
* The timer server may block here and wait for resources or time.
* The system watchdogs are inactive and will remain inactive since
* the active flag of the timer server is true.
*/
(*watchdog->routine)( watchdog->id, watchdog->user_data );
ffc19ea4: 81 49 00 1c lwz r10,28(r9)
ffc19ea8: 80 69 00 20 lwz r3,32(r9)
ffc19eac: 80 89 00 24 lwz r4,36(r9)
ffc19eb0: 7d 49 03 a6 mtctr r10
ffc19eb4: 4e 80 04 21 bctrl
}
ffc19eb8: 4b ff ff c8 b ffc19e80 <_Timer_server_Body+0x140>
ffc19ebc: 7c 60 01 24 mtmsr r3
ffc19ec0: 4b ff fe e0 b ffc19da0 <_Timer_server_Body+0x60>
} else {
ts->active = false;
ffc19ec4: 39 20 00 00 li r9,0
ffc19ec8: 99 3f 00 7c stb r9,124(r31)
ffc19ecc: 81 3b 29 3c lwz r9,10556(r27)
++level;
ffc19ed0: 39 29 00 01 addi r9,r9,1
_Thread_Dispatch_disable_level = level;
ffc19ed4: 91 3b 29 3c stw r9,10556(r27)
/*
* Block until there is something to do.
*/
_Thread_Disable_dispatch();
_Thread_Set_state( ts->thread, STATES_DELAYING );
ffc19ed8: 80 7f 00 00 lwz r3,0(r31)
ffc19edc: 38 80 00 08 li r4,8
ffc19ee0: 48 00 42 6d bl ffc1e14c <_Thread_Set_state>
_Timer_server_Reset_interval_system_watchdog( ts );
ffc19ee4: 7f e3 fb 78 mr r3,r31
ffc19ee8: 4b ff fd 81 bl ffc19c68 <_Timer_server_Reset_interval_system_watchdog>
_Timer_server_Reset_tod_system_watchdog( ts );
ffc19eec: 7f e3 fb 78 mr r3,r31
ffc19ef0: 4b ff fd e5 bl ffc19cd4 <_Timer_server_Reset_tod_system_watchdog>
_Thread_Enable_dispatch();
ffc19ef4: 48 00 38 59 bl ffc1d74c <_Thread_Enable_dispatch>
ts->active = true;
ffc19ef8: 39 20 00 01 li r9,1
ffc19efc: 99 3f 00 7c stb r9,124(r31)
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
ffc19f00: 7e e3 bb 78 mr r3,r23
ffc19f04: 48 00 49 0d bl ffc1e810 <_Watchdog_Remove>
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
ffc19f08: 7f 03 c3 78 mr r3,r24
ffc19f0c: 48 00 49 05 bl ffc1e810 <_Watchdog_Remove>
ffc19f10: 4b ff fe 90 b ffc19da0 <_Timer_server_Body+0x60>
ffc19f14 <_Timer_server_Schedule_operation_method>:
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
ffc19f14: 94 21 ff e8 stwu r1,-24(r1)
ffc19f18: 7c 08 02 a6 mflr r0
ffc19f1c: 90 01 00 1c stw r0,28(r1)
if ( ts->insert_chain == NULL ) {
ffc19f20: 81 23 00 78 lwz r9,120(r3)
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
ffc19f24: bf a1 00 0c stmw r29,12(r1)
ffc19f28: 7c 7f 1b 78 mr r31,r3
if ( ts->insert_chain == NULL ) {
ffc19f2c: 2f 89 00 00 cmpwi cr7,r9,0
ffc19f30: 40 be 01 3c bne+ cr7,ffc1a06c <_Timer_server_Schedule_operation_method+0x158>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc19f34: 3d 20 00 00 lis r9,0
ffc19f38: 81 49 29 3c lwz r10,10556(r9)
ffc19f3c: 7c 9e 23 78 mr r30,r4
++level;
ffc19f40: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc19f44: 91 49 29 3c stw r10,10556(r9)
* being inserted. This could result in an integer overflow.
*/
_Thread_Disable_dispatch();
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
ffc19f48: 81 24 00 38 lwz r9,56(r4)
ffc19f4c: 2f 89 00 01 cmpwi cr7,r9,1
ffc19f50: 40 be 00 6c bne+ cr7,ffc19fbc <_Timer_server_Schedule_operation_method+0xa8>
/*
* We have to advance the last known ticks value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
ffc19f54: 4b ff fd 01 bl ffc19c54 <ppc_interrupt_disable>
snapshot = _Watchdog_Ticks_since_boot;
ffc19f58: 3d 20 00 00 lis r9,0
ffc19f5c: 81 49 29 5c lwz r10,10588(r9)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc19f60: 39 1f 00 34 addi r8,r31,52
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc19f64: 81 3f 00 30 lwz r9,48(r31)
last_snapshot = ts->Interval_watchdogs.last_snapshot;
ffc19f68: 80 ff 00 3c lwz r7,60(r31)
if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) {
ffc19f6c: 7f 89 40 00 cmpw cr7,r9,r8
ffc19f70: 41 9e 00 20 beq- cr7,ffc19f90 <_Timer_server_Schedule_operation_method+0x7c>
/*
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
delta_interval = first_watchdog->delta_interval;
ffc19f74: 80 c9 00 10 lwz r6,16(r9)
first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain );
/*
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
ffc19f78: 7c e7 50 50 subf r7,r7,r10
delta_interval = first_watchdog->delta_interval;
if (delta_interval > delta) {
delta_interval -= delta;
} else {
delta_interval = 0;
ffc19f7c: 39 00 00 00 li r8,0
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
delta_interval = first_watchdog->delta_interval;
if (delta_interval > delta) {
ffc19f80: 7f 86 38 40 cmplw cr7,r6,r7
ffc19f84: 40 9d 00 08 ble- cr7,ffc19f8c <_Timer_server_Schedule_operation_method+0x78>
delta_interval -= delta;
ffc19f88: 7d 07 30 50 subf r8,r7,r6
} else {
delta_interval = 0;
}
first_watchdog->delta_interval = delta_interval;
ffc19f8c: 91 09 00 10 stw r8,16(r9)
}
ts->Interval_watchdogs.last_snapshot = snapshot;
ffc19f90: 91 5f 00 3c stw r10,60(r31)
ffc19f94: 7c 60 01 24 mtmsr r3
_ISR_Enable( level );
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
ffc19f98: 38 7f 00 30 addi r3,r31,48
ffc19f9c: 38 9e 00 10 addi r4,r30,16
ffc19fa0: 48 00 47 15 bl ffc1e6b4 <_Watchdog_Insert>
if ( !ts->active ) {
ffc19fa4: 89 3f 00 7c lbz r9,124(r31)
ffc19fa8: 2f 89 00 00 cmpwi cr7,r9,0
ffc19fac: 40 be 00 ac bne+ cr7,ffc1a058 <_Timer_server_Schedule_operation_method+0x144>
_Timer_server_Reset_interval_system_watchdog( ts );
ffc19fb0: 7f e3 fb 78 mr r3,r31
ffc19fb4: 4b ff fc b5 bl ffc19c68 <_Timer_server_Reset_interval_system_watchdog>
ffc19fb8: 48 00 00 a0 b ffc1a058 <_Timer_server_Schedule_operation_method+0x144>
}
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
ffc19fbc: 2f 89 00 03 cmpwi cr7,r9,3
ffc19fc0: 40 be 00 98 bne+ cr7,ffc1a058 <_Timer_server_Schedule_operation_method+0x144>
/*
* We have to advance the last known seconds value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
ffc19fc4: 4b ff fc 91 bl ffc19c54 <ppc_interrupt_disable>
ffc19fc8: 7c 7d 1b 78 mr r29,r3
ffc19fcc: 3d 20 00 00 lis r9,0
ffc19fd0: 39 29 70 80 addi r9,r9,28800
ffc19fd4: 80 69 00 00 lwz r3,0(r9)
ffc19fd8: 3c c0 3b 9a lis r6,15258
ffc19fdc: 80 89 00 04 lwz r4,4(r9)
ffc19fe0: 38 a0 00 00 li r5,0
ffc19fe4: 60 c6 ca 00 ori r6,r6,51712
ffc19fe8: 48 01 44 a1 bl ffc2e488 <__divdi3>
ffc19fec: 81 3f 00 68 lwz r9,104(r31)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc19ff0: 39 1f 00 6c addi r8,r31,108
snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
last_snapshot = ts->TOD_watchdogs.last_snapshot;
ffc19ff4: 81 5f 00 74 lwz r10,116(r31)
if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) {
ffc19ff8: 7f 89 40 00 cmpw cr7,r9,r8
ffc19ffc: 41 9e 00 34 beq- cr7,ffc1a030 <_Timer_server_Schedule_operation_method+0x11c>
first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain );
delta_interval = first_watchdog->delta_interval;
if ( snapshot > last_snapshot ) {
ffc1a000: 7f 84 50 40 cmplw cr7,r4,r10
_ISR_Disable( level );
snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
last_snapshot = ts->TOD_watchdogs.last_snapshot;
if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) {
first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain );
delta_interval = first_watchdog->delta_interval;
ffc1a004: 81 09 00 10 lwz r8,16(r9)
if ( snapshot > last_snapshot ) {
ffc1a008: 40 9d 00 1c ble- cr7,ffc1a024 <_Timer_server_Schedule_operation_method+0x110>
/*
* We advanced in time.
*/
delta = snapshot - last_snapshot;
ffc1a00c: 7c ea 20 50 subf r7,r10,r4
if (delta_interval > delta) {
ffc1a010: 7f 88 38 40 cmplw cr7,r8,r7
delta_interval -= delta;
} else {
delta_interval = 0;
ffc1a014: 39 40 00 00 li r10,0
if ( snapshot > last_snapshot ) {
/*
* We advanced in time.
*/
delta = snapshot - last_snapshot;
if (delta_interval > delta) {
ffc1a018: 40 9d 00 14 ble- cr7,ffc1a02c <_Timer_server_Schedule_operation_method+0x118><== NEVER TAKEN
delta_interval -= delta;
ffc1a01c: 7d 47 40 50 subf r10,r7,r8
ffc1a020: 48 00 00 0c b ffc1a02c <_Timer_server_Schedule_operation_method+0x118>
}
} else {
/*
* Someone put us in the past.
*/
delta = last_snapshot - snapshot;
ffc1a024: 7d 48 52 14 add r10,r8,r10
delta_interval += delta;
ffc1a028: 7d 44 50 50 subf r10,r4,r10
}
first_watchdog->delta_interval = delta_interval;
ffc1a02c: 91 49 00 10 stw r10,16(r9)
}
ts->TOD_watchdogs.last_snapshot = snapshot;
ffc1a030: 90 9f 00 74 stw r4,116(r31)
ffc1a034: 7f a0 01 24 mtmsr r29
_ISR_Enable( level );
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
ffc1a038: 38 7f 00 68 addi r3,r31,104
ffc1a03c: 38 9e 00 10 addi r4,r30,16
ffc1a040: 48 00 46 75 bl ffc1e6b4 <_Watchdog_Insert>
if ( !ts->active ) {
ffc1a044: 89 3f 00 7c lbz r9,124(r31)
ffc1a048: 2f 89 00 00 cmpwi cr7,r9,0
ffc1a04c: 40 be 00 0c bne+ cr7,ffc1a058 <_Timer_server_Schedule_operation_method+0x144><== NEVER TAKEN
_Timer_server_Reset_tod_system_watchdog( ts );
ffc1a050: 7f e3 fb 78 mr r3,r31
ffc1a054: 4b ff fc 81 bl ffc19cd4 <_Timer_server_Reset_tod_system_watchdog>
* critical section. We have to use the protected chain methods because
* we may be interrupted by a higher priority interrupt.
*/
_Chain_Append( ts->insert_chain, &timer->Object.Node );
}
}
ffc1a058: 80 01 00 1c lwz r0,28(r1)
ffc1a05c: bb a1 00 0c lmw r29,12(r1)
ffc1a060: 7c 08 03 a6 mtlr r0
ffc1a064: 38 21 00 18 addi r1,r1,24
if ( !ts->active ) {
_Timer_server_Reset_tod_system_watchdog( ts );
}
}
_Thread_Enable_dispatch();
ffc1a068: 48 00 36 e4 b ffc1d74c <_Thread_Enable_dispatch>
* critical section. We have to use the protected chain methods because
* we may be interrupted by a higher priority interrupt.
*/
_Chain_Append( ts->insert_chain, &timer->Object.Node );
}
}
ffc1a06c: 80 01 00 1c lwz r0,28(r1)
ffc1a070: bb a1 00 0c lmw r29,12(r1)
ffc1a074: 7c 08 03 a6 mtlr r0
* server is not preemptible, so we must be in interrupt context here. No
* thread dispatch will happen until the timer server finishes its
* critical section. We have to use the protected chain methods because
* we may be interrupted by a higher priority interrupt.
*/
_Chain_Append( ts->insert_chain, &timer->Object.Node );
ffc1a078: 80 63 00 78 lwz r3,120(r3)
}
}
ffc1a07c: 38 21 00 18 addi r1,r1,24
* server is not preemptible, so we must be in interrupt context here. No
* thread dispatch will happen until the timer server finishes its
* critical section. We have to use the protected chain methods because
* we may be interrupted by a higher priority interrupt.
*/
_Chain_Append( ts->insert_chain, &timer->Object.Node );
ffc1a080: 48 00 08 b0 b ffc1a930 <_Chain_Append>
ffc0d628 <_Timestamp64_Divide>:
const Timestamp64_Control *_lhs,
const Timestamp64_Control *_rhs,
uint32_t *_ival_percentage,
uint32_t *_fval_percentage
)
{
ffc0d628: 94 21 ff e8 stwu r1,-24(r1)
ffc0d62c: 7c 08 02 a6 mflr r0
ffc0d630: 90 01 00 1c stw r0,28(r1)
ffc0d634: bf 81 00 08 stmw r28,8(r1)
ffc0d638: 7c be 2b 78 mr r30,r5
ffc0d63c: 7c df 33 78 mr r31,r6
Timestamp64_Control answer;
if ( *_rhs == 0 ) {
ffc0d640: 80 a4 00 00 lwz r5,0(r4)
ffc0d644: 81 24 00 04 lwz r9,4(r4)
ffc0d648: 7c a8 4b 79 or. r8,r5,r9
ffc0d64c: 40 a2 00 10 bne+ ffc0d65c <_Timestamp64_Divide+0x34> <== ALWAYS TAKEN
*_ival_percentage = 0;
ffc0d650: 91 1e 00 00 stw r8,0(r30) <== NOT EXECUTED
*_fval_percentage = 0;
ffc0d654: 91 06 00 00 stw r8,0(r6) <== NOT EXECUTED
return;
ffc0d658: 48 00 00 5c b ffc0d6b4 <_Timestamp64_Divide+0x8c> <== NOT EXECUTED
* This looks odd but gives the results the proper precision.
*
* TODO: Rounding on the last digit of the fval.
*/
answer = (*_lhs * 100000) / *_rhs;
ffc0d65c: 80 c3 00 04 lwz r6,4(r3)
ffc0d660: 3d 00 00 01 lis r8,1
ffc0d664: 80 e3 00 00 lwz r7,0(r3)
ffc0d668: 61 08 86 a0 ori r8,r8,34464
ffc0d66c: 7c 68 30 16 mulhwu r3,r8,r6
ffc0d670: 7c e8 39 d6 mullw r7,r8,r7
ffc0d674: 7c 88 31 d6 mullw r4,r8,r6
ffc0d678: 7c 67 1a 14 add r3,r7,r3
ffc0d67c: 7d 26 4b 78 mr r6,r9
ffc0d680: 48 00 ea 19 bl ffc1c098 <__divdi3>
*_ival_percentage = answer / 1000;
ffc0d684: 38 a0 00 00 li r5,0
ffc0d688: 38 c0 03 e8 li r6,1000
* This looks odd but gives the results the proper precision.
*
* TODO: Rounding on the last digit of the fval.
*/
answer = (*_lhs * 100000) / *_rhs;
ffc0d68c: 7c 7c 1b 78 mr r28,r3
ffc0d690: 7c 9d 23 78 mr r29,r4
*_ival_percentage = answer / 1000;
ffc0d694: 48 00 ea 05 bl ffc1c098 <__divdi3>
ffc0d698: 90 9e 00 00 stw r4,0(r30)
*_fval_percentage = answer % 1000;
ffc0d69c: 7f 83 e3 78 mr r3,r28
ffc0d6a0: 7f a4 eb 78 mr r4,r29
ffc0d6a4: 38 a0 00 00 li r5,0
ffc0d6a8: 38 c0 03 e8 li r6,1000
ffc0d6ac: 48 00 ee 11 bl ffc1c4bc <__moddi3>
ffc0d6b0: 90 9f 00 00 stw r4,0(r31)
}
ffc0d6b4: 39 61 00 18 addi r11,r1,24
ffc0d6b8: 4b ff 3c 78 b ffc01330 <_restgpr_28_x>
ffc0d91c <_Watchdog_Adjust>:
void _Watchdog_Adjust(
Chain_Control *header,
Watchdog_Adjust_directions direction,
Watchdog_Interval units
)
{
ffc0d91c: 94 21 ff e8 stwu r1,-24(r1)
ffc0d920: 7c 08 02 a6 mflr r0
ffc0d924: 90 01 00 1c stw r0,28(r1)
ffc0d928: bf 81 00 08 stmw r28,8(r1)
ffc0d92c: 7c 7e 1b 78 mr r30,r3
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0d930: 7d 20 00 a6 mfmsr r9
ffc0d934: 7d 50 42 a6 mfsprg r10,0
ffc0d938: 7d 2a 50 78 andc r10,r9,r10
ffc0d93c: 7d 40 01 24 mtmsr r10
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc0d940: 81 43 00 00 lwz r10,0(r3)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc0d944: 3b a3 00 04 addi r29,r3,4
* hence the compiler must not assume *header to remain
* unmodified across that call.
*
* Till Straumann, 7/2003
*/
if ( !_Chain_Is_empty( header ) ) {
ffc0d948: 7f 8a e8 00 cmpw cr7,r10,r29
ffc0d94c: 41 9e 00 80 beq- cr7,ffc0d9cc <_Watchdog_Adjust+0xb0>
switch ( direction ) {
ffc0d950: 2f 84 00 00 cmpwi cr7,r4,0
ffc0d954: 7c bf 2b 78 mr r31,r5
ffc0d958: 41 9e 00 68 beq- cr7,ffc0d9c0 <_Watchdog_Adjust+0xa4>
ffc0d95c: 2f 84 00 01 cmpwi cr7,r4,1
ffc0d960: 40 be 00 6c bne+ cr7,ffc0d9cc <_Watchdog_Adjust+0xb0> <== NEVER TAKEN
case WATCHDOG_BACKWARD:
_Watchdog_First( header )->delta_interval += units;
ffc0d964: 81 0a 00 10 lwz r8,16(r10)
ffc0d968: 7f e8 2a 14 add r31,r8,r5
ffc0d96c: 48 00 00 18 b ffc0d984 <_Watchdog_Adjust+0x68>
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First(
Chain_Control *the_chain
)
{
return _Chain_Head( the_chain )->next;
ffc0d970: 81 5e 00 00 lwz r10,0(r30)
break;
case WATCHDOG_FORWARD:
while ( units ) {
if ( units < _Watchdog_First( header )->delta_interval ) {
ffc0d974: 81 0a 00 10 lwz r8,16(r10)
ffc0d978: 7f 9f 40 40 cmplw cr7,r31,r8
ffc0d97c: 40 bc 00 10 bge+ cr7,ffc0d98c <_Watchdog_Adjust+0x70>
_Watchdog_First( header )->delta_interval -= units;
ffc0d980: 7f ff 40 50 subf r31,r31,r8
ffc0d984: 93 ea 00 10 stw r31,16(r10)
break;
ffc0d988: 48 00 00 44 b ffc0d9cc <_Watchdog_Adjust+0xb0>
} else {
units -= _Watchdog_First( header )->delta_interval;
_Watchdog_First( header )->delta_interval = 1;
ffc0d98c: 93 8a 00 10 stw r28,16(r10)
while ( units ) {
if ( units < _Watchdog_First( header )->delta_interval ) {
_Watchdog_First( header )->delta_interval -= units;
break;
} else {
units -= _Watchdog_First( header )->delta_interval;
ffc0d990: 7f e8 f8 50 subf r31,r8,r31
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0d994: 7d 20 01 24 mtmsr r9
_Watchdog_First( header )->delta_interval = 1;
_ISR_Enable( level );
_Watchdog_Tickle( header );
ffc0d998: 7f c3 f3 78 mr r3,r30
ffc0d99c: 48 00 02 41 bl ffc0dbdc <_Watchdog_Tickle>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0d9a0: 7d 20 00 a6 mfmsr r9
ffc0d9a4: 7d 50 42 a6 mfsprg r10,0
ffc0d9a8: 7d 2a 50 78 andc r10,r9,r10
ffc0d9ac: 7d 40 01 24 mtmsr r10
_ISR_Disable( level );
if ( _Chain_Is_empty( header ) )
ffc0d9b0: 81 5e 00 00 lwz r10,0(r30)
ffc0d9b4: 7f 8a e8 00 cmpw cr7,r10,r29
ffc0d9b8: 40 be 00 0c bne+ cr7,ffc0d9c4 <_Watchdog_Adjust+0xa8>
ffc0d9bc: 48 00 00 10 b ffc0d9cc <_Watchdog_Adjust+0xb0>
if ( units < _Watchdog_First( header )->delta_interval ) {
_Watchdog_First( header )->delta_interval -= units;
break;
} else {
units -= _Watchdog_First( header )->delta_interval;
_Watchdog_First( header )->delta_interval = 1;
ffc0d9c0: 3b 80 00 01 li r28,1
switch ( direction ) {
case WATCHDOG_BACKWARD:
_Watchdog_First( header )->delta_interval += units;
break;
case WATCHDOG_FORWARD:
while ( units ) {
ffc0d9c4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0d9c8: 40 9e ff a8 bne+ cr7,ffc0d970 <_Watchdog_Adjust+0x54> <== ALWAYS TAKEN
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0d9cc: 7d 20 01 24 mtmsr r9
}
}
_ISR_Enable( level );
}
ffc0d9d0: 39 61 00 18 addi r11,r1,24
ffc0d9d4: 4b ff 39 5c b ffc01330 <_restgpr_28_x>
ffc0c0f0 <_Watchdog_Remove>:
#include <rtems/score/watchdog.h>
Watchdog_States _Watchdog_Remove(
Watchdog_Control *the_watchdog
)
{
ffc0c0f0: 7c 69 1b 78 mr r9,r3
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc0c0f4: 7c c0 00 a6 mfmsr r6
ffc0c0f8: 7d 50 42 a6 mfsprg r10,0
ffc0c0fc: 7c ca 50 78 andc r10,r6,r10
ffc0c100: 7d 40 01 24 mtmsr r10
ISR_Level level;
Watchdog_States previous_state;
Watchdog_Control *next_watchdog;
_ISR_Disable( level );
previous_state = the_watchdog->state;
ffc0c104: 80 63 00 08 lwz r3,8(r3)
switch ( previous_state ) {
ffc0c108: 2f 83 00 01 cmpwi cr7,r3,1
ffc0c10c: 41 9e 00 18 beq- cr7,ffc0c124 <_Watchdog_Remove+0x34>
ffc0c110: 2b 83 00 01 cmplwi cr7,r3,1
ffc0c114: 41 9c 00 70 blt- cr7,ffc0c184 <_Watchdog_Remove+0x94>
ffc0c118: 2b 83 00 03 cmplwi cr7,r3,3
ffc0c11c: 41 9d 00 68 bgt- cr7,ffc0c184 <_Watchdog_Remove+0x94> <== NEVER TAKEN
ffc0c120: 48 00 00 10 b ffc0c130 <_Watchdog_Remove+0x40>
/*
* It is not actually on the chain so just change the state and
* the Insert operation we interrupted will be aborted.
*/
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0c124: 39 40 00 00 li r10,0
ffc0c128: 91 49 00 08 stw r10,8(r9)
break;
ffc0c12c: 48 00 00 58 b ffc0c184 <_Watchdog_Remove+0x94>
case WATCHDOG_ACTIVE:
case WATCHDOG_REMOVE_IT:
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0c130: 39 40 00 00 li r10,0
ffc0c134: 91 49 00 08 stw r10,8(r9)
}
the_watchdog->stop_time = _Watchdog_Ticks_since_boot;
_ISR_Enable( level );
return( previous_state );
}
ffc0c138: 81 49 00 00 lwz r10,0(r9)
case WATCHDOG_REMOVE_IT:
the_watchdog->state = WATCHDOG_INACTIVE;
next_watchdog = _Watchdog_Next( the_watchdog );
if ( _Watchdog_Next(next_watchdog) )
ffc0c13c: 81 0a 00 00 lwz r8,0(r10)
ffc0c140: 2f 88 00 00 cmpwi cr7,r8,0
ffc0c144: 41 9e 00 14 beq- cr7,ffc0c158 <_Watchdog_Remove+0x68>
next_watchdog->delta_interval += the_watchdog->delta_interval;
ffc0c148: 80 ea 00 10 lwz r7,16(r10)
ffc0c14c: 81 09 00 10 lwz r8,16(r9)
ffc0c150: 7d 07 42 14 add r8,r7,r8
ffc0c154: 91 0a 00 10 stw r8,16(r10)
if ( _Watchdog_Sync_count )
ffc0c158: 3d 00 00 00 lis r8,0
ffc0c15c: 81 08 28 84 lwz r8,10372(r8)
ffc0c160: 2f 88 00 00 cmpwi cr7,r8,0
ffc0c164: 41 9e 00 14 beq- cr7,ffc0c178 <_Watchdog_Remove+0x88>
_Watchdog_Sync_level = _ISR_Nest_level;
ffc0c168: 3d 00 00 00 lis r8,0
ffc0c16c: 80 e8 31 a8 lwz r7,12712(r8)
ffc0c170: 3d 00 00 00 lis r8,0
ffc0c174: 90 e8 28 7c stw r7,10364(r8)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
ffc0c178: 81 09 00 04 lwz r8,4(r9)
next->previous = previous;
ffc0c17c: 91 0a 00 04 stw r8,4(r10)
previous->next = next;
ffc0c180: 91 48 00 00 stw r10,0(r8)
_Chain_Extract_unprotected( &the_watchdog->Node );
break;
}
the_watchdog->stop_time = _Watchdog_Ticks_since_boot;
ffc0c184: 3d 40 00 00 lis r10,0
ffc0c188: 81 4a 28 88 lwz r10,10376(r10)
ffc0c18c: 91 49 00 18 stw r10,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc0c190: 7c c0 01 24 mtmsr r6
_ISR_Enable( level );
return( previous_state );
}
ffc0c194: 4e 80 00 20 blr
ffc0c240 <_Workspace_Handler_initialization>:
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c240: 3d 40 ff c2 lis r10,-62
void _Workspace_Handler_initialization(
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
ffc0c244: 7d 80 00 26 mfcr r12
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c248: 39 2a bf 98 addi r9,r10,-16488
void _Workspace_Handler_initialization(
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
ffc0c24c: 94 21 ff d0 stwu r1,-48(r1)
ffc0c250: 7c 08 02 a6 mflr r0
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c254: 89 09 00 32 lbz r8,50(r9)
void _Workspace_Handler_initialization(
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
ffc0c258: bf 01 00 10 stmw r24,16(r1)
ffc0c25c: 7c 99 23 78 mr r25,r4
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c260: 2f 88 00 00 cmpwi cr7,r8,0
ffc0c264: 83 ca bf 98 lwz r30,-16488(r10)
void _Workspace_Handler_initialization(
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
ffc0c268: 7c ba 2b 78 mr r26,r5
ffc0c26c: 90 01 00 34 stw r0,52(r1)
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c270: 39 40 00 00 li r10,0
void _Workspace_Handler_initialization(
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
ffc0c274: 91 81 00 0c stw r12,12(r1)
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
uintptr_t remaining = rtems_configuration_get_work_space_size();
ffc0c278: 40 9e 00 08 bne- cr7,ffc0c280 <_Workspace_Handler_initialization+0x40>
ffc0c27c: 81 49 00 04 lwz r10,4(r9)
ffc0c280: 7f ca f2 14 add r30,r10,r30
bool do_zero = rtems_configuration_get_do_zero_of_workspace();
ffc0c284: 89 49 00 30 lbz r10,48(r9)
bool unified = rtems_configuration_get_unified_work_area();
ffc0c288: 89 29 00 31 lbz r9,49(r9)
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
ffc0c28c: 3f 60 ff c1 lis r27,-63
} else {
size = 0;
}
}
space_available = (*init_or_extend)(
ffc0c290: 3f 00 00 00 lis r24,0
ffc0c294: 7c 7f 1b 78 mr r31,r3
bool unified = rtems_configuration_get_unified_work_area();
uintptr_t page_size = CPU_HEAP_ALIGNMENT;
uintptr_t overhead = _Heap_Area_overhead( page_size );
size_t i;
for (i = 0; i < area_count; ++i) {
ffc0c298: 3b 80 00 00 li r28,0
Heap_Area *areas,
size_t area_count,
Heap_Initialization_or_extend_handler extend
)
{
Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize;
ffc0c29c: 3b 7b 9b 50 addi r27,r27,-25776
size_t i;
for (i = 0; i < area_count; ++i) {
Heap_Area *area = &areas [i];
if ( do_zero ) {
ffc0c2a0: 2e 0a 00 00 cmpwi cr4,r10,0
if ( area->size > overhead ) {
uintptr_t space_available;
uintptr_t size;
if ( unified ) {
ffc0c2a4: 2d 89 00 00 cmpwi cr3,r9,0
} else {
size = 0;
}
}
space_available = (*init_or_extend)(
ffc0c2a8: 3b 18 2d 14 addi r24,r24,11540
bool unified = rtems_configuration_get_unified_work_area();
uintptr_t page_size = CPU_HEAP_ALIGNMENT;
uintptr_t overhead = _Heap_Area_overhead( page_size );
size_t i;
for (i = 0; i < area_count; ++i) {
ffc0c2ac: 48 00 00 9c b ffc0c348 <_Workspace_Handler_initialization+0x108>
Heap_Area *area = &areas [i];
if ( do_zero ) {
ffc0c2b0: 41 b2 00 14 beq+ cr4,ffc0c2c4 <_Workspace_Handler_initialization+0x84>
memset( area->begin, 0, area->size );
ffc0c2b4: 80 7f 00 00 lwz r3,0(r31)
ffc0c2b8: 38 80 00 00 li r4,0
ffc0c2bc: 80 bf 00 04 lwz r5,4(r31)
ffc0c2c0: 48 00 50 e5 bl ffc113a4 <memset>
}
if ( area->size > overhead ) {
ffc0c2c4: 83 bf 00 04 lwz r29,4(r31)
ffc0c2c8: 2b 9d 00 16 cmplwi cr7,r29,22
ffc0c2cc: 40 9d 00 74 ble- cr7,ffc0c340 <_Workspace_Handler_initialization+0x100>
uintptr_t space_available;
uintptr_t size;
if ( unified ) {
ffc0c2d0: 40 8e 00 24 bne- cr3,ffc0c2f4 <_Workspace_Handler_initialization+0xb4>
size = area->size;
} else {
if ( remaining > 0 ) {
ffc0c2d4: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0c2d8: 41 9e 00 18 beq- cr7,ffc0c2f0 <_Workspace_Handler_initialization+0xb0><== NEVER TAKEN
size = remaining < area->size - overhead ?
ffc0c2dc: 39 3d ff ea addi r9,r29,-22
remaining + overhead : area->size;
ffc0c2e0: 7f 9e 48 40 cmplw cr7,r30,r9
ffc0c2e4: 40 9c 00 10 bge- cr7,ffc0c2f4 <_Workspace_Handler_initialization+0xb4><== NEVER TAKEN
ffc0c2e8: 3b be 00 16 addi r29,r30,22
ffc0c2ec: 48 00 00 08 b ffc0c2f4 <_Workspace_Handler_initialization+0xb4>
} else {
size = 0;
ffc0c2f0: 3b a0 00 00 li r29,0 <== NOT EXECUTED
}
}
space_available = (*init_or_extend)(
ffc0c2f4: 7f a5 eb 78 mr r5,r29
ffc0c2f8: 80 9f 00 00 lwz r4,0(r31)
ffc0c2fc: 7f 03 c3 78 mr r3,r24
ffc0c300: 7f 69 03 a6 mtctr r27
ffc0c304: 38 c0 00 08 li r6,8
ffc0c308: 4e 80 04 21 bctrl
area->begin,
size,
page_size
);
area->begin = (char *) area->begin + size;
ffc0c30c: 81 3f 00 00 lwz r9,0(r31)
area->size -= size;
if ( space_available < remaining ) {
ffc0c310: 7f 83 f0 40 cmplw cr7,r3,r30
area->begin,
size,
page_size
);
area->begin = (char *) area->begin + size;
ffc0c314: 7d 29 ea 14 add r9,r9,r29
ffc0c318: 91 3f 00 00 stw r9,0(r31)
area->size -= size;
ffc0c31c: 81 3f 00 04 lwz r9,4(r31)
ffc0c320: 7f bd 48 50 subf r29,r29,r9
ffc0c324: 93 bf 00 04 stw r29,4(r31)
if ( space_available < remaining ) {
ffc0c328: 40 9c 00 10 bge- cr7,ffc0c338 <_Workspace_Handler_initialization+0xf8><== ALWAYS TAKEN
remaining -= space_available;
ffc0c32c: 7f c3 f0 50 subf r30,r3,r30 <== NOT EXECUTED
} else {
remaining = 0;
}
init_or_extend = extend;
ffc0c330: 7f 5b d3 78 mr r27,r26 <== NOT EXECUTED
ffc0c334: 48 00 00 0c b ffc0c340 <_Workspace_Handler_initialization+0x100><== NOT EXECUTED
ffc0c338: 7f 5b d3 78 mr r27,r26
area->size -= size;
if ( space_available < remaining ) {
remaining -= space_available;
} else {
remaining = 0;
ffc0c33c: 3b c0 00 00 li r30,0
bool unified = rtems_configuration_get_unified_work_area();
uintptr_t page_size = CPU_HEAP_ALIGNMENT;
uintptr_t overhead = _Heap_Area_overhead( page_size );
size_t i;
for (i = 0; i < area_count; ++i) {
ffc0c340: 3b 9c 00 01 addi r28,r28,1
ffc0c344: 3b ff 00 08 addi r31,r31,8
ffc0c348: 7f 9c c8 00 cmpw cr7,r28,r25
ffc0c34c: 40 9e ff 64 bne+ cr7,ffc0c2b0 <_Workspace_Handler_initialization+0x70>
init_or_extend = extend;
}
}
if ( remaining > 0 ) {
ffc0c350: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0c354: 41 be 00 14 beq+ cr7,ffc0c368 <_Workspace_Handler_initialization+0x128>
_Internal_error_Occurred(
ffc0c358: 38 60 00 00 li r3,0
ffc0c35c: 38 80 00 01 li r4,1
ffc0c360: 38 a0 00 02 li r5,2
ffc0c364: 4b ff da 6d bl ffc09dd0 <_Internal_error_Occurred>
INTERNAL_ERROR_CORE,
true,
INTERNAL_ERROR_TOO_LITTLE_WORKSPACE
);
}
}
ffc0c368: 81 81 00 0c lwz r12,12(r1)
ffc0c36c: 39 61 00 30 addi r11,r1,48
ffc0c370: 7d 81 81 20 mtcrf 24,r12
ffc0c374: 4b ff 42 34 b ffc005a8 <_restgpr_24_x>
ffc086b4 <aio_cancel>:
#include <stdlib.h>
#include <rtems/system.h>
#include <rtems/seterr.h>
int aio_cancel(int fildes, struct aiocb *aiocbp)
{
ffc086b4: 94 21 ff e0 stwu r1,-32(r1)
ffc086b8: 7c 08 02 a6 mflr r0
ffc086bc: bf 61 00 0c stmw r27,12(r1)
rtems_aio_request_chain *r_chain;
int result;
pthread_mutex_lock (&aio_request_queue.mutex);
ffc086c0: 3f e0 00 00 lis r31,0
ffc086c4: 3b ff 2b b0 addi r31,r31,11184
#include <stdlib.h>
#include <rtems/system.h>
#include <rtems/seterr.h>
int aio_cancel(int fildes, struct aiocb *aiocbp)
{
ffc086c8: 7c 7d 1b 78 mr r29,r3
ffc086cc: 90 01 00 24 stw r0,36(r1)
rtems_aio_request_chain *r_chain;
int result;
pthread_mutex_lock (&aio_request_queue.mutex);
ffc086d0: 7f e3 fb 78 mr r3,r31
#include <stdlib.h>
#include <rtems/system.h>
#include <rtems/seterr.h>
int aio_cancel(int fildes, struct aiocb *aiocbp)
{
ffc086d4: 7c 9e 23 78 mr r30,r4
rtems_aio_request_chain *r_chain;
int result;
pthread_mutex_lock (&aio_request_queue.mutex);
ffc086d8: 48 00 12 59 bl ffc09930 <pthread_mutex_lock>
if (fcntl (fildes, F_GETFD) < 0) {
ffc086dc: 7f a3 eb 78 mr r3,r29
ffc086e0: 38 80 00 01 li r4,1
ffc086e4: 4c c6 31 82 crclr 4*cr1+eq
ffc086e8: 48 00 6a 1d bl ffc0f104 <fcntl>
ffc086ec: 2f 83 00 00 cmpwi cr7,r3,0
ffc086f0: 40 bc 00 18 bge+ cr7,ffc08708 <aio_cancel+0x54>
pthread_mutex_unlock(&aio_request_queue.mutex);
ffc086f4: 7f e3 fb 78 mr r3,r31
ffc086f8: 48 00 12 c5 bl ffc099bc <pthread_mutex_unlock>
rtems_set_errno_and_return_minus_one (EBADF);
ffc086fc: 48 00 a0 35 bl ffc12730 <__errno>
ffc08700: 39 20 00 09 li r9,9
ffc08704: 48 00 01 20 b ffc08824 <aio_cancel+0x170>
}
/* if aiocbp is NULL remove all request for given file descriptor */
if (aiocbp == NULL) {
ffc08708: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0870c: 40 be 00 b8 bne+ cr7,ffc087c4 <aio_cancel+0x110>
AIO_printf ("Cancel all requests\n");
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0);
ffc08710: 38 7f 00 48 addi r3,r31,72
ffc08714: 7f a4 eb 78 mr r4,r29
ffc08718: 38 a0 00 00 li r5,0
ffc0871c: 48 00 05 ad bl ffc08cc8 <rtems_aio_search_fd>
if (r_chain == NULL) {
ffc08720: 7c 7e 1b 79 mr. r30,r3
ffc08724: 40 a2 00 6c bne+ ffc08790 <aio_cancel+0xdc>
AIO_printf ("Request chain not on [WQ]\n");
if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) {
ffc08728: 81 3f 00 54 lwz r9,84(r31)
ffc0872c: 39 5f 00 58 addi r10,r31,88
ffc08730: 7f 89 50 00 cmpw cr7,r9,r10
ffc08734: 41 9e 00 1c beq- cr7,ffc08750 <aio_cancel+0x9c> <== NEVER TAKEN
r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0);
ffc08738: 38 7f 00 54 addi r3,r31,84
ffc0873c: 7f a4 eb 78 mr r4,r29
ffc08740: 38 a0 00 00 li r5,0
ffc08744: 48 00 05 85 bl ffc08cc8 <rtems_aio_search_fd>
if (r_chain == NULL) {
ffc08748: 7c 7e 1b 79 mr. r30,r3
ffc0874c: 40 a2 00 18 bne+ ffc08764 <aio_cancel+0xb0>
pthread_mutex_unlock(&aio_request_queue.mutex);
ffc08750: 3c 60 00 00 lis r3,0
ffc08754: 38 63 2b b0 addi r3,r3,11184
ffc08758: 48 00 12 65 bl ffc099bc <pthread_mutex_unlock>
return AIO_ALLDONE;
ffc0875c: 3b c0 00 02 li r30,2
ffc08760: 48 00 01 10 b ffc08870 <aio_cancel+0x1bc>
*/
RTEMS_INLINE_ROUTINE void rtems_chain_extract(
rtems_chain_node *the_node
)
{
_Chain_Extract( the_node );
ffc08764: 48 00 2c d9 bl ffc0b43c <_Chain_Extract>
AIO_printf ("Request chain on [IQ]\n");
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
pthread_mutex_destroy (&r_chain->mutex);
ffc08768: 3b be 00 1c addi r29,r30,28
}
AIO_printf ("Request chain on [IQ]\n");
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
ffc0876c: 7f c3 f3 78 mr r3,r30
ffc08770: 48 00 06 19 bl ffc08d88 <rtems_aio_remove_fd>
pthread_mutex_destroy (&r_chain->mutex);
ffc08774: 7f a3 eb 78 mr r3,r29
ffc08778: 48 00 0e d9 bl ffc09650 <pthread_mutex_destroy>
pthread_cond_destroy (&r_chain->mutex);
ffc0877c: 7f a3 eb 78 mr r3,r29
ffc08780: 48 00 0b 19 bl ffc09298 <pthread_cond_destroy>
free (r_chain);
ffc08784: 7f c3 f3 78 mr r3,r30
ffc08788: 4b ff c1 21 bl ffc048a8 <free>
ffc0878c: 48 00 00 28 b ffc087b4 <aio_cancel+0x100>
return AIO_ALLDONE;
}
AIO_printf ("Request chain on [WQ]\n");
pthread_mutex_lock (&r_chain->mutex);
ffc08790: 3b be 00 1c addi r29,r30,28
ffc08794: 7f a3 eb 78 mr r3,r29
ffc08798: 48 00 11 99 bl ffc09930 <pthread_mutex_lock>
ffc0879c: 7f c3 f3 78 mr r3,r30
ffc087a0: 48 00 2c 9d bl ffc0b43c <_Chain_Extract>
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
ffc087a4: 7f c3 f3 78 mr r3,r30
ffc087a8: 48 00 05 e1 bl ffc08d88 <rtems_aio_remove_fd>
pthread_mutex_unlock (&r_chain->mutex);
ffc087ac: 7f a3 eb 78 mr r3,r29
ffc087b0: 48 00 12 0d bl ffc099bc <pthread_mutex_unlock>
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc087b4: 7f e3 fb 78 mr r3,r31
ffc087b8: 48 00 12 05 bl ffc099bc <pthread_mutex_unlock>
return AIO_CANCELED;
ffc087bc: 3b c0 00 00 li r30,0
ffc087c0: 48 00 00 b0 b ffc08870 <aio_cancel+0x1bc>
} else {
AIO_printf ("Cancel request\n");
if (aiocbp->aio_fildes != fildes) {
ffc087c4: 83 9e 00 00 lwz r28,0(r30)
ffc087c8: 7f 9c e8 00 cmpw cr7,r28,r29
ffc087cc: 41 be 00 08 beq+ cr7,ffc087d4 <aio_cancel+0x120>
ffc087d0: 48 00 00 44 b ffc08814 <aio_cancel+0x160>
pthread_mutex_unlock (&aio_request_queue.mutex);
rtems_set_errno_and_return_minus_one (EINVAL);
}
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0);
ffc087d4: 38 7f 00 48 addi r3,r31,72
ffc087d8: 7f 84 e3 78 mr r4,r28
ffc087dc: 38 a0 00 00 li r5,0
ffc087e0: 48 00 04 e9 bl ffc08cc8 <rtems_aio_search_fd>
if (r_chain == NULL) {
ffc087e4: 7c 7b 1b 79 mr. r27,r3
ffc087e8: 40 a2 00 5c bne+ ffc08844 <aio_cancel+0x190>
if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) {
ffc087ec: 81 3f 00 54 lwz r9,84(r31)
ffc087f0: 39 5f 00 58 addi r10,r31,88
ffc087f4: 7f 89 50 00 cmpw cr7,r9,r10
ffc087f8: 41 be ff 58 beq- cr7,ffc08750 <aio_cancel+0x9c> <== NEVER TAKEN
r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0);
ffc087fc: 38 7f 00 54 addi r3,r31,84
ffc08800: 7f 84 e3 78 mr r4,r28
ffc08804: 38 a0 00 00 li r5,0
ffc08808: 48 00 04 c1 bl ffc08cc8 <rtems_aio_search_fd>
if (r_chain == NULL) {
ffc0880c: 2c 03 00 00 cmpwi r3,0
ffc08810: 40 a2 00 20 bne+ ffc08830 <aio_cancel+0x17c>
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08814: 7f e3 fb 78 mr r3,r31
ffc08818: 48 00 11 a5 bl ffc099bc <pthread_mutex_unlock>
rtems_set_errno_and_return_minus_one (EINVAL);
ffc0881c: 48 00 9f 15 bl ffc12730 <__errno>
ffc08820: 39 20 00 16 li r9,22
ffc08824: 91 23 00 00 stw r9,0(r3)
ffc08828: 3b c0 ff ff li r30,-1
ffc0882c: 48 00 00 44 b ffc08870 <aio_cancel+0x1bc>
}
AIO_printf ("Request on [IQ]\n");
result = rtems_aio_remove_req (&r_chain->perfd, aiocbp);
ffc08830: 7f c4 f3 78 mr r4,r30
ffc08834: 38 63 00 08 addi r3,r3,8
ffc08838: 48 00 05 a9 bl ffc08de0 <rtems_aio_remove_req>
ffc0883c: 7c 7e 1b 78 mr r30,r3
ffc08840: 48 00 00 28 b ffc08868 <aio_cancel+0x1b4>
return AIO_ALLDONE;
}
}
AIO_printf ("Request on [WQ]\n");
pthread_mutex_lock (&r_chain->mutex);
ffc08844: 3b bb 00 1c addi r29,r27,28
ffc08848: 7f a3 eb 78 mr r3,r29
ffc0884c: 48 00 10 e5 bl ffc09930 <pthread_mutex_lock>
result = rtems_aio_remove_req (&r_chain->perfd, aiocbp);
ffc08850: 7f c4 f3 78 mr r4,r30
ffc08854: 38 7b 00 08 addi r3,r27,8
ffc08858: 48 00 05 89 bl ffc08de0 <rtems_aio_remove_req>
ffc0885c: 7c 7e 1b 78 mr r30,r3
pthread_mutex_unlock (&r_chain->mutex);
ffc08860: 7f a3 eb 78 mr r3,r29
ffc08864: 48 00 11 59 bl ffc099bc <pthread_mutex_unlock>
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08868: 7f e3 fb 78 mr r3,r31
ffc0886c: 48 00 11 51 bl ffc099bc <pthread_mutex_unlock>
return result;
}
return AIO_ALLDONE;
}
ffc08870: 39 61 00 20 addi r11,r1,32
ffc08874: 7f c3 f3 78 mr r3,r30
ffc08878: 4b ff 83 00 b ffc00b78 <_restgpr_27_x>
ffc08884 <aio_fsync>:
)
{
rtems_aio_request *req;
int mode;
if (op != O_SYNC)
ffc08884: 2f 83 20 00 cmpwi cr7,r3,8192
int aio_fsync(
int op,
struct aiocb *aiocbp
)
{
ffc08888: 94 21 ff f0 stwu r1,-16(r1)
ffc0888c: 7c 08 02 a6 mflr r0
ffc08890: bf c1 00 08 stmw r30,8(r1)
ffc08894: 7c 9f 23 78 mr r31,r4
rtems_aio_request *req;
int mode;
if (op != O_SYNC)
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
ffc08898: 3b c0 00 16 li r30,22
int aio_fsync(
int op,
struct aiocb *aiocbp
)
{
ffc0889c: 90 01 00 14 stw r0,20(r1)
rtems_aio_request *req;
int mode;
if (op != O_SYNC)
ffc088a0: 40 9e 00 3c bne- cr7,ffc088dc <aio_fsync+0x58>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc088a4: 80 64 00 00 lwz r3,0(r4)
ffc088a8: 38 80 00 03 li r4,3
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
ffc088ac: 3b c0 00 09 li r30,9
int mode;
if (op != O_SYNC)
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc088b0: 4c c6 31 82 crclr 4*cr1+eq
ffc088b4: 48 00 68 51 bl ffc0f104 <fcntl>
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc088b8: 54 63 07 be clrlwi r3,r3,30
ffc088bc: 38 63 ff ff addi r3,r3,-1
ffc088c0: 2b 83 00 01 cmplwi cr7,r3,1
ffc088c4: 41 9d 00 18 bgt- cr7,ffc088dc <aio_fsync+0x58>
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
req = malloc (sizeof (rtems_aio_request));
ffc088c8: 38 60 00 18 li r3,24
ffc088cc: 4b ff c4 dd bl ffc04da8 <malloc>
if (req == NULL)
ffc088d0: 7c 69 1b 79 mr. r9,r3
ffc088d4: 40 a2 00 20 bne+ ffc088f4 <aio_fsync+0x70> <== ALWAYS TAKEN
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc088d8: 3b c0 00 0b li r30,11 <== NOT EXECUTED
ffc088dc: 39 20 ff ff li r9,-1
ffc088e0: 93 df 00 34 stw r30,52(r31)
ffc088e4: 91 3f 00 38 stw r9,56(r31)
ffc088e8: 48 00 9e 49 bl ffc12730 <__errno>
ffc088ec: 93 c3 00 00 stw r30,0(r3)
ffc088f0: 48 00 00 24 b ffc08914 <aio_fsync+0x90>
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_SYNC;
return rtems_aio_enqueue (req);
}
ffc088f4: 80 01 00 14 lwz r0,20(r1)
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc088f8: 93 e9 00 14 stw r31,20(r9)
req->aiocbp->aio_lio_opcode = LIO_SYNC;
ffc088fc: 39 20 00 03 li r9,3
return rtems_aio_enqueue (req);
}
ffc08900: 7c 08 03 a6 mtlr r0
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_SYNC;
ffc08904: 91 3f 00 30 stw r9,48(r31)
return rtems_aio_enqueue (req);
}
ffc08908: bb c1 00 08 lmw r30,8(r1)
ffc0890c: 38 21 00 10 addi r1,r1,16
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_SYNC;
return rtems_aio_enqueue (req);
ffc08910: 48 00 05 5c b ffc08e6c <rtems_aio_enqueue>
}
ffc08914: 39 61 00 10 addi r11,r1,16
ffc08918: 38 60 ff ff li r3,-1
ffc0891c: 4b ff 82 68 b ffc00b84 <_restgpr_30_x>
ffc09064 <aio_read>:
* 0 - otherwise
*/
int
aio_read (struct aiocb *aiocbp)
{
ffc09064: 94 21 ff f0 stwu r1,-16(r1)
ffc09068: 7c 08 02 a6 mflr r0
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc0906c: 38 80 00 03 li r4,3
* 0 - otherwise
*/
int
aio_read (struct aiocb *aiocbp)
{
ffc09070: 90 01 00 14 stw r0,20(r1)
ffc09074: bf c1 00 08 stmw r30,8(r1)
ffc09078: 7c 7f 1b 78 mr r31,r3
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc0907c: 80 63 00 00 lwz r3,0(r3)
ffc09080: 4c c6 31 82 crclr 4*cr1+eq
ffc09084: 48 00 60 81 bl ffc0f104 <fcntl>
if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc09088: 70 63 00 03 andi. r3,r3,3
ffc0908c: 41 82 00 10 beq- ffc0909c <aio_read+0x38> <== NEVER TAKEN
ffc09090: 2f 83 00 02 cmpwi cr7,r3,2
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
ffc09094: 3b c0 00 09 li r30,9
{
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc09098: 40 9e 00 3c bne- cr7,ffc090d4 <aio_read+0x70>
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX)
ffc0909c: 81 3f 00 18 lwz r9,24(r31)
ffc090a0: 2f 89 00 00 cmpwi cr7,r9,0
ffc090a4: 41 be 00 08 beq+ cr7,ffc090ac <aio_read+0x48>
ffc090a8: 48 00 00 10 b ffc090b8 <aio_read+0x54>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
if (aiocbp->aio_offset < 0)
ffc090ac: 81 3f 00 08 lwz r9,8(r31)
ffc090b0: 2f 89 00 00 cmpwi cr7,r9,0
ffc090b4: 40 9c 00 0c bge- cr7,ffc090c0 <aio_read+0x5c>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
ffc090b8: 3b c0 00 16 li r30,22
ffc090bc: 48 00 00 18 b ffc090d4 <aio_read+0x70>
req = malloc (sizeof (rtems_aio_request));
ffc090c0: 38 60 00 18 li r3,24
ffc090c4: 4b ff bc e5 bl ffc04da8 <malloc>
if (req == NULL)
ffc090c8: 7c 69 1b 79 mr. r9,r3
ffc090cc: 40 a2 00 20 bne+ ffc090ec <aio_read+0x88> <== ALWAYS TAKEN
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc090d0: 3b c0 00 0b li r30,11 <== NOT EXECUTED
ffc090d4: 39 20 ff ff li r9,-1
ffc090d8: 93 df 00 34 stw r30,52(r31)
ffc090dc: 91 3f 00 38 stw r9,56(r31)
ffc090e0: 48 00 96 51 bl ffc12730 <__errno>
ffc090e4: 93 c3 00 00 stw r30,0(r3)
ffc090e8: 48 00 00 24 b ffc0910c <aio_read+0xa8>
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_READ;
return rtems_aio_enqueue (req);
}
ffc090ec: 80 01 00 14 lwz r0,20(r1)
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc090f0: 93 e9 00 14 stw r31,20(r9)
req->aiocbp->aio_lio_opcode = LIO_READ;
ffc090f4: 39 20 00 01 li r9,1
return rtems_aio_enqueue (req);
}
ffc090f8: 7c 08 03 a6 mtlr r0
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_READ;
ffc090fc: 91 3f 00 30 stw r9,48(r31)
return rtems_aio_enqueue (req);
}
ffc09100: bb c1 00 08 lmw r30,8(r1)
ffc09104: 38 21 00 10 addi r1,r1,16
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_READ;
return rtems_aio_enqueue (req);
ffc09108: 4b ff fd 64 b ffc08e6c <rtems_aio_enqueue>
}
ffc0910c: 39 61 00 10 addi r11,r1,16
ffc09110: 38 60 ff ff li r3,-1
ffc09114: 4b ff 7a 70 b ffc00b84 <_restgpr_30_x>
ffc09120 <aio_write>:
* 0 - otherwise
*/
int
aio_write (struct aiocb *aiocbp)
{
ffc09120: 94 21 ff f0 stwu r1,-16(r1)
ffc09124: 7c 08 02 a6 mflr r0
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc09128: 38 80 00 03 li r4,3
* 0 - otherwise
*/
int
aio_write (struct aiocb *aiocbp)
{
ffc0912c: 90 01 00 14 stw r0,20(r1)
ffc09130: bf c1 00 08 stmw r30,8(r1)
ffc09134: 7c 7f 1b 78 mr r31,r3
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
ffc09138: 3b c0 00 09 li r30,9
aio_write (struct aiocb *aiocbp)
{
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc0913c: 80 63 00 00 lwz r3,0(r3)
ffc09140: 4c c6 31 82 crclr 4*cr1+eq
ffc09144: 48 00 5f c1 bl ffc0f104 <fcntl>
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc09148: 54 63 07 be clrlwi r3,r3,30
ffc0914c: 38 63 ff ff addi r3,r3,-1
ffc09150: 2b 83 00 01 cmplwi cr7,r3,1
ffc09154: 41 9d 00 3c bgt- cr7,ffc09190 <aio_write+0x70>
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX)
ffc09158: 81 3f 00 18 lwz r9,24(r31)
ffc0915c: 2f 89 00 00 cmpwi cr7,r9,0
ffc09160: 41 be 00 08 beq+ cr7,ffc09168 <aio_write+0x48>
ffc09164: 48 00 00 10 b ffc09174 <aio_write+0x54>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
if (aiocbp->aio_offset < 0)
ffc09168: 81 3f 00 08 lwz r9,8(r31)
ffc0916c: 2f 89 00 00 cmpwi cr7,r9,0
ffc09170: 40 9c 00 0c bge- cr7,ffc0917c <aio_write+0x5c>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
ffc09174: 3b c0 00 16 li r30,22
ffc09178: 48 00 00 18 b ffc09190 <aio_write+0x70>
req = malloc (sizeof (rtems_aio_request));
ffc0917c: 38 60 00 18 li r3,24
ffc09180: 4b ff bc 29 bl ffc04da8 <malloc>
if (req == NULL)
ffc09184: 7c 69 1b 79 mr. r9,r3
ffc09188: 40 a2 00 20 bne+ ffc091a8 <aio_write+0x88> <== ALWAYS TAKEN
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc0918c: 3b c0 00 0b li r30,11 <== NOT EXECUTED
ffc09190: 39 20 ff ff li r9,-1
ffc09194: 93 df 00 34 stw r30,52(r31)
ffc09198: 91 3f 00 38 stw r9,56(r31)
ffc0919c: 48 00 95 95 bl ffc12730 <__errno>
ffc091a0: 93 c3 00 00 stw r30,0(r3)
ffc091a4: 48 00 00 24 b ffc091c8 <aio_write+0xa8>
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_WRITE;
return rtems_aio_enqueue (req);
}
ffc091a8: 80 01 00 14 lwz r0,20(r1)
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc091ac: 93 e9 00 14 stw r31,20(r9)
req->aiocbp->aio_lio_opcode = LIO_WRITE;
ffc091b0: 39 20 00 02 li r9,2
return rtems_aio_enqueue (req);
}
ffc091b4: 7c 08 03 a6 mtlr r0
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_WRITE;
ffc091b8: 91 3f 00 30 stw r9,48(r31)
return rtems_aio_enqueue (req);
}
ffc091bc: bb c1 00 08 lmw r30,8(r1)
ffc091c0: 38 21 00 10 addi r1,r1,16
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_WRITE;
return rtems_aio_enqueue (req);
ffc091c4: 4b ff fc a8 b ffc08e6c <rtems_aio_enqueue>
}
ffc091c8: 39 61 00 10 addi r11,r1,16
ffc091cc: 38 60 ff ff li r3,-1
ffc091d0: 4b ff 79 b4 b ffc00b84 <_restgpr_30_x>
ffc081e8 <clock_gettime>:
int clock_gettime(
clockid_t clock_id,
struct timespec *tp
)
{
ffc081e8: 94 21 ff d8 stwu r1,-40(r1)
ffc081ec: 7c 08 02 a6 mflr r0
ffc081f0: bf a1 00 1c stmw r29,28(r1)
if ( !tp )
ffc081f4: 7c 9d 23 79 mr. r29,r4
int clock_gettime(
clockid_t clock_id,
struct timespec *tp
)
{
ffc081f8: 90 01 00 2c stw r0,44(r1)
if ( !tp )
ffc081fc: 40 a2 00 08 bne+ ffc08204 <clock_gettime+0x1c>
ffc08200: 48 00 00 94 b ffc08294 <clock_gettime+0xac>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( clock_id == CLOCK_REALTIME ) {
ffc08204: 2f 83 00 01 cmpwi cr7,r3,1
ffc08208: 40 be 00 58 bne+ cr7,ffc08260 <clock_gettime+0x78>
)
{
Timestamp_Control tod_as_timestamp;
Timestamp_Control *tod_as_timestamp_ptr;
tod_as_timestamp_ptr =
ffc0820c: 3c 80 00 00 lis r4,0
ffc08210: 38 84 2c a0 addi r4,r4,11424
ffc08214: 38 61 00 08 addi r3,r1,8
ffc08218: 48 00 20 d1 bl ffc0a2e8 <_TOD_Get_with_nanoseconds>
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc0821c: 3c c0 3b 9a lis r6,15258
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
return 0;
}
ffc08220: 83 e3 00 04 lwz r31,4(r3)
ffc08224: 38 a0 00 00 li r5,0
ffc08228: 83 c3 00 00 lwz r30,0(r3)
ffc0822c: 60 c6 ca 00 ori r6,r6,51712
ffc08230: 7f e4 fb 78 mr r4,r31
ffc08234: 7f c3 f3 78 mr r3,r30
ffc08238: 48 00 f8 a9 bl ffc17ae0 <__divdi3>
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc0823c: 3c c0 3b 9a lis r6,15258
static inline void _Timestamp64_implementation_To_timespec(
const Timestamp64_Control *_timestamp,
struct timespec *_timespec
)
{
_timespec->tv_sec = (time_t) (*_timestamp / 1000000000L);
ffc08240: 90 9d 00 00 stw r4,0(r29)
_timespec->tv_nsec = (long) (*_timestamp % 1000000000L);
ffc08244: 7f c3 f3 78 mr r3,r30
ffc08248: 7f e4 fb 78 mr r4,r31
ffc0824c: 38 a0 00 00 li r5,0
ffc08250: 60 c6 ca 00 ori r6,r6,51712
ffc08254: 48 00 fc b1 bl ffc17f04 <__moddi3>
ffc08258: 90 9d 00 04 stw r4,4(r29)
ffc0825c: 48 00 00 14 b ffc08270 <clock_gettime+0x88>
if ( clock_id == CLOCK_REALTIME ) {
_TOD_Get(tp);
return 0;
}
#ifdef CLOCK_MONOTONIC
if ( clock_id == CLOCK_MONOTONIC ) {
ffc08260: 2f 83 00 04 cmpwi cr7,r3,4
ffc08264: 40 be 00 14 bne+ cr7,ffc08278 <clock_gettime+0x90> <== ALWAYS TAKEN
_TOD_Get_uptime_as_timespec( tp );
ffc08268: 7f a3 eb 78 mr r3,r29
ffc0826c: 48 00 20 e5 bl ffc0a350 <_TOD_Get_uptime_as_timespec>
return 0;
ffc08270: 38 60 00 00 li r3,0
ffc08274: 48 00 00 30 b ffc082a4 <clock_gettime+0xbc>
}
#endif
#ifdef _POSIX_CPUTIME
if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) {
ffc08278: 2f 83 00 02 cmpwi cr7,r3,2
ffc0827c: 41 be ff ec beq- cr7,ffc08268 <clock_gettime+0x80>
return 0;
}
#endif
#ifdef _POSIX_THREAD_CPUTIME
if ( clock_id == CLOCK_THREAD_CPUTIME_ID )
ffc08280: 2f 83 00 03 cmpwi cr7,r3,3
ffc08284: 40 be 00 10 bne+ cr7,ffc08294 <clock_gettime+0xac>
rtems_set_errno_and_return_minus_one( ENOSYS );
ffc08288: 48 00 8f 49 bl ffc111d0 <__errno>
ffc0828c: 39 20 00 58 li r9,88
ffc08290: 48 00 00 0c b ffc0829c <clock_gettime+0xb4>
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08294: 48 00 8f 3d bl ffc111d0 <__errno>
ffc08298: 39 20 00 16 li r9,22
ffc0829c: 91 23 00 00 stw r9,0(r3)
ffc082a0: 38 60 ff ff li r3,-1
return 0;
}
ffc082a4: 39 61 00 28 addi r11,r1,40
ffc082a8: 4b ff 86 e8 b ffc00990 <_restgpr_29_x>
ffc26f24 <clock_settime>:
int clock_settime(
clockid_t clock_id,
const struct timespec *tp
)
{
if ( !tp )
ffc26f24: 2c 04 00 00 cmpwi r4,0
int clock_settime(
clockid_t clock_id,
const struct timespec *tp
)
{
ffc26f28: 94 21 ff e8 stwu r1,-24(r1)
ffc26f2c: 7c 08 02 a6 mflr r0
ffc26f30: 90 01 00 1c stw r0,28(r1)
if ( !tp )
ffc26f34: 40 a2 00 08 bne+ ffc26f3c <clock_settime+0x18> <== ALWAYS TAKEN
ffc26f38: 48 00 00 94 b ffc26fcc <clock_settime+0xa8> <== NOT EXECUTED
rtems_set_errno_and_return_minus_one( EINVAL );
if ( clock_id == CLOCK_REALTIME ) {
ffc26f3c: 2f 83 00 01 cmpwi cr7,r3,1
ffc26f40: 40 be 00 6c bne+ cr7,ffc26fac <clock_settime+0x88>
if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 )
ffc26f44: 81 24 00 00 lwz r9,0(r4)
ffc26f48: 3d 40 21 da lis r10,8666
ffc26f4c: 61 4a e4 ff ori r10,r10,58623
ffc26f50: 7f 89 50 40 cmplw cr7,r9,r10
ffc26f54: 41 bd 00 08 bgt+ cr7,ffc26f5c <clock_settime+0x38>
ffc26f58: 48 00 00 74 b ffc26fcc <clock_settime+0xa8>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc26f5c: 3d 20 00 00 lis r9,0
ffc26f60: 81 49 34 e4 lwz r10,13540(r9)
++level;
ffc26f64: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc26f68: 91 49 34 e4 stw r10,13540(r9)
Timestamp64_Control *_time,
Timestamp64_Control _seconds,
Timestamp64_Control _nanoseconds
)
{
*_time = _seconds * 1000000000L + _nanoseconds;
ffc26f6c: 3c c0 3b 9a lis r6,15258
const struct timespec *tod_as_timespec
)
{
Timestamp_Control tod_as_timestamp;
_Timestamp_Set(
ffc26f70: 81 44 00 00 lwz r10,0(r4)
ffc26f74: 60 c6 ca 00 ori r6,r6,51712
ffc26f78: 81 64 00 04 lwz r11,4(r4)
ffc26f7c: 7d 0a 30 96 mulhw r8,r10,r6
ffc26f80: 7d 2a 31 d6 mullw r9,r10,r6
ffc26f84: 7d 6a fe 70 srawi r10,r11,31
ffc26f88: 7d 6b 48 14 addc r11,r11,r9
ffc26f8c: 7d 4a 41 14 adde r10,r10,r8
ffc26f90: 7c 23 0b 78 mr r3,r1
ffc26f94: 95 43 00 08 stwu r10,8(r3)
ffc26f98: 91 63 00 04 stw r11,4(r3)
&tod_as_timestamp,
tod_as_timespec->tv_sec,
tod_as_timespec->tv_nsec
);
_TOD_Set_with_timestamp( &tod_as_timestamp );
ffc26f9c: 48 00 10 85 bl ffc28020 <_TOD_Set_with_timestamp>
rtems_set_errno_and_return_minus_one( EINVAL );
_Thread_Disable_dispatch();
_TOD_Set( tp );
_Thread_Enable_dispatch();
ffc26fa0: 4b fe 3a b1 bl ffc0aa50 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( ENOSYS );
#endif
else
rtems_set_errno_and_return_minus_one( EINVAL );
return 0;
ffc26fa4: 38 60 00 00 li r3,0
ffc26fa8: 48 00 00 34 b ffc26fdc <clock_settime+0xb8>
_Thread_Disable_dispatch();
_TOD_Set( tp );
_Thread_Enable_dispatch();
}
#ifdef _POSIX_CPUTIME
else if ( clock_id == CLOCK_PROCESS_CPUTIME_ID )
ffc26fac: 2f 83 00 02 cmpwi cr7,r3,2
ffc26fb0: 40 be 00 08 bne+ cr7,ffc26fb8 <clock_settime+0x94>
ffc26fb4: 48 00 00 0c b ffc26fc0 <clock_settime+0x9c>
rtems_set_errno_and_return_minus_one( ENOSYS );
#endif
#ifdef _POSIX_THREAD_CPUTIME
else if ( clock_id == CLOCK_THREAD_CPUTIME_ID )
ffc26fb8: 2f 83 00 03 cmpwi cr7,r3,3
ffc26fbc: 40 be 00 10 bne+ cr7,ffc26fcc <clock_settime+0xa8>
rtems_set_errno_and_return_minus_one( ENOSYS );
ffc26fc0: 48 01 14 49 bl ffc38408 <__errno>
ffc26fc4: 39 20 00 58 li r9,88
ffc26fc8: 48 00 00 0c b ffc26fd4 <clock_settime+0xb0>
#endif
else
rtems_set_errno_and_return_minus_one( EINVAL );
ffc26fcc: 48 01 14 3d bl ffc38408 <__errno>
ffc26fd0: 39 20 00 16 li r9,22
ffc26fd4: 91 23 00 00 stw r9,0(r3)
ffc26fd8: 38 60 ff ff li r3,-1
return 0;
}
ffc26fdc: 80 01 00 1c lwz r0,28(r1)
ffc26fe0: 38 21 00 18 addi r1,r1,24
ffc26fe4: 7c 08 03 a6 mtlr r0
ffc26fe8: 4e 80 00 20 blr
ffc1b59c <killinfo>:
int killinfo(
pid_t pid,
int sig,
const union sigval *value
)
{
ffc1b59c: 94 21 ff d8 stwu r1,-40(r1)
ffc1b5a0: 7c 08 02 a6 mflr r0
ffc1b5a4: bf 81 00 18 stmw r28,24(r1)
ffc1b5a8: 7c 7e 1b 78 mr r30,r3
ffc1b5ac: 7c 9f 23 78 mr r31,r4
ffc1b5b0: 90 01 00 2c stw r0,44(r1)
ffc1b5b4: 7c bd 2b 78 mr r29,r5
POSIX_signals_Siginfo_node *psiginfo;
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid != getpid() )
ffc1b5b8: 4b ff fc 71 bl ffc1b228 <getpid>
ffc1b5bc: 7f 9e 18 00 cmpw cr7,r30,r3
ffc1b5c0: 41 be 00 10 beq+ cr7,ffc1b5d0 <killinfo+0x34>
rtems_set_errno_and_return_minus_one( ESRCH );
ffc1b5c4: 4b ff 4f e9 bl ffc105ac <__errno>
ffc1b5c8: 39 20 00 03 li r9,3
ffc1b5cc: 48 00 02 24 b ffc1b7f0 <killinfo+0x254>
/*
* Validate the signal passed.
*/
if ( !sig )
ffc1b5d0: 2f 9f 00 00 cmpwi cr7,r31,0
ffc1b5d4: 40 be 00 08 bne+ cr7,ffc1b5dc <killinfo+0x40>
ffc1b5d8: 48 00 00 10 b ffc1b5e8 <killinfo+0x4c>
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc1b5dc: 3b df ff ff addi r30,r31,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
ffc1b5e0: 2b 9e 00 1f cmplwi cr7,r30,31
ffc1b5e4: 40 bd 00 10 ble+ cr7,ffc1b5f4 <killinfo+0x58>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc1b5e8: 4b ff 4f c5 bl ffc105ac <__errno>
ffc1b5ec: 39 20 00 16 li r9,22
ffc1b5f0: 48 00 02 00 b ffc1b7f0 <killinfo+0x254>
/*
* If the signal is being ignored, then we are out of here.
*/
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN )
ffc1b5f4: 1d 5f 00 0c mulli r10,r31,12
ffc1b5f8: 3d 20 00 00 lis r9,0
ffc1b5fc: 39 29 32 20 addi r9,r9,12832
ffc1b600: 7d 29 52 14 add r9,r9,r10
ffc1b604: 81 29 00 08 lwz r9,8(r9)
ffc1b608: 2f 89 00 01 cmpwi cr7,r9,1
ffc1b60c: 41 9e 02 14 beq- cr7,ffc1b820 <killinfo+0x284>
/*
* P1003.1c/Draft 10, p. 33 says that certain signals should always
* be directed to the executing thread such as those caused by hardware
* faults.
*/
if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) )
ffc1b610: 2f 9f 00 08 cmpwi cr7,r31,8
ffc1b614: 41 9e 00 14 beq- cr7,ffc1b628 <killinfo+0x8c>
ffc1b618: 2f 9f 00 04 cmpwi cr7,r31,4
ffc1b61c: 41 9e 00 0c beq- cr7,ffc1b628 <killinfo+0x8c>
ffc1b620: 2f 9f 00 0b cmpwi cr7,r31,11
ffc1b624: 40 be 00 14 bne+ cr7,ffc1b638 <killinfo+0x9c>
return pthread_kill( pthread_self(), sig );
ffc1b628: 48 00 04 45 bl ffc1ba6c <pthread_self>
ffc1b62c: 7f e4 fb 78 mr r4,r31
ffc1b630: 48 00 03 55 bl ffc1b984 <pthread_kill>
ffc1b634: 48 00 01 f0 b ffc1b824 <killinfo+0x288>
* Build up a siginfo structure
*/
siginfo = &siginfo_struct;
siginfo->si_signo = sig;
siginfo->si_code = SI_USER;
if ( !value ) {
ffc1b638: 2f 9d 00 00 cmpwi cr7,r29,0
/*
* Build up a siginfo structure
*/
siginfo = &siginfo_struct;
siginfo->si_signo = sig;
ffc1b63c: 93 e1 00 08 stw r31,8(r1)
static inline sigset_t signo_to_mask(
uint32_t sig
)
{
return 1u << (sig - 1);
ffc1b640: 39 20 00 01 li r9,1
ffc1b644: 7d 3e f0 30 slw r30,r9,r30
siginfo->si_code = SI_USER;
ffc1b648: 91 21 00 0c stw r9,12(r1)
if ( !value ) {
ffc1b64c: 40 be 00 0c bne+ cr7,ffc1b658 <killinfo+0xbc>
siginfo->si_value.sival_int = 0;
ffc1b650: 93 a1 00 10 stw r29,16(r1)
ffc1b654: 48 00 00 0c b ffc1b660 <killinfo+0xc4>
} else {
siginfo->si_value = *value;
ffc1b658: 81 3d 00 00 lwz r9,0(r29)
ffc1b65c: 91 21 00 10 stw r9,16(r1)
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc1b660: 3d 20 00 00 lis r9,0
ffc1b664: 81 49 28 68 lwz r10,10344(r9)
++level;
ffc1b668: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc1b66c: 91 49 28 68 stw r10,10344(r9)
*/
void _POSIX_signals_Manager_Initialization(void);
static inline void _POSIX_signals_Add_post_switch_extension(void)
{
_API_extensions_Add_post_switch( &_POSIX_signals_Post_switch );
ffc1b670: 3c 60 00 00 lis r3,0
ffc1b674: 38 63 22 20 addi r3,r3,8736
ffc1b678: 4b fe db fd bl ffc09274 <_API_extensions_Add_post_switch>
/*
* Is the currently executing thread interested? If so then it will
* get it an execute it as soon as the dispatcher executes.
*/
the_thread = _Thread_Executing;
ffc1b67c: 3d 20 00 00 lis r9,0
ffc1b680: 80 69 31 b0 lwz r3,12720(r9)
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
if ( _POSIX_signals_Is_interested( api, mask ) ) {
ffc1b684: 81 43 01 50 lwz r10,336(r3)
ffc1b688: 81 4a 00 d0 lwz r10,208(r10)
ffc1b68c: 7f c6 50 79 andc. r6,r30,r10
ffc1b690: 40 82 01 04 bne- ffc1b794 <killinfo+0x1f8>
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First(
Chain_Control *the_chain
)
{
return _Chain_Head( the_chain )->next;
ffc1b694: 3d 20 00 00 lis r9,0
/* XXX violation of visibility -- need to define thread queue support */
the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo;
for ( the_node = _Chain_First( the_chain );
ffc1b698: 3d 00 00 00 lis r8,0
ffc1b69c: 81 29 33 ac lwz r9,13228(r9)
ffc1b6a0: 39 08 33 b0 addi r8,r8,13232
ffc1b6a4: 48 00 00 24 b ffc1b6c8 <killinfo+0x12c>
#endif
/*
* Is this thread is actually blocked waiting for the signal?
*/
if (the_thread->Wait.option & mask)
ffc1b6a8: 81 49 00 30 lwz r10,48(r9)
for ( the_node = _Chain_First( the_chain );
!_Chain_Is_tail( the_chain, the_node ) ;
the_node = the_node->next ) {
the_thread = (Thread_Control *)the_node;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc1b6ac: 80 e9 01 50 lwz r7,336(r9)
#endif
/*
* Is this thread is actually blocked waiting for the signal?
*/
if (the_thread->Wait.option & mask)
ffc1b6b0: 7f dc 50 39 and. r28,r30,r10
ffc1b6b4: 40 82 00 dc bne- ffc1b790 <killinfo+0x1f4>
/*
* Is this thread is blocked waiting for another signal but has
* not blocked this one?
*/
if (~api->signals_blocked & mask)
ffc1b6b8: 81 47 00 d0 lwz r10,208(r7)
ffc1b6bc: 7f c3 50 79 andc. r3,r30,r10
ffc1b6c0: 40 82 00 d0 bne- ffc1b790 <killinfo+0x1f4>
the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo;
for ( the_node = _Chain_First( the_chain );
!_Chain_Is_tail( the_chain, the_node ) ;
the_node = the_node->next ) {
ffc1b6c4: 81 29 00 00 lwz r9,0(r9)
/* XXX violation of visibility -- need to define thread queue support */
the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo;
for ( the_node = _Chain_First( the_chain );
ffc1b6c8: 7f 89 40 00 cmpw cr7,r9,r8
ffc1b6cc: 40 9e ff dc bne+ cr7,ffc1b6a8 <killinfo+0x10c>
* NOTES:
*
* + rtems internal threads do not receive signals.
*/
interested = NULL;
interested_priority = PRIORITY_MAXIMUM + 1;
ffc1b6d0: 3d 20 00 00 lis r9,0
ffc1b6d4: 88 e9 27 84 lbz r7,10116(r9)
ffc1b6d8: 3d 00 00 00 lis r8,0
ffc1b6dc: 39 08 2c 7c addi r8,r8,11388
ffc1b6e0: 38 e7 00 01 addi r7,r7,1
*/
#define _POSIX_signals_Is_interested( _api, _mask ) \
( ~(_api)->signals_blocked & (_mask) )
int killinfo(
ffc1b6e4: 39 68 00 08 addi r11,r8,8
*
* NOTES:
*
* + rtems internal threads do not receive signals.
*/
interested = NULL;
ffc1b6e8: 39 20 00 00 li r9,0
for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) {
/*
* This can occur when no one is interested and an API is not configured.
*/
if ( !_Objects_Information_table[ the_api ] )
ffc1b6ec: 85 48 00 04 lwzu r10,4(r8)
ffc1b6f0: 2f 8a 00 00 cmpwi cr7,r10,0
ffc1b6f4: 41 9e 00 8c beq- cr7,ffc1b780 <killinfo+0x1e4> <== NEVER TAKEN
continue;
the_info = _Objects_Information_table[ the_api ][ 1 ];
ffc1b6f8: 81 4a 00 04 lwz r10,4(r10)
#endif
maximum = the_info->maximum;
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
ffc1b6fc: 38 c0 00 01 li r6,1
*/
if ( !the_info )
continue;
#endif
maximum = the_info->maximum;
ffc1b700: a0 0a 00 10 lhz r0,16(r10)
object_table = the_info->local_table;
ffc1b704: 83 aa 00 1c lwz r29,28(r10)
for ( index = 1 ; index <= maximum ; index++ ) {
ffc1b708: 48 00 00 70 b ffc1b778 <killinfo+0x1dc>
*/
#define _POSIX_signals_Is_interested( _api, _mask ) \
( ~(_api)->signals_blocked & (_mask) )
int killinfo(
ffc1b70c: 54 ca 10 3a rlwinm r10,r6,2,0,29
maximum = the_info->maximum;
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
the_thread = (Thread_Control *) object_table[ index ];
ffc1b710: 7d 5d 50 2e lwzx r10,r29,r10
if ( !the_thread )
ffc1b714: 2f 8a 00 00 cmpwi cr7,r10,0
ffc1b718: 41 9e 00 5c beq- cr7,ffc1b774 <killinfo+0x1d8>
/*
* If this thread is of lower priority than the interested thread,
* go on to the next thread.
*/
if ( the_thread->current_priority > interested_priority )
ffc1b71c: 80 aa 00 14 lwz r5,20(r10)
ffc1b720: 7f 85 38 40 cmplw cr7,r5,r7
ffc1b724: 41 9d 00 50 bgt- cr7,ffc1b774 <killinfo+0x1d8>
#if defined(RTEMS_DEBUG)
if ( !api )
continue;
#endif
if ( !_POSIX_signals_Is_interested( api, mask ) )
ffc1b728: 80 8a 01 50 lwz r4,336(r10)
ffc1b72c: 80 84 00 d0 lwz r4,208(r4)
ffc1b730: 7f dc 20 79 andc. r28,r30,r4
ffc1b734: 41 82 00 40 beq- ffc1b774 <killinfo+0x1d8>
*
* NOTE: We initialized interested_priority to PRIORITY_MAXIMUM + 1
* so we never have to worry about deferencing a NULL
* interested thread.
*/
if ( the_thread->current_priority < interested_priority ) {
ffc1b738: 41 9c 00 34 blt- cr7,ffc1b76c <killinfo+0x1d0>
* and blocking interruptibutable by signal.
*
* If the interested thread is ready, don't think about changing.
*/
if ( interested && !_States_Is_ready( interested->current_state ) ) {
ffc1b73c: 2f 89 00 00 cmpwi cr7,r9,0
ffc1b740: 41 9e 00 34 beq- cr7,ffc1b774 <killinfo+0x1d8> <== NEVER TAKEN
ffc1b744: 80 69 00 10 lwz r3,16(r9)
ffc1b748: 2f 83 00 00 cmpwi cr7,r3,0
ffc1b74c: 41 9e 00 28 beq- cr7,ffc1b774 <killinfo+0x1d8>
/* preferred ready over blocked */
DEBUG_STEP("5");
if ( _States_Is_ready( the_thread->current_state ) ) {
ffc1b750: 80 8a 00 10 lwz r4,16(r10)
ffc1b754: 2f 84 00 00 cmpwi cr7,r4,0
ffc1b758: 41 9e 00 14 beq- cr7,ffc1b76c <killinfo+0x1d0>
continue;
}
DEBUG_STEP("6");
/* prefer blocked/interruptible over blocked/not interruptible */
if ( !_States_Is_interruptible_by_signal(interested->current_state) ) {
ffc1b75c: 74 7c 10 00 andis. r28,r3,4096
ffc1b760: 40 82 00 14 bne- ffc1b774 <killinfo+0x1d8>
DEBUG_STEP("7");
if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) {
ffc1b764: 74 83 10 00 andis. r3,r4,4096
ffc1b768: 41 82 00 0c beq- ffc1b774 <killinfo+0x1d8>
*/
if ( interested && !_States_Is_ready( interested->current_state ) ) {
/* preferred ready over blocked */
DEBUG_STEP("5");
if ( _States_Is_ready( the_thread->current_state ) ) {
ffc1b76c: 7c a7 2b 78 mr r7,r5
ffc1b770: 7d 49 53 78 mr r9,r10
#endif
maximum = the_info->maximum;
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
ffc1b774: 38 c6 00 01 addi r6,r6,1
ffc1b778: 7f 86 00 40 cmplw cr7,r6,r0
ffc1b77c: 40 9d ff 90 ble+ cr7,ffc1b70c <killinfo+0x170>
* + rtems internal threads do not receive signals.
*/
interested = NULL;
interested_priority = PRIORITY_MAXIMUM + 1;
for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) {
ffc1b780: 7f 88 58 00 cmpw cr7,r8,r11
ffc1b784: 40 be ff 68 bne- cr7,ffc1b6ec <killinfo+0x150>
}
}
}
}
if ( interested ) {
ffc1b788: 2f 89 00 00 cmpwi cr7,r9,0
ffc1b78c: 41 9e 00 24 beq- cr7,ffc1b7b0 <killinfo+0x214>
/*
* Is this thread is blocked waiting for another signal but has
* not blocked this one?
*/
if (~api->signals_blocked & mask)
ffc1b790: 7d 23 4b 78 mr r3,r9
/*
* Returns true if the signal was synchronously given to a thread
* blocked waiting for the signal.
*/
if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) {
ffc1b794: 7f e4 fb 78 mr r4,r31
ffc1b798: 38 a1 00 08 addi r5,r1,8
ffc1b79c: 48 00 00 b9 bl ffc1b854 <_POSIX_signals_Unblock_thread>
ffc1b7a0: 2f 83 00 00 cmpwi cr7,r3,0
ffc1b7a4: 41 be 00 0c beq+ cr7,ffc1b7b0 <killinfo+0x214>
_Thread_Enable_dispatch();
ffc1b7a8: 4b fe fa 81 bl ffc0b228 <_Thread_Enable_dispatch>
ffc1b7ac: 48 00 00 74 b ffc1b820 <killinfo+0x284>
/*
* We may have woken up a thread but we definitely need to post the
* signal to the process wide information set.
*/
_POSIX_signals_Set_process_signals( mask );
ffc1b7b0: 7f c3 f3 78 mr r3,r30
ffc1b7b4: 48 00 00 79 bl ffc1b82c <_POSIX_signals_Set_process_signals>
if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) {
ffc1b7b8: 1f ff 00 0c mulli r31,r31,12
ffc1b7bc: 3d 20 00 00 lis r9,0
ffc1b7c0: 39 29 32 20 addi r9,r9,12832
ffc1b7c4: 7d 29 f8 2e lwzx r9,r9,r31
ffc1b7c8: 2f 89 00 02 cmpwi cr7,r9,2
ffc1b7cc: 40 9e ff dc bne+ cr7,ffc1b7a8 <killinfo+0x20c>
psiginfo = (POSIX_signals_Siginfo_node *)
ffc1b7d0: 3c 60 00 00 lis r3,0
ffc1b7d4: 38 63 33 a0 addi r3,r3,13216
ffc1b7d8: 4b fe dc 59 bl ffc09430 <_Chain_Get>
_Chain_Get( &_POSIX_signals_Inactive_siginfo );
if ( !psiginfo ) {
ffc1b7dc: 7c 64 1b 79 mr. r4,r3
ffc1b7e0: 40 a2 00 1c bne+ ffc1b7fc <killinfo+0x260>
_Thread_Enable_dispatch();
ffc1b7e4: 4b fe fa 45 bl ffc0b228 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EAGAIN );
ffc1b7e8: 4b ff 4d c5 bl ffc105ac <__errno>
ffc1b7ec: 39 20 00 0b li r9,11
ffc1b7f0: 91 23 00 00 stw r9,0(r3)
ffc1b7f4: 38 60 ff ff li r3,-1
ffc1b7f8: 48 00 00 2c b ffc1b824 <killinfo+0x288>
}
psiginfo->Info = *siginfo;
ffc1b7fc: 39 24 00 08 addi r9,r4,8
ffc1b800: 39 41 00 08 addi r10,r1,8
_Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node );
ffc1b804: 3c 60 00 00 lis r3,0
if ( !psiginfo ) {
_Thread_Enable_dispatch();
rtems_set_errno_and_return_minus_one( EAGAIN );
}
psiginfo->Info = *siginfo;
ffc1b808: 7c aa 64 aa lswi r5,r10,12
ffc1b80c: 7c a9 65 aa stswi r5,r9,12
_Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node );
ffc1b810: 38 63 34 14 addi r3,r3,13332
ffc1b814: 7c 63 fa 14 add r3,r3,r31
ffc1b818: 4b fe db e9 bl ffc09400 <_Chain_Append>
ffc1b81c: 4b ff ff 8c b ffc1b7a8 <killinfo+0x20c>
/*
* If the signal is being ignored, then we are out of here.
*/
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN )
return 0;
ffc1b820: 38 60 00 00 li r3,0
}
DEBUG_STEP("\n");
_Thread_Enable_dispatch();
return 0;
}
ffc1b824: 39 61 00 28 addi r11,r1,40
ffc1b828: 4b fe 4d 90 b ffc005b8 <_restgpr_28_x>
ffc0d6a8 <pthread_attr_setschedpolicy>:
int pthread_attr_setschedpolicy(
pthread_attr_t *attr,
int policy
)
{
if ( !attr || !attr->is_initialized )
ffc0d6a8: 7c 69 1b 79 mr. r9,r3
ffc0d6ac: 41 82 00 38 beq- ffc0d6e4 <pthread_attr_setschedpolicy+0x3c>
ffc0d6b0: 81 49 00 00 lwz r10,0(r9)
return EINVAL;
ffc0d6b4: 38 60 00 16 li r3,22
int pthread_attr_setschedpolicy(
pthread_attr_t *attr,
int policy
)
{
if ( !attr || !attr->is_initialized )
ffc0d6b8: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0d6bc: 4d be 00 20 beqlr+ cr7
return EINVAL;
switch ( policy ) {
ffc0d6c0: 2b 84 00 04 cmplwi cr7,r4,4
ffc0d6c4: 41 9d 00 28 bgt- cr7,ffc0d6ec <pthread_attr_setschedpolicy+0x44>
ffc0d6c8: 39 40 00 01 li r10,1
ffc0d6cc: 7d 4a 20 30 slw r10,r10,r4
ffc0d6d0: 71 48 00 17 andi. r8,r10,23
ffc0d6d4: 41 82 00 18 beq- ffc0d6ec <pthread_attr_setschedpolicy+0x44><== NEVER TAKEN
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
case SCHED_SPORADIC:
attr->schedpolicy = policy;
ffc0d6d8: 90 89 00 14 stw r4,20(r9)
return 0;
ffc0d6dc: 38 60 00 00 li r3,0
ffc0d6e0: 4e 80 00 20 blr
pthread_attr_t *attr,
int policy
)
{
if ( !attr || !attr->is_initialized )
return EINVAL;
ffc0d6e4: 38 60 00 16 li r3,22
ffc0d6e8: 4e 80 00 20 blr
case SCHED_SPORADIC:
attr->schedpolicy = policy;
return 0;
default:
return ENOTSUP;
ffc0d6ec: 38 60 00 86 li r3,134
}
}
ffc0d6f0: 4e 80 00 20 blr
ffc08858 <pthread_barrier_init>:
int pthread_barrier_init(
pthread_barrier_t *barrier,
const pthread_barrierattr_t *attr,
unsigned int count
)
{
ffc08858: 94 21 ff d8 stwu r1,-40(r1)
ffc0885c: 7c 08 02 a6 mflr r0
ffc08860: bf 81 00 18 stmw r28,24(r1)
const pthread_barrierattr_t *the_attr;
/*
* Error check parameters
*/
if ( !barrier )
ffc08864: 7c 7c 1b 79 mr. r28,r3
int pthread_barrier_init(
pthread_barrier_t *barrier,
const pthread_barrierattr_t *attr,
unsigned int count
)
{
ffc08868: 90 01 00 2c stw r0,44(r1)
const pthread_barrierattr_t *the_attr;
/*
* Error check parameters
*/
if ( !barrier )
ffc0886c: 40 a2 00 08 bne+ ffc08874 <pthread_barrier_init+0x1c>
ffc08870: 48 00 00 ac b ffc0891c <pthread_barrier_init+0xc4>
return EINVAL;
if ( count == 0 )
ffc08874: 2f 85 00 00 cmpwi cr7,r5,0
ffc08878: 7c bf 2b 78 mr r31,r5
ffc0887c: 41 be 00 a0 beq+ cr7,ffc0891c <pthread_barrier_init+0xc4>
return EINVAL;
/*
* If the user passed in NULL, use the default attributes
*/
if ( attr ) {
ffc08880: 2f 84 00 00 cmpwi cr7,r4,0
ffc08884: 7c 89 23 78 mr r9,r4
ffc08888: 40 be 00 10 bne+ cr7,ffc08898 <pthread_barrier_init+0x40>
the_attr = attr;
} else {
(void) pthread_barrierattr_init( &my_attr );
ffc0888c: 38 61 00 08 addi r3,r1,8
ffc08890: 4b ff fe dd bl ffc0876c <pthread_barrierattr_init>
the_attr = &my_attr;
ffc08894: 39 21 00 08 addi r9,r1,8
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc08898: 81 49 00 00 lwz r10,0(r9)
ffc0889c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc088a0: 41 be 00 7c beq+ cr7,ffc0891c <pthread_barrier_init+0xc4>
return EINVAL;
switch ( the_attr->process_shared ) {
ffc088a4: 83 c9 00 04 lwz r30,4(r9)
ffc088a8: 2f 9e 00 00 cmpwi cr7,r30,0
ffc088ac: 40 9e 00 70 bne- cr7,ffc0891c <pthread_barrier_init+0xc4><== NEVER TAKEN
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc088b0: 3d 20 00 00 lis r9,0
}
/*
* Convert from POSIX attributes to Core Barrier attributes
*/
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
ffc088b4: 93 c1 00 10 stw r30,16(r1)
ffc088b8: 81 49 28 90 lwz r10,10384(r9)
the_attributes.maximum_count = count;
ffc088bc: 93 e1 00 14 stw r31,20(r1)
++level;
ffc088c0: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc088c4: 91 49 28 90 stw r10,10384(r9)
* This function allocates a barrier control block from
* the inactive chain of free barrier control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void )
{
return (POSIX_Barrier_Control *)
ffc088c8: 3f a0 00 00 lis r29,0
ffc088cc: 3b bd 30 00 addi r29,r29,12288
ffc088d0: 7f a3 eb 78 mr r3,r29
ffc088d4: 48 00 22 69 bl ffc0ab3c <_Objects_Allocate>
*/
_Thread_Disable_dispatch(); /* prevents deletion */
the_barrier = _POSIX_Barrier_Allocate();
if ( !the_barrier ) {
ffc088d8: 7c 7f 1b 79 mr. r31,r3
ffc088dc: 40 a2 00 10 bne+ ffc088ec <pthread_barrier_init+0x94>
_Thread_Enable_dispatch();
ffc088e0: 48 00 35 a5 bl ffc0be84 <_Thread_Enable_dispatch>
return EAGAIN;
ffc088e4: 38 60 00 0b li r3,11
ffc088e8: 48 00 00 38 b ffc08920 <pthread_barrier_init+0xc8>
}
_CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes );
ffc088ec: 38 7f 00 10 addi r3,r31,16
ffc088f0: 38 81 00 10 addi r4,r1,16
ffc088f4: 48 00 18 09 bl ffc0a0fc <_CORE_barrier_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc088f8: 81 3f 00 08 lwz r9,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc088fc: 81 1d 00 1c lwz r8,28(r29)
ffc08900: 55 2a 13 ba rlwinm r10,r9,2,14,29
ffc08904: 7f e8 51 2e stwx r31,r8,r10
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc08908: 93 df 00 0c stw r30,12(r31)
);
/*
* Exit the critical section and return the user an operational barrier
*/
*barrier = the_barrier->Object.id;
ffc0890c: 91 3c 00 00 stw r9,0(r28)
_Thread_Enable_dispatch();
ffc08910: 48 00 35 75 bl ffc0be84 <_Thread_Enable_dispatch>
return 0;
ffc08914: 38 60 00 00 li r3,0
ffc08918: 48 00 00 08 b ffc08920 <pthread_barrier_init+0xc8>
switch ( the_attr->process_shared ) {
case PTHREAD_PROCESS_PRIVATE: /* only supported values */
break;
case PTHREAD_PROCESS_SHARED:
default:
return EINVAL;
ffc0891c: 38 60 00 16 li r3,22
* Exit the critical section and return the user an operational barrier
*/
*barrier = the_barrier->Object.id;
_Thread_Enable_dispatch();
return 0;
}
ffc08920: 39 61 00 28 addi r11,r1,40
ffc08924: 4b ff 85 8c b ffc00eb0 <_restgpr_28_x>
ffc0802c <pthread_cleanup_push>:
void pthread_cleanup_push(
void (*routine)( void * ),
void *arg
)
{
ffc0802c: 94 21 ff f0 stwu r1,-16(r1)
ffc08030: 7c 08 02 a6 mflr r0
ffc08034: bf c1 00 08 stmw r30,8(r1)
/*
* The POSIX standard does not address what to do when the routine
* is NULL. It also does not address what happens when we cannot
* allocate memory or anything else bad happens.
*/
if ( !routine )
ffc08038: 7c 7e 1b 79 mr. r30,r3
void pthread_cleanup_push(
void (*routine)( void * ),
void *arg
)
{
ffc0803c: 90 01 00 14 stw r0,20(r1)
/*
* The POSIX standard does not address what to do when the routine
* is NULL. It also does not address what happens when we cannot
* allocate memory or anything else bad happens.
*/
if ( !routine )
ffc08040: 41 82 00 58 beq- ffc08098 <pthread_cleanup_push+0x6c>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc08044: 3d 20 00 00 lis r9,0
ffc08048: 81 49 28 68 lwz r10,10344(r9)
ffc0804c: 7c 9f 23 78 mr r31,r4
++level;
ffc08050: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc08054: 91 49 28 68 stw r10,10344(r9)
return;
_Thread_Disable_dispatch();
handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) );
ffc08058: 38 60 00 10 li r3,16
ffc0805c: 48 00 49 25 bl ffc0c980 <_Workspace_Allocate>
if ( handler ) {
ffc08060: 7c 64 1b 79 mr. r4,r3
ffc08064: 41 82 00 20 beq- ffc08084 <pthread_cleanup_push+0x58> <== NEVER TAKEN
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc08068: 3d 40 00 00 lis r10,0
ffc0806c: 81 4a 31 70 lwz r10,12656(r10)
handler_stack = &thread_support->Cancellation_Handlers;
ffc08070: 80 6a 01 50 lwz r3,336(r10)
handler->routine = routine;
ffc08074: 93 c4 00 08 stw r30,8(r4)
handler->arg = arg;
_Chain_Append( handler_stack, &handler->Node );
ffc08078: 38 63 00 e4 addi r3,r3,228
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
handler->routine = routine;
handler->arg = arg;
ffc0807c: 93 e4 00 0c stw r31,12(r4)
_Chain_Append( handler_stack, &handler->Node );
ffc08080: 48 00 19 5d bl ffc099dc <_Chain_Append>
}
_Thread_Enable_dispatch();
}
ffc08084: 80 01 00 14 lwz r0,20(r1)
ffc08088: bb c1 00 08 lmw r30,8(r1)
ffc0808c: 7c 08 03 a6 mtlr r0
ffc08090: 38 21 00 10 addi r1,r1,16
handler->routine = routine;
handler->arg = arg;
_Chain_Append( handler_stack, &handler->Node );
}
_Thread_Enable_dispatch();
ffc08094: 48 00 36 d8 b ffc0b76c <_Thread_Enable_dispatch>
}
ffc08098: 39 61 00 10 addi r11,r1,16
ffc0809c: 48 00 df 58 b ffc15ff4 <_restgpr_30_x>
ffc0923c <pthread_cond_init>:
*/
int pthread_cond_init(
pthread_cond_t *cond,
const pthread_condattr_t *attr
)
{
ffc0923c: 94 21 ff e8 stwu r1,-24(r1)
ffc09240: 7c 08 02 a6 mflr r0
ffc09244: bf 81 00 08 stmw r28,8(r1)
POSIX_Condition_variables_Control *the_cond;
const pthread_condattr_t *the_attr;
if ( attr ) the_attr = attr;
ffc09248: 7c 9e 23 79 mr. r30,r4
*/
int pthread_cond_init(
pthread_cond_t *cond,
const pthread_condattr_t *attr
)
{
ffc0924c: 7c 7c 1b 78 mr r28,r3
ffc09250: 90 01 00 1c stw r0,28(r1)
POSIX_Condition_variables_Control *the_cond;
const pthread_condattr_t *the_attr;
if ( attr ) the_attr = attr;
ffc09254: 40 a2 00 0c bne+ ffc09260 <pthread_cond_init+0x24>
else the_attr = &_POSIX_Condition_variables_Default_attributes;
ffc09258: 3f c0 00 00 lis r30,0
ffc0925c: 3b de 27 e4 addi r30,r30,10212
/*
* Be careful about attributes when global!!!
*/
if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED )
ffc09260: 81 5e 00 04 lwz r10,4(r30)
return EINVAL;
ffc09264: 38 60 00 16 li r3,22
else the_attr = &_POSIX_Condition_variables_Default_attributes;
/*
* Be careful about attributes when global!!!
*/
if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED )
ffc09268: 2f 8a 00 01 cmpwi cr7,r10,1
ffc0926c: 41 9e 00 8c beq- cr7,ffc092f8 <pthread_cond_init+0xbc> <== NEVER TAKEN
return EINVAL;
if ( !the_attr->is_initialized )
ffc09270: 81 5e 00 00 lwz r10,0(r30)
ffc09274: 2f 8a 00 00 cmpwi cr7,r10,0
ffc09278: 41 be 00 80 beq+ cr7,ffc092f8 <pthread_cond_init+0xbc>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0927c: 3d 20 00 00 lis r9,0
ffc09280: 81 49 28 9c lwz r10,10396(r9)
++level;
ffc09284: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc09288: 91 49 28 9c stw r10,10396(r9)
*/
RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control
*_POSIX_Condition_variables_Allocate( void )
{
return (POSIX_Condition_variables_Control *)
ffc0928c: 3f a0 00 00 lis r29,0
ffc09290: 3b bd 30 98 addi r29,r29,12440
ffc09294: 7f a3 eb 78 mr r3,r29
ffc09298: 48 00 29 9d bl ffc0bc34 <_Objects_Allocate>
_Thread_Disable_dispatch();
the_cond = _POSIX_Condition_variables_Allocate();
if ( !the_cond ) {
ffc0929c: 7c 7f 1b 79 mr. r31,r3
ffc092a0: 40 a2 00 10 bne+ ffc092b0 <pthread_cond_init+0x74>
_Thread_Enable_dispatch();
ffc092a4: 48 00 3c d9 bl ffc0cf7c <_Thread_Enable_dispatch>
return ENOMEM;
ffc092a8: 38 60 00 0c li r3,12
ffc092ac: 48 00 00 4c b ffc092f8 <pthread_cond_init+0xbc>
}
the_cond->process_shared = the_attr->process_shared;
ffc092b0: 81 3e 00 04 lwz r9,4(r30)
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
ffc092b4: 3b c0 00 00 li r30,0
ffc092b8: 93 df 00 14 stw r30,20(r31)
_Thread_queue_Initialize(
ffc092bc: 3c a0 10 00 lis r5,4096
ffc092c0: 38 7f 00 18 addi r3,r31,24
if ( !the_cond ) {
_Thread_Enable_dispatch();
return ENOMEM;
}
the_cond->process_shared = the_attr->process_shared;
ffc092c4: 91 3f 00 10 stw r9,16(r31)
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
_Thread_queue_Initialize(
ffc092c8: 38 80 00 00 li r4,0
ffc092cc: 60 a5 08 00 ori r5,r5,2048
ffc092d0: 38 c0 00 74 li r6,116
ffc092d4: 48 00 45 35 bl ffc0d808 <_Thread_queue_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc092d8: 81 3f 00 08 lwz r9,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc092dc: 81 1d 00 1c lwz r8,28(r29)
ffc092e0: 55 2a 13 ba rlwinm r10,r9,2,14,29
ffc092e4: 7f e8 51 2e stwx r31,r8,r10
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc092e8: 93 df 00 0c stw r30,12(r31)
&_POSIX_Condition_variables_Information,
&the_cond->Object,
0
);
*cond = the_cond->Object.id;
ffc092ec: 91 3c 00 00 stw r9,0(r28)
_Thread_Enable_dispatch();
ffc092f0: 48 00 3c 8d bl ffc0cf7c <_Thread_Enable_dispatch>
return 0;
ffc092f4: 38 60 00 00 li r3,0
}
ffc092f8: 39 61 00 18 addi r11,r1,24
ffc092fc: 4b ff 84 80 b ffc0177c <_restgpr_28_x>
ffc084c8 <pthread_create>:
pthread_t *thread,
const pthread_attr_t *attr,
void *(*start_routine)( void * ),
void *arg
)
{
ffc084c8: 94 21 ff 80 stwu r1,-128(r1)
ffc084cc: 7c 08 02 a6 mflr r0
ffc084d0: be a1 00 54 stmw r21,84(r1)
int schedpolicy = SCHED_RR;
struct sched_param schedparam;
Objects_Name name;
int rc;
if ( !start_routine )
ffc084d4: 7c b7 2b 79 mr. r23,r5
return EFAULT;
ffc084d8: 3b c0 00 0e li r30,14
pthread_t *thread,
const pthread_attr_t *attr,
void *(*start_routine)( void * ),
void *arg
)
{
ffc084dc: 90 01 00 84 stw r0,132(r1)
int schedpolicy = SCHED_RR;
struct sched_param schedparam;
Objects_Name name;
int rc;
if ( !start_routine )
ffc084e0: 41 82 02 10 beq- ffc086f0 <pthread_create+0x228>
return EFAULT;
the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes;
ffc084e4: 2f 84 00 00 cmpwi cr7,r4,0
ffc084e8: 7c 79 1b 78 mr r25,r3
ffc084ec: 7c d8 33 78 mr r24,r6
ffc084f0: 7c 9f 23 78 mr r31,r4
ffc084f4: 40 be 00 0c bne+ cr7,ffc08500 <pthread_create+0x38>
ffc084f8: 3f e0 ff c2 lis r31,-62
ffc084fc: 3b ff e8 d4 addi r31,r31,-5932
if ( !the_attr->is_initialized )
ffc08500: 81 3f 00 00 lwz r9,0(r31)
ffc08504: 2f 89 00 00 cmpwi cr7,r9,0
ffc08508: 40 9e 00 08 bne- cr7,ffc08510 <pthread_create+0x48>
ffc0850c: 48 00 01 e0 b ffc086ec <pthread_create+0x224>
* stack space if it is allowed to allocate it itself.
*
* NOTE: If the user provides the stack we will let it drop below
* twice the minimum.
*/
if ( the_attr->stackaddr && !_Stack_Is_enough(the_attr->stacksize) )
ffc08510: 81 3f 00 04 lwz r9,4(r31)
ffc08514: 2f 89 00 00 cmpwi cr7,r9,0
ffc08518: 41 9e 00 18 beq- cr7,ffc08530 <pthread_create+0x68>
ffc0851c: 3d 40 00 00 lis r10,0
ffc08520: 81 3f 00 08 lwz r9,8(r31)
ffc08524: 81 4a 27 88 lwz r10,10120(r10)
ffc08528: 7f 89 50 40 cmplw cr7,r9,r10
ffc0852c: 41 bc 01 c0 blt+ cr7,ffc086ec <pthread_create+0x224>
* If inheritsched is set to PTHREAD_INHERIT_SCHED, then this thread
* inherits scheduling attributes from the creating thread. If it is
* PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the
* attributes structure.
*/
switch ( the_attr->inheritsched ) {
ffc08530: 81 3f 00 10 lwz r9,16(r31)
ffc08534: 2f 89 00 01 cmpwi cr7,r9,1
ffc08538: 41 9e 00 10 beq- cr7,ffc08548 <pthread_create+0x80>
ffc0853c: 2f 89 00 02 cmpwi cr7,r9,2
ffc08540: 40 be 01 ac bne+ cr7,ffc086ec <pthread_create+0x224>
ffc08544: 48 00 00 1c b ffc08560 <pthread_create+0x98>
case PTHREAD_INHERIT_SCHED:
api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc08548: 3d 20 00 00 lis r9,0
ffc0854c: 81 29 31 90 lwz r9,12688(r9)
ffc08550: 81 29 01 50 lwz r9,336(r9)
schedpolicy = api->schedpolicy;
ffc08554: 83 69 00 84 lwz r27,132(r9)
schedparam = api->schedparam;
ffc08558: 38 69 00 88 addi r3,r9,136
ffc0855c: 48 00 00 0c b ffc08568 <pthread_create+0xa0>
break;
case PTHREAD_EXPLICIT_SCHED:
schedpolicy = the_attr->schedpolicy;
ffc08560: 83 7f 00 14 lwz r27,20(r31)
schedparam = the_attr->schedparam;
ffc08564: 38 7f 00 18 addi r3,r31,24
ffc08568: 38 81 00 18 addi r4,r1,24
ffc0856c: 7c a3 e4 aa lswi r5,r3,28
ffc08570: 7c a4 e5 aa stswi r5,r4,28
/*
* Check the contentionscope since rtems only supports PROCESS wide
* contention (i.e. no system wide contention).
*/
if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS )
return ENOTSUP;
ffc08574: 3b c0 00 86 li r30,134
/*
* Check the contentionscope since rtems only supports PROCESS wide
* contention (i.e. no system wide contention).
*/
if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS )
ffc08578: 81 3f 00 0c lwz r9,12(r31)
ffc0857c: 2f 89 00 00 cmpwi cr7,r9,0
ffc08580: 40 be 01 70 bne+ cr7,ffc086f0 <pthread_create+0x228>
return ENOTSUP;
/*
* Interpret the scheduling parameters.
*/
if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) )
ffc08584: 80 61 00 18 lwz r3,24(r1)
ffc08588: 48 00 62 35 bl ffc0e7bc <_POSIX_Priority_Is_valid>
ffc0858c: 2f 83 00 00 cmpwi cr7,r3,0
ffc08590: 41 be 01 5c beq+ cr7,ffc086ec <pthread_create+0x224> <== NEVER TAKEN
RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core(
int priority
)
{
return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1);
ffc08594: 3d 20 00 00 lis r9,0
return EINVAL;
core_priority = _POSIX_Priority_To_core( schedparam.sched_priority );
ffc08598: 82 c1 00 18 lwz r22,24(r1)
/*
* Set the core scheduling policy information.
*/
rc = _POSIX_Thread_Translate_sched_param(
ffc0859c: 7f 63 db 78 mr r3,r27
ffc085a0: 8a a9 27 84 lbz r21,10116(r9)
ffc085a4: 38 81 00 18 addi r4,r1,24
ffc085a8: 38 a1 00 38 addi r5,r1,56
ffc085ac: 38 c1 00 34 addi r6,r1,52
ffc085b0: 48 00 62 35 bl ffc0e7e4 <_POSIX_Thread_Translate_sched_param>
schedpolicy,
&schedparam,
&budget_algorithm,
&budget_callout
);
if ( rc )
ffc085b4: 7c 7e 1b 79 mr. r30,r3
ffc085b8: 40 a2 01 38 bne+ ffc086f0 <pthread_create+0x228>
#endif
/*
* Lock the allocator mutex for protection
*/
_RTEMS_Lock_allocator();
ffc085bc: 3f 40 00 00 lis r26,0
ffc085c0: 80 7a 28 7c lwz r3,10364(r26)
* _POSIX_Threads_Allocate
*/
RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void )
{
return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information );
ffc085c4: 3f a0 00 00 lis r29,0
ffc085c8: 3b bd 2e 60 addi r29,r29,11872
ffc085cc: 48 00 19 ad bl ffc09f78 <_API_Mutex_Lock>
ffc085d0: 7f a3 eb 78 mr r3,r29
ffc085d4: 48 00 24 79 bl ffc0aa4c <_Objects_Allocate>
* Allocate the thread control block.
*
* NOTE: Global threads are not currently supported.
*/
the_thread = _POSIX_Threads_Allocate();
if ( !the_thread ) {
ffc085d8: 7c 7c 1b 79 mr. r28,r3
ffc085dc: 40 a2 00 0c bne+ ffc085e8 <pthread_create+0x120>
_RTEMS_Unlock_allocator();
ffc085e0: 80 7a 28 7c lwz r3,10364(r26)
ffc085e4: 48 00 00 78 b ffc0865c <pthread_create+0x194>
static inline size_t _POSIX_Threads_Ensure_minimum_stack (
size_t size
)
{
if ( size >= PTHREAD_MINIMUM_STACK_SIZE )
ffc085e8: 3d 20 00 00 lis r9,0
/*
* Initialize the core thread for this task.
*/
name.name_p = NULL; /* posix threads don't have a name by default */
status = _Thread_Initialize(
ffc085ec: 81 5f 00 08 lwz r10,8(r31)
static inline size_t _POSIX_Threads_Ensure_minimum_stack (
size_t size
)
{
if ( size >= PTHREAD_MINIMUM_STACK_SIZE )
ffc085f0: 81 29 27 88 lwz r9,10120(r9)
/*
* Initialize the core thread for this task.
*/
name.name_p = NULL; /* posix threads don't have a name by default */
status = _Thread_Initialize(
ffc085f4: 93 c1 00 48 stw r30,72(r1)
ffc085f8: 55 26 08 3c rlwinm r6,r9,1,0,30
ffc085fc: 7f 86 50 40 cmplw cr7,r6,r10
ffc08600: 80 bf 00 04 lwz r5,4(r31)
ffc08604: 40 9c 00 08 bge- cr7,ffc0860c <pthread_create+0x144>
ffc08608: 7d 46 53 78 mr r6,r10
ffc0860c: 81 41 00 34 lwz r10,52(r1)
ffc08610: 7f a3 eb 78 mr r3,r29
ffc08614: 7f 84 e3 78 mr r4,r28
ffc08618: 91 41 00 08 stw r10,8(r1)
ffc0861c: 39 40 00 00 li r10,0
ffc08620: 38 e0 00 01 li r7,1
ffc08624: 91 41 00 0c stw r10,12(r1)
ffc08628: 39 41 00 48 addi r10,r1,72
ffc0862c: 7d 16 a8 50 subf r8,r22,r21
ffc08630: 91 41 00 10 stw r10,16(r1)
ffc08634: 39 20 00 01 li r9,1
ffc08638: 81 41 00 38 lwz r10,56(r1)
ffc0863c: 48 00 38 09 bl ffc0be44 <_Thread_Initialize>
budget_callout,
0, /* isr level */
name /* posix threads don't have a name */
);
if ( !status ) {
ffc08640: 2f 83 00 00 cmpwi cr7,r3,0
ffc08644: 40 9e 00 24 bne- cr7,ffc08668 <pthread_create+0x1a0>
RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free (
Thread_Control *the_pthread
)
{
_Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object );
ffc08648: 7f a3 eb 78 mr r3,r29
ffc0864c: 7f 84 e3 78 mr r4,r28
ffc08650: 48 00 27 65 bl ffc0adb4 <_Objects_Free>
_POSIX_Threads_Free( the_thread );
_RTEMS_Unlock_allocator();
ffc08654: 3d 20 00 00 lis r9,0
ffc08658: 80 69 28 7c lwz r3,10364(r9)
ffc0865c: 48 00 19 69 bl ffc09fc4 <_API_Mutex_Unlock>
return EAGAIN;
ffc08660: 3b c0 00 0b li r30,11
ffc08664: 48 00 00 8c b ffc086f0 <pthread_create+0x228>
}
/*
* finish initializing the per API structure
*/
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc08668: 83 bc 01 50 lwz r29,336(r28)
api->Attributes = *the_attr;
ffc0866c: 38 a0 00 40 li r5,64
ffc08670: 7f e4 fb 78 mr r4,r31
ffc08674: 7f a3 eb 78 mr r3,r29
ffc08678: 48 00 93 dd bl ffc11a54 <memcpy>
api->detachstate = the_attr->detachstate;
ffc0867c: 81 3f 00 3c lwz r9,60(r31)
api->schedpolicy = schedpolicy;
ffc08680: 93 7d 00 84 stw r27,132(r29)
api->schedparam = schedparam;
ffc08684: 38 9d 00 88 addi r4,r29,136
ffc08688: 38 61 00 18 addi r3,r1,24
* finish initializing the per API structure
*/
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
api->Attributes = *the_attr;
api->detachstate = the_attr->detachstate;
ffc0868c: 91 3d 00 40 stw r9,64(r29)
api->schedpolicy = schedpolicy;
api->schedparam = schedparam;
ffc08690: 7c a3 e4 aa lswi r5,r3,28
ffc08694: 7c a4 e5 aa stswi r5,r4,28
/*
* POSIX threads are allocated and started in one operation.
*/
status = _Thread_Start(
ffc08698: 7f 83 e3 78 mr r3,r28
ffc0869c: 38 80 00 01 li r4,1
ffc086a0: 7e e5 bb 78 mr r5,r23
ffc086a4: 7f 06 c3 78 mr r6,r24
ffc086a8: 38 e0 00 00 li r7,0
ffc086ac: 48 00 41 f1 bl ffc0c89c <_Thread_Start>
_RTEMS_Unlock_allocator();
return EINVAL;
}
#endif
if ( schedpolicy == SCHED_SPORADIC ) {
ffc086b0: 2f 9b 00 04 cmpwi cr7,r27,4
ffc086b4: 40 be 00 20 bne+ cr7,ffc086d4 <pthread_create+0x20c>
_Watchdog_Insert_ticks(
ffc086b8: 38 7d 00 90 addi r3,r29,144
ffc086bc: 48 00 42 75 bl ffc0c930 <_Timespec_To_ticks>
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc086c0: 38 9d 00 a8 addi r4,r29,168
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc086c4: 90 7d 00 b4 stw r3,180(r29)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc086c8: 3c 60 00 00 lis r3,0
ffc086cc: 38 63 2d 88 addi r3,r3,11656
ffc086d0: 48 00 45 25 bl ffc0cbf4 <_Watchdog_Insert>
}
/*
* Return the id and indicate we successfully created the thread
*/
*thread = the_thread->Object.id;
ffc086d4: 81 3c 00 08 lwz r9,8(r28)
ffc086d8: 91 39 00 00 stw r9,0(r25)
_RTEMS_Unlock_allocator();
ffc086dc: 3d 20 00 00 lis r9,0
ffc086e0: 80 69 28 7c lwz r3,10364(r9)
ffc086e4: 48 00 18 e1 bl ffc09fc4 <_API_Mutex_Unlock>
ffc086e8: 48 00 00 08 b ffc086f0 <pthread_create+0x228>
schedpolicy = the_attr->schedpolicy;
schedparam = the_attr->schedparam;
break;
default:
return EINVAL;
ffc086ec: 3b c0 00 16 li r30,22
*/
*thread = the_thread->Object.id;
_RTEMS_Unlock_allocator();
return 0;
}
ffc086f0: 39 61 00 80 addi r11,r1,128
ffc086f4: 7f c3 f3 78 mr r3,r30
ffc086f8: 4b ff 84 90 b ffc00b88 <_restgpr_21_x>
ffc1b984 <pthread_kill>:
int pthread_kill(
pthread_t thread,
int sig
)
{
ffc1b984: 94 21 ff d8 stwu r1,-40(r1)
ffc1b988: 7c 08 02 a6 mflr r0
ffc1b98c: bf 81 00 18 stmw r28,24(r1)
POSIX_API_Control *api;
Thread_Control *the_thread;
Objects_Locations location;
if ( !sig )
ffc1b990: 7c 9e 23 79 mr. r30,r4
int pthread_kill(
pthread_t thread,
int sig
)
{
ffc1b994: 90 01 00 2c stw r0,44(r1)
POSIX_API_Control *api;
Thread_Control *the_thread;
Objects_Locations location;
if ( !sig )
ffc1b998: 40 a2 00 08 bne+ ffc1b9a0 <pthread_kill+0x1c>
ffc1b99c: 48 00 00 10 b ffc1b9ac <pthread_kill+0x28>
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc1b9a0: 3b be ff ff addi r29,r30,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
ffc1b9a4: 2b 9d 00 1f cmplwi cr7,r29,31
ffc1b9a8: 40 bd 00 10 ble+ cr7,ffc1b9b8 <pthread_kill+0x34>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc1b9ac: 4b ff 4c 01 bl ffc105ac <__errno>
ffc1b9b0: 39 20 00 16 li r9,22
ffc1b9b4: 48 00 00 a8 b ffc1ba5c <pthread_kill+0xd8>
the_thread = _Thread_Get( thread, &location );
ffc1b9b8: 38 81 00 08 addi r4,r1,8
ffc1b9bc: 4b fe f8 89 bl ffc0b244 <_Thread_Get>
switch ( location ) {
ffc1b9c0: 81 21 00 08 lwz r9,8(r1)
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
rtems_set_errno_and_return_minus_one( EINVAL );
the_thread = _Thread_Get( thread, &location );
ffc1b9c4: 7c 7f 1b 78 mr r31,r3
switch ( location ) {
ffc1b9c8: 2f 89 00 00 cmpwi cr7,r9,0
ffc1b9cc: 40 9e 00 88 bne- cr7,ffc1ba54 <pthread_kill+0xd0> <== NEVER TAKEN
ffc1b9d0: 3c 60 00 00 lis r3,0
ffc1b9d4: 38 63 22 20 addi r3,r3,8736
ffc1b9d8: 4b fe d8 9d bl ffc09274 <_API_extensions_Add_post_switch>
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
if ( sig ) {
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) {
ffc1b9dc: 1d 1e 00 0c mulli r8,r30,12
* If sig == 0 then just validate arguments
*/
_POSIX_signals_Add_post_switch_extension();
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc1b9e0: 81 3f 01 50 lwz r9,336(r31)
if ( sig ) {
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) {
ffc1b9e4: 3d 40 00 00 lis r10,0
ffc1b9e8: 39 4a 32 20 addi r10,r10,12832
ffc1b9ec: 7d 4a 42 14 add r10,r10,r8
ffc1b9f0: 81 4a 00 08 lwz r10,8(r10)
ffc1b9f4: 2f 8a 00 01 cmpwi cr7,r10,1
ffc1b9f8: 40 be 00 10 bne+ cr7,ffc1ba08 <pthread_kill+0x84>
_Thread_Enable_dispatch();
ffc1b9fc: 4b fe f8 2d bl ffc0b228 <_Thread_Enable_dispatch>
return 0;
ffc1ba00: 38 60 00 00 li r3,0
ffc1ba04: 48 00 00 60 b ffc1ba64 <pthread_kill+0xe0>
}
/* XXX critical section */
api->signals_pending |= signo_to_mask( sig );
ffc1ba08: 81 49 00 d4 lwz r10,212(r9)
static inline sigset_t signo_to_mask(
uint32_t sig
)
{
return 1u << (sig - 1);
ffc1ba0c: 3b 80 00 01 li r28,1
ffc1ba10: 7f 9d e8 30 slw r29,r28,r29
ffc1ba14: 7d 4a eb 78 or r10,r10,r29
ffc1ba18: 91 49 00 d4 stw r10,212(r9)
(void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL );
ffc1ba1c: 7f e3 fb 78 mr r3,r31
ffc1ba20: 7f c4 f3 78 mr r4,r30
ffc1ba24: 38 a0 00 00 li r5,0
ffc1ba28: 4b ff fe 2d bl ffc1b854 <_POSIX_signals_Unblock_thread>
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
ffc1ba2c: 3d 20 00 00 lis r9,0
ffc1ba30: 39 29 31 a0 addi r9,r9,12704
ffc1ba34: 81 49 00 08 lwz r10,8(r9)
ffc1ba38: 2f 8a 00 00 cmpwi cr7,r10,0
ffc1ba3c: 41 be ff c0 beq- cr7,ffc1b9fc <pthread_kill+0x78>
ffc1ba40: 81 49 00 10 lwz r10,16(r9)
ffc1ba44: 7f 9f 50 00 cmpw cr7,r31,r10
ffc1ba48: 40 9e ff b4 bne+ cr7,ffc1b9fc <pthread_kill+0x78>
_Thread_Dispatch_necessary = true;
ffc1ba4c: 9b 89 00 0c stb r28,12(r9)
ffc1ba50: 4b ff ff ac b ffc1b9fc <pthread_kill+0x78>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( ESRCH );
ffc1ba54: 4b ff 4b 59 bl ffc105ac <__errno> <== NOT EXECUTED
ffc1ba58: 39 20 00 03 li r9,3 <== NOT EXECUTED
ffc1ba5c: 91 23 00 00 stw r9,0(r3)
ffc1ba60: 38 60 ff ff li r3,-1
}
ffc1ba64: 39 61 00 28 addi r11,r1,40
ffc1ba68: 4b fe 4b 50 b ffc005b8 <_restgpr_28_x>
ffc0a8a8 <pthread_mutex_timedlock>:
*/
int pthread_mutex_timedlock(
pthread_mutex_t *mutex,
const struct timespec *abstime
)
{
ffc0a8a8: 94 21 ff d8 stwu r1,-40(r1)
ffc0a8ac: 7c 08 02 a6 mflr r0
ffc0a8b0: bf a1 00 1c stmw r29,28(r1)
ffc0a8b4: 7c 7d 1b 78 mr r29,r3
*
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
ffc0a8b8: 7c 83 23 78 mr r3,r4
ffc0a8bc: 38 81 00 08 addi r4,r1,8
*/
int pthread_mutex_timedlock(
pthread_mutex_t *mutex,
const struct timespec *abstime
)
{
ffc0a8c0: 90 01 00 2c stw r0,44(r1)
*
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
ffc0a8c4: 48 00 00 d9 bl ffc0a99c <_POSIX_Absolute_timeout_to_ticks>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc0a8c8: 68 7f 00 03 xori r31,r3,3
do_wait = false;
lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks );
ffc0a8cc: 80 a1 00 08 lwz r5,8(r1)
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc0a8d0: 7f ff 00 34 cntlzw r31,r31
ffc0a8d4: 57 ff d9 7e rlwinm r31,r31,27,5,31
*
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
ffc0a8d8: 7c 7e 1b 78 mr r30,r3
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks );
ffc0a8dc: 7f e4 fb 78 mr r4,r31
ffc0a8e0: 7f a3 eb 78 mr r3,r29
ffc0a8e4: 4b ff fe b9 bl ffc0a79c <_POSIX_Mutex_Lock_support>
* This service only gives us the option to block. We used a polling
* attempt to lock if the abstime was not in the future. If we did
* not obtain the mutex, then not look at the status immediately,
* make sure the right reason is returned.
*/
if ( !do_wait && (lock_status == EBUSY) ) {
ffc0a8e8: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0a8ec: 40 9e 00 2c bne- cr7,ffc0a918 <pthread_mutex_timedlock+0x70>
ffc0a8f0: 2f 83 00 10 cmpwi cr7,r3,16
ffc0a8f4: 40 be 00 24 bne+ cr7,ffc0a918 <pthread_mutex_timedlock+0x70>
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc0a8f8: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0a8fc: 41 be 00 18 beq+ cr7,ffc0a914 <pthread_mutex_timedlock+0x6c><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc0a900: 3b de ff ff addi r30,r30,-1
ffc0a904: 2b 9e 00 01 cmplwi cr7,r30,1
ffc0a908: 41 bd 00 10 bgt+ cr7,ffc0a918 <pthread_mutex_timedlock+0x70><== NEVER TAKEN
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc0a90c: 38 60 00 74 li r3,116
ffc0a910: 48 00 00 08 b ffc0a918 <pthread_mutex_timedlock+0x70>
* not obtain the mutex, then not look at the status immediately,
* make sure the right reason is returned.
*/
if ( !do_wait && (lock_status == EBUSY) ) {
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
return EINVAL;
ffc0a914: 38 60 00 16 li r3,22 <== NOT EXECUTED
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
}
return lock_status;
}
ffc0a918: 39 61 00 28 addi r11,r1,40
ffc0a91c: 4b ff 80 60 b ffc0297c <_restgpr_29_x>
ffc08b80 <pthread_once>:
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
ffc08b80: 94 21 ff e0 stwu r1,-32(r1)
ffc08b84: 7c 08 02 a6 mflr r0
ffc08b88: bf c1 00 18 stmw r30,24(r1)
if ( !once_control || !init_routine )
ffc08b8c: 7c 7f 1b 79 mr. r31,r3
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
ffc08b90: 90 01 00 24 stw r0,36(r1)
if ( !once_control || !init_routine )
ffc08b94: 41 82 00 6c beq- ffc08c00 <pthread_once+0x80>
ffc08b98: 2f 84 00 00 cmpwi cr7,r4,0
ffc08b9c: 7c 9e 23 78 mr r30,r4
return EINVAL;
ffc08ba0: 38 60 00 16 li r3,22
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
if ( !once_control || !init_routine )
ffc08ba4: 41 9e 00 60 beq- cr7,ffc08c04 <pthread_once+0x84>
return EINVAL;
if ( !once_control->init_executed ) {
ffc08ba8: 81 3f 00 04 lwz r9,4(r31)
once_control->init_executed = true;
(*init_routine)();
}
rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode);
}
return 0;
ffc08bac: 38 60 00 00 li r3,0
)
{
if ( !once_control || !init_routine )
return EINVAL;
if ( !once_control->init_executed ) {
ffc08bb0: 2f 89 00 00 cmpwi cr7,r9,0
ffc08bb4: 40 be 00 50 bne+ cr7,ffc08c04 <pthread_once+0x84>
rtems_mode saveMode;
rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode);
ffc08bb8: 38 60 01 00 li r3,256
ffc08bbc: 38 80 01 00 li r4,256
ffc08bc0: 38 a1 00 08 addi r5,r1,8
ffc08bc4: 48 00 0c a5 bl ffc09868 <rtems_task_mode>
if ( !once_control->init_executed ) {
ffc08bc8: 81 3f 00 04 lwz r9,4(r31)
ffc08bcc: 2f 89 00 00 cmpwi cr7,r9,0
ffc08bd0: 40 be 00 18 bne+ cr7,ffc08be8 <pthread_once+0x68> <== NEVER TAKEN
once_control->is_initialized = true;
ffc08bd4: 39 20 00 01 li r9,1
once_control->init_executed = true;
(*init_routine)();
ffc08bd8: 7f c9 03 a6 mtctr r30
if ( !once_control->init_executed ) {
rtems_mode saveMode;
rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode);
if ( !once_control->init_executed ) {
once_control->is_initialized = true;
ffc08bdc: 91 3f 00 00 stw r9,0(r31)
once_control->init_executed = true;
ffc08be0: 91 3f 00 04 stw r9,4(r31)
(*init_routine)();
ffc08be4: 4e 80 04 21 bctrl
}
rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode);
ffc08be8: 7c 25 0b 78 mr r5,r1
ffc08bec: 84 65 00 08 lwzu r3,8(r5)
ffc08bf0: 38 80 01 00 li r4,256
ffc08bf4: 48 00 0c 75 bl ffc09868 <rtems_task_mode>
}
return 0;
ffc08bf8: 38 60 00 00 li r3,0
ffc08bfc: 48 00 00 08 b ffc08c04 <pthread_once+0x84>
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
if ( !once_control || !init_routine )
return EINVAL;
ffc08c00: 38 60 00 16 li r3,22
(*init_routine)();
}
rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode);
}
return 0;
}
ffc08c04: 39 61 00 20 addi r11,r1,32
ffc08c08: 4b ff 7f a4 b ffc00bac <_restgpr_30_x>
ffc08eec <pthread_rwlock_init>:
int pthread_rwlock_init(
pthread_rwlock_t *rwlock,
const pthread_rwlockattr_t *attr
)
{
ffc08eec: 94 21 ff d8 stwu r1,-40(r1)
ffc08ef0: 7c 08 02 a6 mflr r0
ffc08ef4: bf 81 00 18 stmw r28,24(r1)
const pthread_rwlockattr_t *the_attr;
/*
* Error check parameters
*/
if ( !rwlock )
ffc08ef8: 7c 7c 1b 79 mr. r28,r3
int pthread_rwlock_init(
pthread_rwlock_t *rwlock,
const pthread_rwlockattr_t *attr
)
{
ffc08efc: 90 01 00 2c stw r0,44(r1)
const pthread_rwlockattr_t *the_attr;
/*
* Error check parameters
*/
if ( !rwlock )
ffc08f00: 40 a2 00 08 bne+ ffc08f08 <pthread_rwlock_init+0x1c>
ffc08f04: 48 00 00 9c b ffc08fa0 <pthread_rwlock_init+0xb4>
return EINVAL;
/*
* If the user passed in NULL, use the default attributes
*/
if ( attr ) {
ffc08f08: 2f 84 00 00 cmpwi cr7,r4,0
ffc08f0c: 7c 89 23 78 mr r9,r4
ffc08f10: 40 be 00 10 bne+ cr7,ffc08f20 <pthread_rwlock_init+0x34>
the_attr = attr;
} else {
(void) pthread_rwlockattr_init( &default_attr );
ffc08f14: 38 61 00 08 addi r3,r1,8
ffc08f18: 48 00 06 fd bl ffc09614 <pthread_rwlockattr_init>
the_attr = &default_attr;
ffc08f1c: 39 21 00 08 addi r9,r1,8
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc08f20: 81 49 00 00 lwz r10,0(r9)
ffc08f24: 2f 8a 00 00 cmpwi cr7,r10,0
ffc08f28: 41 be 00 78 beq+ cr7,ffc08fa0 <pthread_rwlock_init+0xb4><== NEVER TAKEN
return EINVAL;
switch ( the_attr->process_shared ) {
ffc08f2c: 83 c9 00 04 lwz r30,4(r9)
ffc08f30: 2f 9e 00 00 cmpwi cr7,r30,0
ffc08f34: 40 9e 00 6c bne- cr7,ffc08fa0 <pthread_rwlock_init+0xb4><== NEVER TAKEN
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc08f38: 3d 20 00 00 lis r9,0
*/
RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes(
CORE_RWLock_Attributes *the_attributes
)
{
the_attributes->XXX = 0;
ffc08f3c: 93 c1 00 10 stw r30,16(r1)
ffc08f40: 81 49 28 a8 lwz r10,10408(r9)
++level;
ffc08f44: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc08f48: 91 49 28 a8 stw r10,10408(r9)
* This function allocates a RWLock control block from
* the inactive chain of free RWLock control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void )
{
return (POSIX_RWLock_Control *)
ffc08f4c: 3f a0 00 00 lis r29,0
ffc08f50: 3b bd 58 40 addi r29,r29,22592
ffc08f54: 7f a3 eb 78 mr r3,r29
ffc08f58: 48 00 2b 35 bl ffc0ba8c <_Objects_Allocate>
*/
_Thread_Disable_dispatch(); /* prevents deletion */
the_rwlock = _POSIX_RWLock_Allocate();
if ( !the_rwlock ) {
ffc08f5c: 7c 7f 1b 79 mr. r31,r3
ffc08f60: 40 a2 00 10 bne+ ffc08f70 <pthread_rwlock_init+0x84>
_Thread_Enable_dispatch();
ffc08f64: 48 00 3f 65 bl ffc0cec8 <_Thread_Enable_dispatch>
return EAGAIN;
ffc08f68: 38 60 00 0b li r3,11
ffc08f6c: 48 00 00 38 b ffc08fa4 <pthread_rwlock_init+0xb8>
}
_CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes );
ffc08f70: 38 7f 00 10 addi r3,r31,16
ffc08f74: 38 81 00 10 addi r4,r1,16
ffc08f78: 48 00 24 ad bl ffc0b424 <_CORE_RWLock_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc08f7c: 81 3f 00 08 lwz r9,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc08f80: 81 1d 00 1c lwz r8,28(r29)
ffc08f84: 55 2a 13 ba rlwinm r10,r9,2,14,29
ffc08f88: 7f e8 51 2e stwx r31,r8,r10
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc08f8c: 93 df 00 0c stw r30,12(r31)
&_POSIX_RWLock_Information,
&the_rwlock->Object,
0
);
*rwlock = the_rwlock->Object.id;
ffc08f90: 91 3c 00 00 stw r9,0(r28)
_Thread_Enable_dispatch();
ffc08f94: 48 00 3f 35 bl ffc0cec8 <_Thread_Enable_dispatch>
return 0;
ffc08f98: 38 60 00 00 li r3,0
ffc08f9c: 48 00 00 08 b ffc08fa4 <pthread_rwlock_init+0xb8>
switch ( the_attr->process_shared ) {
case PTHREAD_PROCESS_PRIVATE: /* only supported values */
break;
case PTHREAD_PROCESS_SHARED:
default:
return EINVAL;
ffc08fa0: 38 60 00 16 li r3,22
*rwlock = the_rwlock->Object.id;
_Thread_Enable_dispatch();
return 0;
}
ffc08fa4: 39 61 00 28 addi r11,r1,40
ffc08fa8: 48 01 3e 00 b ffc1cda8 <_restgpr_28_x>
ffc0979c <pthread_rwlock_timedrdlock>:
int pthread_rwlock_timedrdlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc0979c: 94 21 ff d8 stwu r1,-40(r1)
ffc097a0: 7c 08 02 a6 mflr r0
ffc097a4: bf a1 00 1c stmw r29,28(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc097a8: 7c 7d 1b 79 mr. r29,r3
int pthread_rwlock_timedrdlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc097ac: 90 01 00 2c stw r0,44(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc097b0: 40 82 00 08 bne- ffc097b8 <pthread_rwlock_timedrdlock+0x1c>
ffc097b4: 48 00 00 a4 b ffc09858 <pthread_rwlock_timedrdlock+0xbc>
*
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
ffc097b8: 7c 83 23 78 mr r3,r4
ffc097bc: 38 81 00 08 addi r4,r1,8
ffc097c0: 48 00 65 4d bl ffc0fd0c <_POSIX_Absolute_timeout_to_ticks>
ffc097c4: 80 9d 00 00 lwz r4,0(r29)
ffc097c8: 7c 7e 1b 78 mr r30,r3
ffc097cc: 3c 60 00 00 lis r3,0
ffc097d0: 38 63 2e 40 addi r3,r3,11840
ffc097d4: 38 a1 00 0c addi r5,r1,12
ffc097d8: 48 00 2d 65 bl ffc0c53c <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
ffc097dc: 81 21 00 0c lwz r9,12(r1)
ffc097e0: 2f 89 00 00 cmpwi cr7,r9,0
ffc097e4: 40 9e 00 74 bne- cr7,ffc09858 <pthread_rwlock_timedrdlock+0xbc>
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc097e8: 6b df 00 03 xori r31,r30,3
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
ffc097ec: 80 9d 00 00 lwz r4,0(r29)
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc097f0: 7f ff 00 34 cntlzw r31,r31
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
ffc097f4: 80 c1 00 08 lwz r6,8(r1)
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc097f8: 57 ff d9 7e rlwinm r31,r31,27,5,31
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
ffc097fc: 38 63 00 10 addi r3,r3,16
ffc09800: 7f e5 fb 78 mr r5,r31
ffc09804: 38 e0 00 00 li r7,0
ffc09808: 48 00 1f 09 bl ffc0b710 <_CORE_RWLock_Obtain_for_reading>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
ffc0980c: 48 00 3b 85 bl ffc0d390 <_Thread_Enable_dispatch>
if ( !do_wait ) {
ffc09810: 2f 9f 00 00 cmpwi cr7,r31,0
ffc09814: 40 9e 00 30 bne- cr7,ffc09844 <pthread_rwlock_timedrdlock+0xa8>
if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) {
ffc09818: 3d 20 00 00 lis r9,0
ffc0981c: 81 29 31 b0 lwz r9,12720(r9)
ffc09820: 81 29 00 34 lwz r9,52(r9)
ffc09824: 2f 89 00 02 cmpwi cr7,r9,2
ffc09828: 40 be 00 1c bne+ cr7,ffc09844 <pthread_rwlock_timedrdlock+0xa8>
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc0982c: 2f 9e 00 00 cmpwi cr7,r30,0
ffc09830: 41 be 00 28 beq+ cr7,ffc09858 <pthread_rwlock_timedrdlock+0xbc><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc09834: 3b de ff ff addi r30,r30,-1
ffc09838: 2b 9e 00 01 cmplwi cr7,r30,1
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc0983c: 38 60 00 74 li r3,116
_Thread_Enable_dispatch();
if ( !do_wait ) {
if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) {
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc09840: 40 9d 00 1c ble- cr7,ffc0985c <pthread_rwlock_timedrdlock+0xc0><== ALWAYS TAKEN
return ETIMEDOUT;
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
(CORE_RWLock_Status) _Thread_Executing->Wait.return_code
ffc09844: 3d 20 00 00 lis r9,0
ffc09848: 81 29 31 b0 lwz r9,12720(r9)
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
ffc0984c: 80 69 00 34 lwz r3,52(r9)
ffc09850: 48 00 00 dd bl ffc0992c <_POSIX_RWLock_Translate_core_RWLock_return_code>
ffc09854: 48 00 00 08 b ffc0985c <pthread_rwlock_timedrdlock+0xc0>
#endif
case OBJECTS_ERROR:
break;
}
return EINVAL;
ffc09858: 38 60 00 16 li r3,22
}
ffc0985c: 39 61 00 28 addi r11,r1,40
ffc09860: 4b ff 84 54 b ffc01cb4 <_restgpr_29_x>
ffc09864 <pthread_rwlock_timedwrlock>:
int pthread_rwlock_timedwrlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc09864: 94 21 ff d8 stwu r1,-40(r1)
ffc09868: 7c 08 02 a6 mflr r0
ffc0986c: bf a1 00 1c stmw r29,28(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc09870: 7c 7d 1b 79 mr. r29,r3
int pthread_rwlock_timedwrlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc09874: 90 01 00 2c stw r0,44(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc09878: 40 82 00 08 bne- ffc09880 <pthread_rwlock_timedwrlock+0x1c>
ffc0987c: 48 00 00 a4 b ffc09920 <pthread_rwlock_timedwrlock+0xbc>
*
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
ffc09880: 7c 83 23 78 mr r3,r4
ffc09884: 38 81 00 08 addi r4,r1,8
ffc09888: 48 00 64 85 bl ffc0fd0c <_POSIX_Absolute_timeout_to_ticks>
ffc0988c: 80 9d 00 00 lwz r4,0(r29)
ffc09890: 7c 7e 1b 78 mr r30,r3
ffc09894: 3c 60 00 00 lis r3,0
ffc09898: 38 63 2e 40 addi r3,r3,11840
ffc0989c: 38 a1 00 0c addi r5,r1,12
ffc098a0: 48 00 2c 9d bl ffc0c53c <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
ffc098a4: 81 21 00 0c lwz r9,12(r1)
ffc098a8: 2f 89 00 00 cmpwi cr7,r9,0
ffc098ac: 40 9e 00 74 bne- cr7,ffc09920 <pthread_rwlock_timedwrlock+0xbc>
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc098b0: 6b df 00 03 xori r31,r30,3
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
ffc098b4: 80 9d 00 00 lwz r4,0(r29)
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc098b8: 7f ff 00 34 cntlzw r31,r31
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
ffc098bc: 80 c1 00 08 lwz r6,8(r1)
* If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID,
* POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW,
* then we should not wait.
*/
status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks );
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
ffc098c0: 57 ff d9 7e rlwinm r31,r31,27,5,31
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
ffc098c4: 38 63 00 10 addi r3,r3,16
ffc098c8: 7f e5 fb 78 mr r5,r31
ffc098cc: 38 e0 00 00 li r7,0
ffc098d0: 48 00 1f 25 bl ffc0b7f4 <_CORE_RWLock_Obtain_for_writing>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
ffc098d4: 48 00 3a bd bl ffc0d390 <_Thread_Enable_dispatch>
if ( !do_wait &&
ffc098d8: 2f 9f 00 00 cmpwi cr7,r31,0
ffc098dc: 40 9e 00 30 bne- cr7,ffc0990c <pthread_rwlock_timedwrlock+0xa8>
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
ffc098e0: 3d 20 00 00 lis r9,0
ffc098e4: 81 29 31 b0 lwz r9,12720(r9)
ticks,
NULL
);
_Thread_Enable_dispatch();
if ( !do_wait &&
ffc098e8: 81 29 00 34 lwz r9,52(r9)
ffc098ec: 2f 89 00 02 cmpwi cr7,r9,2
ffc098f0: 40 be 00 1c bne+ cr7,ffc0990c <pthread_rwlock_timedwrlock+0xa8>
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc098f4: 2f 9e 00 00 cmpwi cr7,r30,0
ffc098f8: 41 be 00 28 beq+ cr7,ffc09920 <pthread_rwlock_timedwrlock+0xbc><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc098fc: 3b de ff ff addi r30,r30,-1
ffc09900: 2b 9e 00 01 cmplwi cr7,r30,1
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc09904: 38 60 00 74 li r3,116
_Thread_Enable_dispatch();
if ( !do_wait &&
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc09908: 40 9d 00 1c ble- cr7,ffc09924 <pthread_rwlock_timedwrlock+0xc0><== ALWAYS TAKEN
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
(CORE_RWLock_Status) _Thread_Executing->Wait.return_code
ffc0990c: 3d 20 00 00 lis r9,0
ffc09910: 81 29 31 b0 lwz r9,12720(r9)
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
ffc09914: 80 69 00 34 lwz r3,52(r9)
ffc09918: 48 00 00 15 bl ffc0992c <_POSIX_RWLock_Translate_core_RWLock_return_code>
ffc0991c: 48 00 00 08 b ffc09924 <pthread_rwlock_timedwrlock+0xc0>
#endif
case OBJECTS_ERROR:
break;
}
return EINVAL;
ffc09920: 38 60 00 16 li r3,22
}
ffc09924: 39 61 00 28 addi r11,r1,40
ffc09928: 4b ff 83 8c b ffc01cb4 <_restgpr_29_x>
ffc0b1d8 <pthread_setschedparam>:
int pthread_setschedparam(
pthread_t thread,
int policy,
struct sched_param *param
)
{
ffc0b1d8: 94 21 ff d0 stwu r1,-48(r1)
ffc0b1dc: 7c 08 02 a6 mflr r0
ffc0b1e0: bf 61 00 1c stmw r27,28(r1)
int rc;
/*
* Check all the parameters
*/
if ( !param )
ffc0b1e4: 7c bb 2b 79 mr. r27,r5
return EINVAL;
ffc0b1e8: 3b 80 00 16 li r28,22
int pthread_setschedparam(
pthread_t thread,
int policy,
struct sched_param *param
)
{
ffc0b1ec: 90 01 00 34 stw r0,52(r1)
int rc;
/*
* Check all the parameters
*/
if ( !param )
ffc0b1f0: 41 82 00 f0 beq- ffc0b2e0 <pthread_setschedparam+0x108>
ffc0b1f4: 7c 7f 1b 78 mr r31,r3
ffc0b1f8: 7c 9d 23 78 mr r29,r4
return EINVAL;
rc = _POSIX_Thread_Translate_sched_param(
ffc0b1fc: 7c 83 23 78 mr r3,r4
ffc0b200: 38 a1 00 10 addi r5,r1,16
ffc0b204: 7f 64 db 78 mr r4,r27
ffc0b208: 38 c1 00 0c addi r6,r1,12
ffc0b20c: 48 00 5c 15 bl ffc10e20 <_POSIX_Thread_Translate_sched_param>
policy,
param,
&budget_algorithm,
&budget_callout
);
if ( rc )
ffc0b210: 7c 7c 1b 79 mr. r28,r3
ffc0b214: 40 a2 00 cc bne+ ffc0b2e0 <pthread_setschedparam+0x108>
return rc;
/*
* Actually change the scheduling policy and parameters
*/
the_thread = _Thread_Get( thread, &location );
ffc0b218: 7f e3 fb 78 mr r3,r31
ffc0b21c: 38 81 00 08 addi r4,r1,8
ffc0b220: 48 00 30 ad bl ffc0e2cc <_Thread_Get>
switch ( location ) {
ffc0b224: 81 21 00 08 lwz r9,8(r1)
return rc;
/*
* Actually change the scheduling policy and parameters
*/
the_thread = _Thread_Get( thread, &location );
ffc0b228: 7c 7e 1b 78 mr r30,r3
switch ( location ) {
ffc0b22c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b230: 40 9e 00 ac bne- cr7,ffc0b2dc <pthread_setschedparam+0x104>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0b234: 83 e3 01 50 lwz r31,336(r3)
if ( api->schedpolicy == SCHED_SPORADIC )
ffc0b238: 81 3f 00 84 lwz r9,132(r31)
ffc0b23c: 2f 89 00 04 cmpwi cr7,r9,4
ffc0b240: 40 be 00 0c bne+ cr7,ffc0b24c <pthread_setschedparam+0x74>
(void) _Watchdog_Remove( &api->Sporadic_timer );
ffc0b244: 38 7f 00 a8 addi r3,r31,168
ffc0b248: 48 00 41 6d bl ffc0f3b4 <_Watchdog_Remove>
api->schedpolicy = policy;
ffc0b24c: 93 bf 00 84 stw r29,132(r31)
api->schedparam = *param;
ffc0b250: 38 9f 00 88 addi r4,r31,136
the_thread->budget_algorithm = budget_algorithm;
the_thread->budget_callout = budget_callout;
switch ( api->schedpolicy ) {
ffc0b254: 2f 9d 00 00 cmpwi cr7,r29,0
if ( api->schedpolicy == SCHED_SPORADIC )
(void) _Watchdog_Remove( &api->Sporadic_timer );
api->schedpolicy = policy;
api->schedparam = *param;
ffc0b258: 7c bb e4 aa lswi r5,r27,28
ffc0b25c: 7c a4 e5 aa stswi r5,r4,28
the_thread->budget_algorithm = budget_algorithm;
ffc0b260: 81 21 00 10 lwz r9,16(r1)
ffc0b264: 91 3e 00 78 stw r9,120(r30)
the_thread->budget_callout = budget_callout;
ffc0b268: 81 21 00 0c lwz r9,12(r1)
ffc0b26c: 91 3e 00 7c stw r9,124(r30)
switch ( api->schedpolicy ) {
ffc0b270: 41 9c 00 64 blt- cr7,ffc0b2d4 <pthread_setschedparam+0xfc><== NEVER TAKEN
ffc0b274: 2f 9d 00 02 cmpwi cr7,r29,2
ffc0b278: 40 9d 00 10 ble- cr7,ffc0b288 <pthread_setschedparam+0xb0>
ffc0b27c: 2f 9d 00 04 cmpwi cr7,r29,4
ffc0b280: 40 be 00 54 bne+ cr7,ffc0b2d4 <pthread_setschedparam+0xfc><== NEVER TAKEN
ffc0b284: 48 00 00 34 b ffc0b2b8 <pthread_setschedparam+0xe0>
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b288: 3d 20 00 00 lis r9,0
ffc0b28c: 81 29 28 e0 lwz r9,10464(r9)
the_thread->real_priority =
_POSIX_Priority_To_core( api->schedparam.sched_priority );
_Thread_Change_priority(
ffc0b290: 7f c3 f3 78 mr r3,r30
ffc0b294: 38 a0 00 01 li r5,1
switch ( api->schedpolicy ) {
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b298: 91 3e 00 74 stw r9,116(r30)
ffc0b29c: 3d 20 00 00 lis r9,0
ffc0b2a0: 88 89 27 c4 lbz r4,10180(r9)
ffc0b2a4: 81 3f 00 88 lwz r9,136(r31)
ffc0b2a8: 7c 89 20 50 subf r4,r9,r4
the_thread->real_priority =
ffc0b2ac: 90 9e 00 18 stw r4,24(r30)
_POSIX_Priority_To_core( api->schedparam.sched_priority );
_Thread_Change_priority(
ffc0b2b0: 48 00 2a bd bl ffc0dd6c <_Thread_Change_priority>
the_thread,
the_thread->real_priority,
true
);
break;
ffc0b2b4: 48 00 00 20 b ffc0b2d4 <pthread_setschedparam+0xfc>
case SCHED_SPORADIC:
api->ss_high_priority = api->schedparam.sched_priority;
ffc0b2b8: 81 3f 00 88 lwz r9,136(r31)
_Watchdog_Remove( &api->Sporadic_timer );
ffc0b2bc: 38 7f 00 a8 addi r3,r31,168
true
);
break;
case SCHED_SPORADIC:
api->ss_high_priority = api->schedparam.sched_priority;
ffc0b2c0: 91 3f 00 a4 stw r9,164(r31)
_Watchdog_Remove( &api->Sporadic_timer );
ffc0b2c4: 48 00 40 f1 bl ffc0f3b4 <_Watchdog_Remove>
_POSIX_Threads_Sporadic_budget_TSR( 0, the_thread );
ffc0b2c8: 38 60 00 00 li r3,0
ffc0b2cc: 7f c4 f3 78 mr r4,r30
ffc0b2d0: 4b ff fd cd bl ffc0b09c <_POSIX_Threads_Sporadic_budget_TSR>
break;
}
_Thread_Enable_dispatch();
ffc0b2d4: 48 00 2f dd bl ffc0e2b0 <_Thread_Enable_dispatch>
ffc0b2d8: 48 00 00 08 b ffc0b2e0 <pthread_setschedparam+0x108>
#endif
case OBJECTS_ERROR:
break;
}
return ESRCH;
ffc0b2dc: 3b 80 00 03 li r28,3
}
ffc0b2e0: 39 61 00 30 addi r11,r1,48
ffc0b2e4: 7f 83 e3 78 mr r3,r28
ffc0b2e8: 4b ff 76 8c b ffc02974 <_restgpr_27_x>
ffc08850 <pthread_testcancel>:
* Don't even think about deleting a resource from an ISR.
* Besides this request is supposed to be for _Thread_Executing
* and the ISR context is not a thread.
*/
if ( _ISR_Is_in_progress() )
ffc08850: 3d 20 00 00 lis r9,0
ffc08854: 39 29 31 60 addi r9,r9,12640
ffc08858: 81 49 00 08 lwz r10,8(r9)
ffc0885c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc08860: 4c be 00 20 bnelr+ cr7
/*
* 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183
*/
void pthread_testcancel( void )
{
ffc08864: 7c 2b 0b 78 mr r11,r1
ffc08868: 7c 08 02 a6 mflr r0
ffc0886c: 94 21 ff f0 stwu r1,-16(r1)
ffc08870: 90 01 00 14 stw r0,20(r1)
ffc08874: 48 00 d7 39 bl ffc15fac <_savegpr_31>
*/
if ( _ISR_Is_in_progress() )
return;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc08878: 81 29 00 10 lwz r9,16(r9)
ffc0887c: 81 49 01 50 lwz r10,336(r9)
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc08880: 3d 20 00 00 lis r9,0
ffc08884: 81 09 28 68 lwz r8,10344(r9)
++level;
ffc08888: 39 08 00 01 addi r8,r8,1
_Thread_Dispatch_disable_level = level;
ffc0888c: 91 09 28 68 stw r8,10344(r9)
_Thread_Disable_dispatch();
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
ffc08890: 81 0a 00 d8 lwz r8,216(r10)
*/
void pthread_testcancel( void )
{
POSIX_API_Control *thread_support;
bool cancel = false;
ffc08894: 3b e0 00 00 li r31,0
return;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
_Thread_Disable_dispatch();
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
ffc08898: 2f 88 00 00 cmpwi cr7,r8,0
ffc0889c: 40 9e 00 14 bne- cr7,ffc088b0 <pthread_testcancel+0x60> <== NEVER TAKEN
ffc088a0: 81 2a 00 e0 lwz r9,224(r10)
ffc088a4: 7d 29 00 34 cntlzw r9,r9
ffc088a8: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc088ac: 69 3f 00 01 xori r31,r9,1
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
ffc088b0: 48 00 2e bd bl ffc0b76c <_Thread_Enable_dispatch>
if ( cancel )
ffc088b4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc088b8: 41 be 00 24 beq+ cr7,ffc088dc <pthread_testcancel+0x8c>
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
}
ffc088bc: 80 01 00 14 lwz r0,20(r1)
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
if ( cancel )
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
ffc088c0: 3d 20 00 00 lis r9,0
}
ffc088c4: 83 e1 00 0c lwz r31,12(r1)
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
if ( cancel )
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
ffc088c8: 38 80 ff ff li r4,-1
}
ffc088cc: 7c 08 03 a6 mtlr r0
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
if ( cancel )
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
ffc088d0: 80 69 31 70 lwz r3,12656(r9)
}
ffc088d4: 38 21 00 10 addi r1,r1,16
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
if ( cancel )
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
ffc088d8: 48 00 5a b4 b ffc0e38c <_POSIX_Thread_Exit>
}
ffc088dc: 39 61 00 10 addi r11,r1,16
ffc088e0: 48 00 d7 18 b ffc15ff8 <_restgpr_31_x>
ffc08e6c <rtems_aio_enqueue>:
* errno - otherwise
*/
int
rtems_aio_enqueue (rtems_aio_request *req)
{
ffc08e6c: 94 21 ff b0 stwu r1,-80(r1)
ffc08e70: 7c 08 02 a6 mflr r0
ffc08e74: bf 61 00 3c stmw r27,60(r1)
struct sched_param param;
/* The queue should be initialized */
AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED);
result = pthread_mutex_lock (&aio_request_queue.mutex);
ffc08e78: 3f c0 00 00 lis r30,0
ffc08e7c: 3b de 2b b0 addi r30,r30,11184
* errno - otherwise
*/
int
rtems_aio_enqueue (rtems_aio_request *req)
{
ffc08e80: 7c 7f 1b 78 mr r31,r3
ffc08e84: 90 01 00 54 stw r0,84(r1)
struct sched_param param;
/* The queue should be initialized */
AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED);
result = pthread_mutex_lock (&aio_request_queue.mutex);
ffc08e88: 7f c3 f3 78 mr r3,r30
ffc08e8c: 48 00 0a a5 bl ffc09930 <pthread_mutex_lock>
if (result != 0) {
ffc08e90: 7c 7c 1b 79 mr. r28,r3
ffc08e94: 41 a2 00 10 beq+ ffc08ea4 <rtems_aio_enqueue+0x38> <== ALWAYS TAKEN
free (req);
ffc08e98: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08e9c: 4b ff ba 0d bl ffc048a8 <free> <== NOT EXECUTED
ffc08ea0: 48 00 01 b8 b ffc09058 <rtems_aio_enqueue+0x1ec> <== NOT EXECUTED
return result;
}
/* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined,
we can use aio_reqprio to lower the priority of the request */
pthread_getschedparam (pthread_self(), &policy, ¶m);
ffc08ea4: 48 00 13 4d bl ffc0a1f0 <pthread_self>
ffc08ea8: 38 81 00 24 addi r4,r1,36
ffc08eac: 38 a1 00 08 addi r5,r1,8
ffc08eb0: 48 00 0f 41 bl ffc09df0 <pthread_getschedparam>
ffc08eb4: 3b 7e 00 48 addi r27,r30,72
req->caller_thread = pthread_self ();
ffc08eb8: 48 00 13 39 bl ffc0a1f0 <pthread_self>
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
ffc08ebc: 81 3f 00 14 lwz r9,20(r31)
ffc08ec0: 81 01 00 08 lwz r8,8(r1)
ffc08ec4: 81 49 00 18 lwz r10,24(r9)
/* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined,
we can use aio_reqprio to lower the priority of the request */
pthread_getschedparam (pthread_self(), &policy, ¶m);
req->caller_thread = pthread_self ();
ffc08ec8: 90 7f 00 10 stw r3,16(r31)
if ((aio_request_queue.idle_threads == 0) &&
aio_request_queue.active_threads < AIO_MAX_THREADS)
/* we still have empty places on the active_threads chain */
{
chain = &aio_request_queue.work_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08ecc: 7f 63 db 78 mr r3,r27
/* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined,
we can use aio_reqprio to lower the priority of the request */
pthread_getschedparam (pthread_self(), &policy, ¶m);
req->caller_thread = pthread_self ();
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
ffc08ed0: 7d 4a 40 50 subf r10,r10,r8
ffc08ed4: 91 5f 00 0c stw r10,12(r31)
req->policy = policy;
ffc08ed8: 81 41 00 24 lwz r10,36(r1)
if ((aio_request_queue.idle_threads == 0) &&
aio_request_queue.active_threads < AIO_MAX_THREADS)
/* we still have empty places on the active_threads chain */
{
chain = &aio_request_queue.work_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08edc: 80 89 00 00 lwz r4,0(r9)
we can use aio_reqprio to lower the priority of the request */
pthread_getschedparam (pthread_self(), &policy, ¶m);
req->caller_thread = pthread_self ();
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
req->policy = policy;
ffc08ee0: 91 5f 00 08 stw r10,8(r31)
req->aiocbp->error_code = EINPROGRESS;
ffc08ee4: 39 40 00 77 li r10,119
ffc08ee8: 91 49 00 34 stw r10,52(r9)
req->aiocbp->return_value = 0;
if ((aio_request_queue.idle_threads == 0) &&
ffc08eec: 81 5e 00 68 lwz r10,104(r30)
req->caller_thread = pthread_self ();
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
req->policy = policy;
req->aiocbp->error_code = EINPROGRESS;
req->aiocbp->return_value = 0;
ffc08ef0: 93 89 00 38 stw r28,56(r9)
if ((aio_request_queue.idle_threads == 0) &&
ffc08ef4: 2f 8a 00 00 cmpwi cr7,r10,0
ffc08ef8: 40 9e 00 a8 bne- cr7,ffc08fa0 <rtems_aio_enqueue+0x134> <== NEVER TAKEN
ffc08efc: 81 5e 00 64 lwz r10,100(r30)
ffc08f00: 2f 8a 00 04 cmpwi cr7,r10,4
ffc08f04: 41 bd 00 9c bgt+ cr7,ffc08fa0 <rtems_aio_enqueue+0x134>
aio_request_queue.active_threads < AIO_MAX_THREADS)
/* we still have empty places on the active_threads chain */
{
chain = &aio_request_queue.work_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08f08: 38 a0 00 01 li r5,1
ffc08f0c: 4b ff fd bd bl ffc08cc8 <rtems_aio_search_fd>
if (r_chain->new_fd == 1) {
ffc08f10: 81 23 00 18 lwz r9,24(r3)
if ((aio_request_queue.idle_threads == 0) &&
aio_request_queue.active_threads < AIO_MAX_THREADS)
/* we still have empty places on the active_threads chain */
{
chain = &aio_request_queue.work_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08f14: 7c 7d 1b 78 mr r29,r3
ffc08f18: 3b 63 00 08 addi r27,r3,8
if (r_chain->new_fd == 1) {
ffc08f1c: 2f 89 00 01 cmpwi cr7,r9,1
ffc08f20: 40 be 00 6c bne+ cr7,ffc08f8c <rtems_aio_enqueue+0x120>
RTEMS_INLINE_ROUTINE void _Chain_Prepend(
Chain_Control *the_chain,
Chain_Node *the_node
)
{
_Chain_Insert(_Chain_Head(the_chain), the_node);
ffc08f24: 7f e4 fb 78 mr r4,r31
ffc08f28: 7f 63 db 78 mr r3,r27
ffc08f2c: 48 00 25 79 bl ffc0b4a4 <_Chain_Insert>
rtems_chain_prepend (&r_chain->perfd, &req->next_prio);
r_chain->new_fd = 0;
ffc08f30: 93 9d 00 18 stw r28,24(r29)
pthread_mutex_init (&r_chain->mutex, NULL);
ffc08f34: 38 80 00 00 li r4,0
ffc08f38: 38 7d 00 1c addi r3,r29,28
ffc08f3c: 48 00 08 95 bl ffc097d0 <pthread_mutex_init>
pthread_cond_init (&r_chain->cond, NULL);
ffc08f40: 38 80 00 00 li r4,0
ffc08f44: 38 7d 00 20 addi r3,r29,32
ffc08f48: 48 00 04 45 bl ffc0938c <pthread_cond_init>
AIO_printf ("New thread \n");
result = pthread_create (&thid, &aio_request_queue.attr,
ffc08f4c: 3c a0 ff c1 lis r5,-63
ffc08f50: 38 61 00 28 addi r3,r1,40
ffc08f54: 38 9e 00 08 addi r4,r30,8
ffc08f58: 38 a5 89 20 addi r5,r5,-30432
ffc08f5c: 7f a6 eb 78 mr r6,r29
ffc08f60: 48 00 0c 5d bl ffc09bbc <pthread_create>
rtems_aio_handle, (void *) r_chain);
if (result != 0) {
ffc08f64: 7c 7f 1b 79 mr. r31,r3
ffc08f68: 41 a2 00 14 beq+ ffc08f7c <rtems_aio_enqueue+0x110> <== ALWAYS TAKEN
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08f6c: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc08f70: 48 00 0a 4d bl ffc099bc <pthread_mutex_unlock> <== NOT EXECUTED
ffc08f74: 7f fc fb 78 mr r28,r31 <== NOT EXECUTED
ffc08f78: 48 00 00 e0 b ffc09058 <rtems_aio_enqueue+0x1ec> <== NOT EXECUTED
return result;
}
++aio_request_queue.active_threads;
ffc08f7c: 81 3e 00 64 lwz r9,100(r30)
ffc08f80: 39 29 00 01 addi r9,r9,1
ffc08f84: 91 3e 00 64 stw r9,100(r30)
ffc08f88: 48 00 00 c4 b ffc0904c <rtems_aio_enqueue+0x1e0>
}
else {
/* put request in the fd chain it belongs to */
pthread_mutex_lock (&r_chain->mutex);
ffc08f8c: 3b c3 00 1c addi r30,r3,28
ffc08f90: 7f c3 f3 78 mr r3,r30
ffc08f94: 48 00 09 9d bl ffc09930 <pthread_mutex_lock>
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc08f98: 7f 63 db 78 mr r3,r27
ffc08f9c: 48 00 00 24 b ffc08fc0 <rtems_aio_enqueue+0x154>
else
{
/* the maximum number of threads has been already created
even though some of them might be idle.
The request belongs to one of the active fd chain */
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc08fa0: 38 a0 00 00 li r5,0
ffc08fa4: 4b ff fd 25 bl ffc08cc8 <rtems_aio_search_fd>
req->aiocbp->aio_fildes, 0);
if (r_chain != NULL)
ffc08fa8: 7c 7d 1b 79 mr. r29,r3
ffc08fac: 41 82 00 30 beq- ffc08fdc <rtems_aio_enqueue+0x170>
{
pthread_mutex_lock (&r_chain->mutex);
ffc08fb0: 3b dd 00 1c addi r30,r29,28
ffc08fb4: 7f c3 f3 78 mr r3,r30
ffc08fb8: 48 00 09 79 bl ffc09930 <pthread_mutex_lock>
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc08fbc: 38 7d 00 08 addi r3,r29,8
ffc08fc0: 7f e4 fb 78 mr r4,r31
ffc08fc4: 4b ff fb c9 bl ffc08b8c <rtems_aio_insert_prio>
pthread_cond_signal (&r_chain->cond);
ffc08fc8: 38 7d 00 20 addi r3,r29,32
ffc08fcc: 48 00 04 85 bl ffc09450 <pthread_cond_signal>
pthread_mutex_unlock (&r_chain->mutex);
ffc08fd0: 7f c3 f3 78 mr r3,r30
ffc08fd4: 48 00 09 e9 bl ffc099bc <pthread_mutex_unlock>
ffc08fd8: 48 00 00 74 b ffc0904c <rtems_aio_enqueue+0x1e0>
} else {
/* or to the idle chain */
chain = &aio_request_queue.idle_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08fdc: 81 3f 00 14 lwz r9,20(r31)
ffc08fe0: 38 7b 00 0c addi r3,r27,12
ffc08fe4: 38 a0 00 01 li r5,1
ffc08fe8: 80 89 00 00 lwz r4,0(r9)
ffc08fec: 4b ff fc dd bl ffc08cc8 <rtems_aio_search_fd>
ffc08ff0: 7f e4 fb 78 mr r4,r31
if (r_chain->new_fd == 1) {
ffc08ff4: 81 23 00 18 lwz r9,24(r3)
} else {
/* or to the idle chain */
chain = &aio_request_queue.idle_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08ff8: 7c 7e 1b 78 mr r30,r3
ffc08ffc: 38 63 00 08 addi r3,r3,8
if (r_chain->new_fd == 1) {
ffc09000: 2f 89 00 01 cmpwi cr7,r9,1
ffc09004: 40 be 00 28 bne+ cr7,ffc0902c <rtems_aio_enqueue+0x1c0>
ffc09008: 48 00 24 9d bl ffc0b4a4 <_Chain_Insert>
/* If this is a new fd chain we signal the idle threads that
might be waiting for requests */
AIO_printf (" New chain on waiting queue \n ");
rtems_chain_prepend (&r_chain->perfd, &req->next_prio);
r_chain->new_fd = 0;
ffc0900c: 93 be 00 18 stw r29,24(r30)
pthread_mutex_init (&r_chain->mutex, NULL);
ffc09010: 38 7e 00 1c addi r3,r30,28
ffc09014: 38 80 00 00 li r4,0
ffc09018: 48 00 07 b9 bl ffc097d0 <pthread_mutex_init>
pthread_cond_init (&r_chain->cond, NULL);
ffc0901c: 38 7e 00 20 addi r3,r30,32
ffc09020: 38 80 00 00 li r4,0
ffc09024: 48 00 03 69 bl ffc0938c <pthread_cond_init>
ffc09028: 48 00 00 08 b ffc09030 <rtems_aio_enqueue+0x1c4>
} else
/* just insert the request in the existing fd chain */
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc0902c: 4b ff fb 61 bl ffc08b8c <rtems_aio_insert_prio>
if (aio_request_queue.idle_threads > 0)
ffc09030: 3c 60 00 00 lis r3,0
ffc09034: 38 63 2b b0 addi r3,r3,11184
ffc09038: 81 23 00 68 lwz r9,104(r3)
ffc0903c: 2f 89 00 00 cmpwi cr7,r9,0
ffc09040: 40 9d 00 0c ble- cr7,ffc0904c <rtems_aio_enqueue+0x1e0> <== ALWAYS TAKEN
pthread_cond_signal (&aio_request_queue.new_req);
ffc09044: 38 63 00 04 addi r3,r3,4 <== NOT EXECUTED
ffc09048: 48 00 04 09 bl ffc09450 <pthread_cond_signal> <== NOT EXECUTED
}
}
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc0904c: 3c 60 00 00 lis r3,0
ffc09050: 38 63 2b b0 addi r3,r3,11184
ffc09054: 48 00 09 69 bl ffc099bc <pthread_mutex_unlock>
return 0;
}
ffc09058: 39 61 00 50 addi r11,r1,80
ffc0905c: 7f 83 e3 78 mr r3,r28
ffc09060: 4b ff 7b 18 b ffc00b78 <_restgpr_27_x>
ffc08920 <rtems_aio_handle>:
* NULL - if error
*/
static void *
rtems_aio_handle (void *arg)
{
ffc08920: 94 21 ff a0 stwu r1,-96(r1)
ffc08924: 7c 08 02 a6 mflr r0
ffc08928: be c1 00 38 stmw r22,56(r1)
struct timespec timeout;
AIO_printf ("Chain is empty [WQ], wait for work\n");
pthread_mutex_unlock (&r_chain->mutex);
pthread_mutex_lock (&aio_request_queue.mutex);
ffc0892c: 3f e0 00 00 lis r31,0
ffc08930: 3b ff 2b b0 addi r31,r31,11184
* NULL - if error
*/
static void *
rtems_aio_handle (void *arg)
{
ffc08934: 90 01 00 64 stw r0,100(r1)
ffc08938: 7c 7e 1b 78 mr r30,r3
pthread_cond_destroy (&r_chain->cond);
free (r_chain);
/* If the idle chain is empty sleep for 3 seconds and wait for a
signal. The thread now becomes idle. */
if (rtems_chain_is_empty (&aio_request_queue.idle_req)) {
ffc0893c: 3b 5f 00 58 addi r26,r31,88
rtems_chain_node *node;
node = rtems_chain_first (&aio_request_queue.work_req);
temp = (rtems_aio_request_chain *) node;
while (temp->fildes < r_chain->fildes &&
ffc08940: 3b 3f 00 4c addi r25,r31,76
--aio_request_queue.active_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08944: 3b 1f 00 04 addi r24,r31,4
default:
result = -1;
}
if (result == -1) {
req->aiocbp->return_value = -1;
ffc08948: 3a e0 ff ff li r23,-1
req->aiocbp->error_code = errno;
} else {
req->aiocbp->return_value = result;
req->aiocbp->error_code = 0;
ffc0894c: 3a c0 00 00 li r22,0
/* acquire the mutex of the current fd chain.
we don't need to lock the queue mutex since we can
add requests to idle fd chains or even active ones
if the working request has been extracted from the
chain */
result = pthread_mutex_lock (&r_chain->mutex);
ffc08950: 3b 9e 00 1c addi r28,r30,28
ffc08954: 7f 83 e3 78 mr r3,r28
ffc08958: 48 00 0f d9 bl ffc09930 <pthread_mutex_lock>
if (result != 0)
ffc0895c: 7c 7b 1b 79 mr. r27,r3
ffc08960: 40 82 02 20 bne- ffc08b80 <rtems_aio_handle+0x260> <== NEVER TAKEN
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc08964: 83 be 00 08 lwz r29,8(r30)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc08968: 39 3e 00 0c addi r9,r30,12
/* If the locked chain is not empty, take the first
request extract it, unlock the chain and process
the request, in this way the user can supply more
requests to this fd chain */
if (!rtems_chain_is_empty (chain)) {
ffc0896c: 7f 9d 48 00 cmpw cr7,r29,r9
ffc08970: 41 9e 00 cc beq- cr7,ffc08a3c <rtems_aio_handle+0x11c>
node = rtems_chain_first (chain);
req = (rtems_aio_request *) node;
/* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING
discussion in rtems_aio_enqueue () */
pthread_getschedparam (pthread_self(), &policy, ¶m);
ffc08974: 48 00 18 7d bl ffc0a1f0 <pthread_self>
ffc08978: 38 81 00 2c addi r4,r1,44
ffc0897c: 38 a1 00 08 addi r5,r1,8
ffc08980: 48 00 14 71 bl ffc09df0 <pthread_getschedparam>
param.sched_priority = req->priority;
ffc08984: 81 3d 00 0c lwz r9,12(r29)
ffc08988: 91 21 00 08 stw r9,8(r1)
pthread_setschedparam (pthread_self(), req->policy, ¶m);
ffc0898c: 48 00 18 65 bl ffc0a1f0 <pthread_self>
ffc08990: 38 a1 00 08 addi r5,r1,8
ffc08994: 80 9d 00 08 lwz r4,8(r29)
ffc08998: 48 00 18 69 bl ffc0a200 <pthread_setschedparam>
ffc0899c: 7f a3 eb 78 mr r3,r29
ffc089a0: 48 00 2a 9d bl ffc0b43c <_Chain_Extract>
rtems_chain_extract (node);
pthread_mutex_unlock (&r_chain->mutex);
ffc089a4: 7f 83 e3 78 mr r3,r28
ffc089a8: 48 00 10 15 bl ffc099bc <pthread_mutex_unlock>
switch (req->aiocbp->aio_lio_opcode) {
ffc089ac: 81 3d 00 14 lwz r9,20(r29)
ffc089b0: 81 49 00 30 lwz r10,48(r9)
ffc089b4: 2f 8a 00 02 cmpwi cr7,r10,2
ffc089b8: 41 9e 00 30 beq- cr7,ffc089e8 <rtems_aio_handle+0xc8>
ffc089bc: 2f 8a 00 03 cmpwi cr7,r10,3
ffc089c0: 41 9e 00 44 beq- cr7,ffc08a04 <rtems_aio_handle+0xe4> <== NEVER TAKEN
ffc089c4: 2f 8a 00 01 cmpwi cr7,r10,1
ffc089c8: 40 be 00 4c bne+ cr7,ffc08a14 <rtems_aio_handle+0xf4> <== NEVER TAKEN
case LIO_READ:
AIO_printf ("read\n");
result = pread (req->aiocbp->aio_fildes,
ffc089cc: 80 69 00 00 lwz r3,0(r9)
ffc089d0: 80 89 00 10 lwz r4,16(r9)
ffc089d4: 80 a9 00 14 lwz r5,20(r9)
ffc089d8: 80 e9 00 08 lwz r7,8(r9)
ffc089dc: 81 09 00 0c lwz r8,12(r9)
ffc089e0: 48 00 ac 6d bl ffc1364c <pread>
(void *) req->aiocbp->aio_buf,
req->aiocbp->aio_nbytes, req->aiocbp->aio_offset);
break;
ffc089e4: 48 00 00 28 b ffc08a0c <rtems_aio_handle+0xec>
case LIO_WRITE:
AIO_printf ("write\n");
result = pwrite (req->aiocbp->aio_fildes,
ffc089e8: 80 69 00 00 lwz r3,0(r9)
ffc089ec: 80 89 00 10 lwz r4,16(r9)
ffc089f0: 80 a9 00 14 lwz r5,20(r9)
ffc089f4: 80 e9 00 08 lwz r7,8(r9)
ffc089f8: 81 09 00 0c lwz r8,12(r9)
ffc089fc: 48 00 ad 8d bl ffc13788 <pwrite>
(void *) req->aiocbp->aio_buf,
req->aiocbp->aio_nbytes, req->aiocbp->aio_offset);
break;
ffc08a00: 48 00 00 0c b ffc08a0c <rtems_aio_handle+0xec>
case LIO_SYNC:
AIO_printf ("sync\n");
result = fsync (req->aiocbp->aio_fildes);
ffc08a04: 80 69 00 00 lwz r3,0(r9) <== NOT EXECUTED
ffc08a08: 48 00 6a 09 bl ffc0f410 <fsync> <== NOT EXECUTED
break;
default:
result = -1;
}
if (result == -1) {
ffc08a0c: 2f 83 ff ff cmpwi cr7,r3,-1
ffc08a10: 40 be 00 1c bne+ cr7,ffc08a2c <rtems_aio_handle+0x10c> <== ALWAYS TAKEN
req->aiocbp->return_value = -1;
ffc08a14: 83 bd 00 14 lwz r29,20(r29) <== NOT EXECUTED
ffc08a18: 92 fd 00 38 stw r23,56(r29) <== NOT EXECUTED
req->aiocbp->error_code = errno;
ffc08a1c: 48 00 9d 15 bl ffc12730 <__errno> <== NOT EXECUTED
ffc08a20: 81 23 00 00 lwz r9,0(r3) <== NOT EXECUTED
ffc08a24: 91 3d 00 34 stw r9,52(r29) <== NOT EXECUTED
ffc08a28: 4b ff ff 28 b ffc08950 <rtems_aio_handle+0x30> <== NOT EXECUTED
} else {
req->aiocbp->return_value = result;
ffc08a2c: 81 3d 00 14 lwz r9,20(r29)
ffc08a30: 90 69 00 38 stw r3,56(r9)
req->aiocbp->error_code = 0;
ffc08a34: 92 c9 00 34 stw r22,52(r9)
ffc08a38: 4b ff ff 18 b ffc08950 <rtems_aio_handle+0x30>
struct timespec timeout;
AIO_printf ("Chain is empty [WQ], wait for work\n");
pthread_mutex_unlock (&r_chain->mutex);
ffc08a3c: 7f 83 e3 78 mr r3,r28
ffc08a40: 48 00 0f 7d bl ffc099bc <pthread_mutex_unlock>
pthread_mutex_lock (&aio_request_queue.mutex);
ffc08a44: 7f e3 fb 78 mr r3,r31
ffc08a48: 48 00 0e e9 bl ffc09930 <pthread_mutex_lock>
if (rtems_chain_is_empty (chain))
ffc08a4c: 81 3e 00 08 lwz r9,8(r30)
ffc08a50: 7f 89 e8 00 cmpw cr7,r9,r29
ffc08a54: 40 be 01 20 bne+ cr7,ffc08b74 <rtems_aio_handle+0x254> <== NEVER TAKEN
{
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08a58: 38 81 00 24 addi r4,r1,36
ffc08a5c: 38 60 00 01 li r3,1
ffc08a60: 48 00 07 75 bl ffc091d4 <clock_gettime>
timeout.tv_sec += 3;
ffc08a64: 81 21 00 24 lwz r9,36(r1)
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a68: 3b be 00 20 addi r29,r30,32
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
ffc08a6c: 93 61 00 28 stw r27,40(r1)
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08a70: 39 29 00 03 addi r9,r9,3
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a74: 7f a3 eb 78 mr r3,r29
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08a78: 91 21 00 24 stw r9,36(r1)
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a7c: 7f e4 fb 78 mr r4,r31
ffc08a80: 38 a1 00 24 addi r5,r1,36
ffc08a84: 48 00 0a 51 bl ffc094d4 <pthread_cond_timedwait>
&aio_request_queue.mutex,
&timeout);
/* If no requests were added to the chain we delete the fd chain from
the queue and start working with idle fd chains */
if (result == ETIMEDOUT) {
ffc08a88: 2f 83 00 74 cmpwi cr7,r3,116
ffc08a8c: 40 be 00 e8 bne+ cr7,ffc08b74 <rtems_aio_handle+0x254> <== NEVER TAKEN
ffc08a90: 7f c3 f3 78 mr r3,r30
ffc08a94: 48 00 29 a9 bl ffc0b43c <_Chain_Extract>
rtems_chain_extract (&r_chain->next_fd);
pthread_mutex_destroy (&r_chain->mutex);
ffc08a98: 7f 83 e3 78 mr r3,r28
ffc08a9c: 48 00 0b b5 bl ffc09650 <pthread_mutex_destroy>
pthread_cond_destroy (&r_chain->cond);
ffc08aa0: 7f a3 eb 78 mr r3,r29
ffc08aa4: 48 00 07 f5 bl ffc09298 <pthread_cond_destroy>
free (r_chain);
ffc08aa8: 7f c3 f3 78 mr r3,r30
ffc08aac: 4b ff bd fd bl ffc048a8 <free>
/* If the idle chain is empty sleep for 3 seconds and wait for a
signal. The thread now becomes idle. */
if (rtems_chain_is_empty (&aio_request_queue.idle_req)) {
ffc08ab0: 81 3f 00 54 lwz r9,84(r31)
ffc08ab4: 7f 89 d0 00 cmpw cr7,r9,r26
ffc08ab8: 40 be 00 68 bne+ cr7,ffc08b20 <rtems_aio_handle+0x200>
AIO_printf ("Chain is empty [IQ], wait for work\n");
++aio_request_queue.idle_threads;
ffc08abc: 81 3f 00 68 lwz r9,104(r31)
--aio_request_queue.active_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08ac0: 38 81 00 24 addi r4,r1,36
ffc08ac4: 38 60 00 01 li r3,1
/* If the idle chain is empty sleep for 3 seconds and wait for a
signal. The thread now becomes idle. */
if (rtems_chain_is_empty (&aio_request_queue.idle_req)) {
AIO_printf ("Chain is empty [IQ], wait for work\n");
++aio_request_queue.idle_threads;
ffc08ac8: 39 29 00 01 addi r9,r9,1
ffc08acc: 91 3f 00 68 stw r9,104(r31)
--aio_request_queue.active_threads;
ffc08ad0: 81 3f 00 64 lwz r9,100(r31)
ffc08ad4: 39 29 ff ff addi r9,r9,-1
ffc08ad8: 91 3f 00 64 stw r9,100(r31)
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08adc: 48 00 06 f9 bl ffc091d4 <clock_gettime>
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08ae0: 7f 03 c3 78 mr r3,r24
AIO_printf ("Chain is empty [IQ], wait for work\n");
++aio_request_queue.idle_threads;
--aio_request_queue.active_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08ae4: 81 21 00 24 lwz r9,36(r1)
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08ae8: 7f e4 fb 78 mr r4,r31
ffc08aec: 38 a1 00 24 addi r5,r1,36
++aio_request_queue.idle_threads;
--aio_request_queue.active_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
ffc08af0: 93 61 00 28 stw r27,40(r1)
AIO_printf ("Chain is empty [IQ], wait for work\n");
++aio_request_queue.idle_threads;
--aio_request_queue.active_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08af4: 39 29 00 03 addi r9,r9,3
ffc08af8: 91 21 00 24 stw r9,36(r1)
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08afc: 48 00 09 d9 bl ffc094d4 <pthread_cond_timedwait>
&aio_request_queue.mutex,
&timeout);
/* If no new fd chain was added in the idle requests
then this thread is finished */
if (result == ETIMEDOUT) {
ffc08b00: 2f 83 00 74 cmpwi cr7,r3,116
ffc08b04: 40 be 00 1c bne+ cr7,ffc08b20 <rtems_aio_handle+0x200> <== NEVER TAKEN
AIO_printf ("Etimeout\n");
--aio_request_queue.idle_threads;
ffc08b08: 81 3f 00 68 lwz r9,104(r31)
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08b0c: 7f e3 fb 78 mr r3,r31
/* If no new fd chain was added in the idle requests
then this thread is finished */
if (result == ETIMEDOUT) {
AIO_printf ("Etimeout\n");
--aio_request_queue.idle_threads;
ffc08b10: 39 29 ff ff addi r9,r9,-1
ffc08b14: 91 3f 00 68 stw r9,104(r31)
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08b18: 48 00 0e a5 bl ffc099bc <pthread_mutex_unlock>
ffc08b1c: 48 00 00 64 b ffc08b80 <rtems_aio_handle+0x260>
}
}
/* Otherwise move this chain to the working chain and
start the loop all over again */
AIO_printf ("Work on idle\n");
--aio_request_queue.idle_threads;
ffc08b20: 81 3f 00 68 lwz r9,104(r31)
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First(
Chain_Control *the_chain
)
{
return _Chain_Head( the_chain )->next;
ffc08b24: 83 df 00 54 lwz r30,84(r31)
ffc08b28: 39 29 ff ff addi r9,r9,-1
ffc08b2c: 91 3f 00 68 stw r9,104(r31)
ffc08b30: 7f c3 f3 78 mr r3,r30
++aio_request_queue.active_threads;
ffc08b34: 81 3f 00 64 lwz r9,100(r31)
ffc08b38: 39 29 00 01 addi r9,r9,1
ffc08b3c: 91 3f 00 64 stw r9,100(r31)
ffc08b40: 48 00 28 fd bl ffc0b43c <_Chain_Extract>
ffc08b44: 81 3f 00 48 lwz r9,72(r31)
rtems_chain_node *node;
node = rtems_chain_first (&aio_request_queue.work_req);
temp = (rtems_aio_request_chain *) node;
while (temp->fildes < r_chain->fildes &&
ffc08b48: 81 1e 00 14 lwz r8,20(r30)
ffc08b4c: 48 00 00 08 b ffc08b54 <rtems_aio_handle+0x234>
}
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08b50: 81 29 00 00 lwz r9,0(r9)
rtems_chain_node *node;
node = rtems_chain_first (&aio_request_queue.work_req);
temp = (rtems_aio_request_chain *) node;
while (temp->fildes < r_chain->fildes &&
ffc08b54: 81 49 00 14 lwz r10,20(r9)
ffc08b58: 7f 8a 40 00 cmpw cr7,r10,r8
ffc08b5c: 40 9c 00 0c bge- cr7,ffc08b68 <rtems_aio_handle+0x248>
ffc08b60: 7f 89 c8 00 cmpw cr7,r9,r25
ffc08b64: 40 9e ff ec bne+ cr7,ffc08b50 <rtems_aio_handle+0x230> <== ALWAYS TAKEN
RTEMS_INLINE_ROUTINE void rtems_chain_insert(
rtems_chain_node *after_node,
rtems_chain_node *the_node
)
{
_Chain_Insert( after_node, the_node );
ffc08b68: 80 69 00 04 lwz r3,4(r9)
ffc08b6c: 7f c4 f3 78 mr r4,r30
ffc08b70: 48 00 29 35 bl ffc0b4a4 <_Chain_Insert>
}
}
/* If there was a request added in the initial fd chain then release
the mutex and process it */
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08b74: 7f e3 fb 78 mr r3,r31
ffc08b78: 48 00 0e 45 bl ffc099bc <pthread_mutex_unlock>
ffc08b7c: 4b ff fd d4 b ffc08950 <rtems_aio_handle+0x30>
}
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08b80: 39 61 00 60 addi r11,r1,96
ffc08b84: 38 60 00 00 li r3,0
ffc08b88: 4b ff 7f dc b ffc00b64 <_restgpr_22_x>
ffc08be4 <rtems_aio_init>:
* 0 - if initialization succeeded
*/
int
rtems_aio_init (void)
{
ffc08be4: 94 21 ff f0 stwu r1,-16(r1)
ffc08be8: 7c 08 02 a6 mflr r0
ffc08bec: bf c1 00 08 stmw r30,8(r1)
int result = 0;
result = pthread_attr_init (&aio_request_queue.attr);
ffc08bf0: 3f e0 00 00 lis r31,0
ffc08bf4: 3b ff 2b b8 addi r31,r31,11192
ffc08bf8: 7f e3 fb 78 mr r3,r31
* 0 - if initialization succeeded
*/
int
rtems_aio_init (void)
{
ffc08bfc: 90 01 00 14 stw r0,20(r1)
int result = 0;
result = pthread_attr_init (&aio_request_queue.attr);
ffc08c00: 48 00 0f 45 bl ffc09b44 <pthread_attr_init>
if (result != 0)
ffc08c04: 7c 7e 1b 79 mr. r30,r3
ffc08c08: 40 a2 00 b4 bne+ ffc08cbc <rtems_aio_init+0xd8> <== NEVER TAKEN
return result;
result =
ffc08c0c: 7f e3 fb 78 mr r3,r31
ffc08c10: 38 80 00 00 li r4,0
ffc08c14: 48 00 0f 75 bl ffc09b88 <pthread_attr_setdetachstate>
pthread_attr_setdetachstate (&aio_request_queue.attr,
PTHREAD_CREATE_DETACHED);
if (result != 0)
ffc08c18: 2f 83 00 00 cmpwi cr7,r3,0
ffc08c1c: 41 be 00 0c beq+ cr7,ffc08c28 <rtems_aio_init+0x44> <== ALWAYS TAKEN
pthread_attr_destroy (&aio_request_queue.attr);
ffc08c20: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08c24: 48 00 0e f1 bl ffc09b14 <pthread_attr_destroy> <== NOT EXECUTED
result = pthread_mutex_init (&aio_request_queue.mutex, NULL);
ffc08c28: 3f e0 00 00 lis r31,0
ffc08c2c: 3b ff 2b b0 addi r31,r31,11184
ffc08c30: 7f e3 fb 78 mr r3,r31
ffc08c34: 38 80 00 00 li r4,0
ffc08c38: 48 00 0b 99 bl ffc097d0 <pthread_mutex_init>
if (result != 0)
ffc08c3c: 2f 83 00 00 cmpwi cr7,r3,0
ffc08c40: 41 be 00 0c beq+ cr7,ffc08c4c <rtems_aio_init+0x68> <== ALWAYS TAKEN
pthread_attr_destroy (&aio_request_queue.attr);
ffc08c44: 38 7f 00 08 addi r3,r31,8 <== NOT EXECUTED
ffc08c48: 48 00 0e cd bl ffc09b14 <pthread_attr_destroy> <== NOT EXECUTED
result = pthread_cond_init (&aio_request_queue.new_req, NULL);
ffc08c4c: 3f e0 00 00 lis r31,0
ffc08c50: 3b ff 2b b4 addi r31,r31,11188
ffc08c54: 7f e3 fb 78 mr r3,r31
ffc08c58: 38 80 00 00 li r4,0
ffc08c5c: 48 00 07 31 bl ffc0938c <pthread_cond_init>
if (result != 0) {
ffc08c60: 7c 7e 1b 79 mr. r30,r3
ffc08c64: 41 a2 00 14 beq+ ffc08c78 <rtems_aio_init+0x94> <== ALWAYS TAKEN
pthread_mutex_destroy (&aio_request_queue.mutex);
ffc08c68: 38 7f ff fc addi r3,r31,-4 <== NOT EXECUTED
ffc08c6c: 48 00 09 e5 bl ffc09650 <pthread_mutex_destroy> <== NOT EXECUTED
pthread_attr_destroy (&aio_request_queue.attr);
ffc08c70: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED
ffc08c74: 48 00 0e a1 bl ffc09b14 <pthread_attr_destroy> <== NOT EXECUTED
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc08c78: 3d 20 00 00 lis r9,0
ffc08c7c: 39 29 2b b0 addi r9,r9,11184
ffc08c80: 39 49 00 4c addi r10,r9,76
head->previous = NULL;
tail->previous = head;
ffc08c84: 39 09 00 48 addi r8,r9,72
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc08c88: 91 49 00 48 stw r10,72(r9)
head->previous = NULL;
ffc08c8c: 39 40 00 00 li r10,0
tail->previous = head;
ffc08c90: 91 09 00 50 stw r8,80(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc08c94: 39 09 00 58 addi r8,r9,88
head->previous = NULL;
ffc08c98: 91 49 00 4c stw r10,76(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc08c9c: 91 09 00 54 stw r8,84(r9)
head->previous = NULL;
tail->previous = head;
ffc08ca0: 39 09 00 54 addi r8,r9,84
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
head->previous = NULL;
ffc08ca4: 91 49 00 58 stw r10,88(r9)
}
rtems_chain_initialize_empty (&aio_request_queue.work_req);
rtems_chain_initialize_empty (&aio_request_queue.idle_req);
aio_request_queue.active_threads = 0;
ffc08ca8: 91 49 00 64 stw r10,100(r9)
aio_request_queue.idle_threads = 0;
ffc08cac: 91 49 00 68 stw r10,104(r9)
aio_request_queue.initialized = AIO_QUEUE_INITIALIZED;
ffc08cb0: 61 4a b0 0b ori r10,r10,45067
tail->previous = head;
ffc08cb4: 91 09 00 5c stw r8,92(r9)
ffc08cb8: 91 49 00 60 stw r10,96(r9)
return result;
}
ffc08cbc: 39 61 00 10 addi r11,r1,16
ffc08cc0: 7f c3 f3 78 mr r3,r30
ffc08cc4: 4b ff 7e c0 b ffc00b84 <_restgpr_30_x>
ffc08b8c <rtems_aio_insert_prio>:
ffc08b8c: 81 23 00 00 lwz r9,0(r3)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc08b90: 39 03 00 04 addi r8,r3,4
* NONE
*/
static void
rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req)
{
ffc08b94: 7c 8a 23 78 mr r10,r4
rtems_chain_node *node;
AIO_printf ("FD exists \n");
node = rtems_chain_first (chain);
if (rtems_chain_is_empty (chain)) {
ffc08b98: 7f 89 40 00 cmpw cr7,r9,r8
ffc08b9c: 40 be 00 08 bne+ cr7,ffc08ba4 <rtems_aio_insert_prio+0x18><== ALWAYS TAKEN
ffc08ba0: 48 00 00 34 b ffc08bd4 <rtems_aio_insert_prio+0x48> <== NOT EXECUTED
AIO_printf ("First in chain \n");
rtems_chain_prepend (chain, &req->next_prio);
} else {
AIO_printf ("Add by priority \n");
int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio;
ffc08ba4: 80 e9 00 14 lwz r7,20(r9)
while (req->aiocbp->aio_reqprio > prio &&
ffc08ba8: 80 c4 00 14 lwz r6,20(r4)
if (rtems_chain_is_empty (chain)) {
AIO_printf ("First in chain \n");
rtems_chain_prepend (chain, &req->next_prio);
} else {
AIO_printf ("Add by priority \n");
int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio;
ffc08bac: 80 e7 00 18 lwz r7,24(r7)
while (req->aiocbp->aio_reqprio > prio &&
ffc08bb0: 80 c6 00 18 lwz r6,24(r6)
ffc08bb4: 48 00 00 10 b ffc08bc4 <rtems_aio_insert_prio+0x38>
}
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08bb8: 81 29 00 00 lwz r9,0(r9) <== NOT EXECUTED
int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio;
while (req->aiocbp->aio_reqprio > prio &&
!rtems_chain_is_tail (chain, node)) {
node = rtems_chain_next (node);
prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio;
ffc08bbc: 80 e9 00 14 lwz r7,20(r9) <== NOT EXECUTED
ffc08bc0: 80 e7 00 18 lwz r7,24(r7) <== NOT EXECUTED
rtems_chain_prepend (chain, &req->next_prio);
} else {
AIO_printf ("Add by priority \n");
int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio;
while (req->aiocbp->aio_reqprio > prio &&
ffc08bc4: 7f 86 38 00 cmpw cr7,r6,r7
ffc08bc8: 41 bd 00 10 bgt+ cr7,ffc08bd8 <rtems_aio_insert_prio+0x4c><== NEVER TAKEN
ffc08bcc: 80 69 00 04 lwz r3,4(r9)
ffc08bd0: 7d 44 53 78 mr r4,r10
ffc08bd4: 48 00 28 d0 b ffc0b4a4 <_Chain_Insert>
ffc08bd8: 7f 89 40 00 cmpw cr7,r9,r8 <== NOT EXECUTED
ffc08bdc: 40 9e ff dc bne+ cr7,ffc08bb8 <rtems_aio_insert_prio+0x2c><== NOT EXECUTED
ffc08be0: 4b ff ff ec b ffc08bcc <rtems_aio_insert_prio+0x40> <== NOT EXECUTED
ffc08de0 <rtems_aio_remove_req>:
* AIO_NOTCANCELED - if request was not canceled
* AIO_CANCELED - if request was canceled
*/
int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp)
{
ffc08de0: 7c 2b 0b 78 mr r11,r1
ffc08de4: 7c 08 02 a6 mflr r0
ffc08de8: 94 21 ff f0 stwu r1,-16(r1)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc08dec: 39 23 00 04 addi r9,r3,4
ffc08df0: 90 01 00 14 stw r0,20(r1)
ffc08df4: 4b ff 7d 49 bl ffc00b3c <_savegpr_31>
*/
RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_head( the_chain )->next;
ffc08df8: 83 e3 00 00 lwz r31,0(r3)
if (rtems_chain_is_empty (chain))
ffc08dfc: 7f 9f 48 00 cmpw cr7,r31,r9
ffc08e00: 40 be 00 1c bne+ cr7,ffc08e1c <rtems_aio_remove_req+0x3c>
ffc08e04: 48 00 00 5c b ffc08e60 <rtems_aio_remove_req+0x80>
}
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08e08: 83 ff 00 00 lwz r31,0(r31) <== NOT EXECUTED
rtems_chain_node *node = rtems_chain_first (chain);
rtems_aio_request *current;
current = (rtems_aio_request *) node;
while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) {
ffc08e0c: 7f 9f 48 00 cmpw cr7,r31,r9 <== NOT EXECUTED
ffc08e10: 40 be 00 0c bne+ cr7,ffc08e1c <rtems_aio_remove_req+0x3c><== NOT EXECUTED
node = rtems_chain_next (node);
current = (rtems_aio_request *) node;
}
if (rtems_chain_is_tail (chain, node))
return AIO_NOTCANCELED;
ffc08e14: 38 60 00 01 li r3,1 <== NOT EXECUTED
ffc08e18: 48 00 00 4c b ffc08e64 <rtems_aio_remove_req+0x84> <== NOT EXECUTED
rtems_chain_node *node = rtems_chain_first (chain);
rtems_aio_request *current;
current = (rtems_aio_request *) node;
while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) {
ffc08e1c: 81 5f 00 14 lwz r10,20(r31)
ffc08e20: 7f 8a 20 00 cmpw cr7,r10,r4
ffc08e24: 40 9e ff e4 bne+ cr7,ffc08e08 <rtems_aio_remove_req+0x28><== NEVER TAKEN
node = rtems_chain_next (node);
current = (rtems_aio_request *) node;
}
if (rtems_chain_is_tail (chain, node))
ffc08e28: 7f 9f 48 00 cmpw cr7,r31,r9
return AIO_NOTCANCELED;
ffc08e2c: 38 60 00 01 li r3,1
while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) {
node = rtems_chain_next (node);
current = (rtems_aio_request *) node;
}
if (rtems_chain_is_tail (chain, node))
ffc08e30: 41 9e 00 34 beq- cr7,ffc08e64 <rtems_aio_remove_req+0x84><== NEVER TAKEN
ffc08e34: 7f e3 fb 78 mr r3,r31
ffc08e38: 48 00 26 05 bl ffc0b43c <_Chain_Extract>
return AIO_NOTCANCELED;
else
{
rtems_chain_extract (node);
current->aiocbp->error_code = ECANCELED;
ffc08e3c: 81 3f 00 14 lwz r9,20(r31)
ffc08e40: 39 40 00 8c li r10,140
ffc08e44: 91 49 00 34 stw r10,52(r9)
current->aiocbp->return_value = -1;
ffc08e48: 39 40 ff ff li r10,-1
free (current);
ffc08e4c: 7f e3 fb 78 mr r3,r31
return AIO_NOTCANCELED;
else
{
rtems_chain_extract (node);
current->aiocbp->error_code = ECANCELED;
current->aiocbp->return_value = -1;
ffc08e50: 91 49 00 38 stw r10,56(r9)
free (current);
ffc08e54: 4b ff ba 55 bl ffc048a8 <free>
}
return AIO_CANCELED;
ffc08e58: 38 60 00 00 li r3,0
ffc08e5c: 48 00 00 08 b ffc08e64 <rtems_aio_remove_req+0x84>
*/
int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp)
{
if (rtems_chain_is_empty (chain))
return AIO_ALLDONE;
ffc08e60: 38 60 00 02 li r3,2
current->aiocbp->return_value = -1;
free (current);
}
return AIO_CANCELED;
}
ffc08e64: 39 61 00 10 addi r11,r1,16
ffc08e68: 4b ff 7d 20 b ffc00b88 <_restgpr_31_x>
ffc091e0 <rtems_chain_get_with_wait>:
rtems_chain_control *chain,
rtems_event_set events,
rtems_interval timeout,
rtems_chain_node **node_ptr
)
{
ffc091e0: 94 21 ff d0 stwu r1,-48(r1)
ffc091e4: 7c 08 02 a6 mflr r0
ffc091e8: bf 61 00 1c stmw r27,28(r1)
ffc091ec: 7c 7e 1b 78 mr r30,r3
ffc091f0: 7c 9d 23 78 mr r29,r4
ffc091f4: 90 01 00 34 stw r0,52(r1)
ffc091f8: 7c bc 2b 78 mr r28,r5
ffc091fc: 7c df 33 78 mr r31,r6
ffc09200: 48 00 00 20 b ffc09220 <rtems_chain_get_with_wait+0x40>
while (
sc == RTEMS_SUCCESSFUL
&& (node = rtems_chain_get( chain )) == NULL
) {
rtems_event_set out;
sc = rtems_event_receive(
ffc09204: 7f a3 eb 78 mr r3,r29
ffc09208: 38 80 00 00 li r4,0
ffc0920c: 7f 85 e3 78 mr r5,r28
ffc09210: 38 c1 00 08 addi r6,r1,8
ffc09214: 4b ff f3 2d bl ffc08540 <rtems_event_receive>
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
rtems_chain_node *node = NULL;
while (
ffc09218: 2c 03 00 00 cmpwi r3,0
ffc0921c: 40 82 00 18 bne- ffc09234 <rtems_chain_get_with_wait+0x54><== ALWAYS TAKEN
*/
RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get(
rtems_chain_control *the_chain
)
{
return _Chain_Get( the_chain );
ffc09220: 7f c3 f3 78 mr r3,r30
ffc09224: 48 00 06 15 bl ffc09838 <_Chain_Get>
sc == RTEMS_SUCCESSFUL
&& (node = rtems_chain_get( chain )) == NULL
ffc09228: 7c 7b 1b 79 mr. r27,r3
ffc0922c: 41 82 ff d8 beq+ ffc09204 <rtems_chain_get_with_wait+0x24>
ffc09230: 38 60 00 00 li r3,0
timeout,
&out
);
}
*node_ptr = node;
ffc09234: 93 7f 00 00 stw r27,0(r31)
return sc;
}
ffc09238: 39 61 00 30 addi r11,r1,48
ffc0923c: 48 00 c4 8c b ffc156c8 <_restgpr_27_x>
ffc1208c <rtems_event_system_receive>:
rtems_event_set *event_out
)
{
rtems_status_code sc;
if ( event_out != NULL ) {
ffc1208c: 7c c9 33 79 mr. r9,r6
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
ffc12090: 7c 08 02 a6 mflr r0
ffc12094: 7c 2b 0b 78 mr r11,r1
ffc12098: 94 21 ff f0 stwu r1,-16(r1)
ffc1209c: 90 01 00 14 stw r0,20(r1)
ffc120a0: 48 00 76 65 bl ffc19704 <_savegpr_31>
rtems_status_code sc;
if ( event_out != NULL ) {
ffc120a4: 41 82 00 5c beq- ffc12100 <rtems_event_system_receive+0x74><== NEVER TAKEN
Thread_Control *executing = _Thread_Executing;
RTEMS_API_Control *api = executing->API_Extensions[ THREAD_API_RTEMS ];
Event_Control *event = &api->System_event;
if ( !_Event_sets_Is_empty( event_in ) ) {
ffc120a8: 2f 83 00 00 cmpwi cr7,r3,0
)
{
rtems_status_code sc;
if ( event_out != NULL ) {
Thread_Control *executing = _Thread_Executing;
ffc120ac: 3d 00 00 00 lis r8,0
ffc120b0: 83 e8 32 10 lwz r31,12816(r8)
RTEMS_API_Control *api = executing->API_Extensions[ THREAD_API_RTEMS ];
ffc120b4: 81 1f 01 4c lwz r8,332(r31)
Event_Control *event = &api->System_event;
if ( !_Event_sets_Is_empty( event_in ) ) {
ffc120b8: 41 be 00 38 beq+ cr7,ffc120f0 <rtems_event_system_receive+0x64><== NEVER TAKEN
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc120bc: 3d 20 00 00 lis r9,0
ffc120c0: 81 49 28 20 lwz r10,10272(r9)
++level;
ffc120c4: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc120c8: 91 49 28 20 stw r10,10272(r9)
_Thread_Disable_dispatch();
_Event_Seize(
ffc120cc: 3d 20 00 00 lis r9,0
ffc120d0: 7f e7 fb 78 mr r7,r31
ffc120d4: 39 08 00 04 addi r8,r8,4
ffc120d8: 39 29 28 54 addi r9,r9,10324
ffc120dc: 3d 40 00 04 lis r10,4
ffc120e0: 4b ff 72 e9 bl ffc093c8 <_Event_Seize>
executing,
event,
&_System_event_Sync_state,
STATES_WAITING_FOR_SYSTEM_EVENT
);
_Thread_Enable_dispatch();
ffc120e4: 4b ff a3 09 bl ffc0c3ec <_Thread_Enable_dispatch>
sc = executing->Wait.return_code;
ffc120e8: 80 7f 00 34 lwz r3,52(r31)
ffc120ec: 48 00 00 18 b ffc12104 <rtems_event_system_receive+0x78>
} else {
*event_out = event->pending_events;
ffc120f0: 81 48 00 04 lwz r10,4(r8) <== NOT EXECUTED
sc = RTEMS_SUCCESSFUL;
ffc120f4: 38 60 00 00 li r3,0 <== NOT EXECUTED
);
_Thread_Enable_dispatch();
sc = executing->Wait.return_code;
} else {
*event_out = event->pending_events;
ffc120f8: 91 49 00 00 stw r10,0(r9) <== NOT EXECUTED
ffc120fc: 48 00 00 08 b ffc12104 <rtems_event_system_receive+0x78><== NOT EXECUTED
sc = RTEMS_SUCCESSFUL;
}
} else {
sc = RTEMS_INVALID_ADDRESS;
ffc12100: 38 60 00 09 li r3,9 <== NOT EXECUTED
}
return sc;
}
ffc12104: 39 61 00 10 addi r11,r1,16
ffc12108: 48 00 76 48 b ffc19750 <_restgpr_31_x>
ffc08a88 <rtems_event_system_send>:
rtems_status_code rtems_event_system_send(
rtems_id id,
rtems_event_set event_in
)
{
ffc08a88: 7c 2b 0b 78 mr r11,r1
ffc08a8c: 94 21 ff e0 stwu r1,-32(r1)
ffc08a90: 7c 08 02 a6 mflr r0
ffc08a94: 48 01 23 29 bl ffc1adbc <_savegpr_31>
ffc08a98: 7c 9f 23 78 mr r31,r4
rtems_status_code sc;
Thread_Control *thread;
Objects_Locations location;
RTEMS_API_Control *api;
thread = _Thread_Get( id, &location );
ffc08a9c: 38 81 00 08 addi r4,r1,8
rtems_status_code rtems_event_system_send(
rtems_id id,
rtems_event_set event_in
)
{
ffc08aa0: 90 01 00 24 stw r0,36(r1)
rtems_status_code sc;
Thread_Control *thread;
Objects_Locations location;
RTEMS_API_Control *api;
thread = _Thread_Get( id, &location );
ffc08aa4: 48 00 27 a1 bl ffc0b244 <_Thread_Get>
switch ( location ) {
ffc08aa8: 81 21 00 08 lwz r9,8(r1)
ffc08aac: 2f 89 00 00 cmpwi cr7,r9,0
ffc08ab0: 40 9e 00 2c bne- cr7,ffc08adc <rtems_event_system_send+0x54><== NEVER TAKEN
case OBJECTS_LOCAL:
api = thread->API_Extensions[ THREAD_API_RTEMS ];
_Event_Surrender(
ffc08ab4: 80 a3 01 4c lwz r5,332(r3)
ffc08ab8: 3c c0 00 00 lis r6,0
ffc08abc: 7f e4 fb 78 mr r4,r31
ffc08ac0: 38 a5 00 04 addi r5,r5,4
ffc08ac4: 38 c6 28 9c addi r6,r6,10396
ffc08ac8: 3c e0 00 04 lis r7,4
ffc08acc: 4b ff f9 89 bl ffc08454 <_Event_Surrender>
event_in,
&api->System_event,
&_System_event_Sync_state,
STATES_WAITING_FOR_SYSTEM_EVENT
);
_Thread_Enable_dispatch();
ffc08ad0: 48 00 27 59 bl ffc0b228 <_Thread_Enable_dispatch>
sc = RTEMS_SUCCESSFUL;
ffc08ad4: 38 60 00 00 li r3,0
break;
ffc08ad8: 48 00 00 08 b ffc08ae0 <rtems_event_system_send+0x58>
case OBJECTS_REMOTE:
sc = RTEMS_ILLEGAL_ON_REMOTE_OBJECT;
break;
#endif
default:
sc = RTEMS_INVALID_ID;
ffc08adc: 38 60 00 04 li r3,4 <== NOT EXECUTED
break;
}
return sc;
}
ffc08ae0: 39 61 00 20 addi r11,r1,32
ffc08ae4: 4b ff 7a e0 b ffc005c4 <_restgpr_31_x>
ffc0b5e0 <rtems_iterate_over_all_threads>:
#include <rtems/system.h>
#include <rtems/score/thread.h>
void rtems_iterate_over_all_threads(rtems_per_thread_routine routine)
{
ffc0b5e0: 94 21 ff e0 stwu r1,-32(r1)
ffc0b5e4: 7c 08 02 a6 mflr r0
ffc0b5e8: bf 61 00 0c stmw r27,12(r1)
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
ffc0b5ec: 7c 7b 1b 79 mr. r27,r3
#include <rtems/system.h>
#include <rtems/score/thread.h>
void rtems_iterate_over_all_threads(rtems_per_thread_routine routine)
{
ffc0b5f0: 90 01 00 24 stw r0,36(r1)
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
ffc0b5f4: 41 82 00 60 beq- ffc0b654 <rtems_iterate_over_all_threads+0x74><== NEVER TAKEN
ffc0b5f8: 3f e0 00 00 lis r31,0
ffc0b5fc: 3b ff 30 78 addi r31,r31,12408
#endif
#include <rtems/system.h>
#include <rtems/score/thread.h>
void rtems_iterate_over_all_threads(rtems_per_thread_routine routine)
ffc0b600: 3b 9f 00 0c addi r28,r31,12
#if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG)
if ( !_Objects_Information_table[ api_index ] )
continue;
#endif
information = _Objects_Information_table[ api_index ][ 1 ];
ffc0b604: 85 3f 00 04 lwzu r9,4(r31)
if ( !information )
ffc0b608: 3b c0 00 01 li r30,1
#if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG)
if ( !_Objects_Information_table[ api_index ] )
continue;
#endif
information = _Objects_Information_table[ api_index ][ 1 ];
ffc0b60c: 83 a9 00 04 lwz r29,4(r9)
if ( !information )
ffc0b610: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b614: 40 be 00 30 bne+ cr7,ffc0b644 <rtems_iterate_over_all_threads+0x64>
Objects_Information *information;
if ( !routine )
return;
for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) {
ffc0b618: 7f 9f e0 00 cmpw cr7,r31,r28
ffc0b61c: 40 9e ff e8 bne+ cr7,ffc0b604 <rtems_iterate_over_all_threads+0x24>
ffc0b620: 48 00 00 34 b ffc0b654 <rtems_iterate_over_all_threads+0x74>
information = _Objects_Information_table[ api_index ][ 1 ];
if ( !information )
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
the_thread = (Thread_Control *)information->local_table[ i ];
ffc0b624: 81 3d 00 1c lwz r9,28(r29)
ffc0b628: 57 ca 10 3a rlwinm r10,r30,2,0,29
ffc0b62c: 7c 69 50 2e lwzx r3,r9,r10
if ( !the_thread )
ffc0b630: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b634: 41 9e 00 0c beq- cr7,ffc0b640 <rtems_iterate_over_all_threads+0x60>
continue;
(*routine)(the_thread);
ffc0b638: 7f 69 03 a6 mtctr r27
ffc0b63c: 4e 80 04 21 bctrl
information = _Objects_Information_table[ api_index ][ 1 ];
if ( !information )
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
ffc0b640: 3b de 00 01 addi r30,r30,1
ffc0b644: a1 3d 00 10 lhz r9,16(r29)
ffc0b648: 7f 9e 48 40 cmplw cr7,r30,r9
ffc0b64c: 40 9d ff d8 ble+ cr7,ffc0b624 <rtems_iterate_over_all_threads+0x44>
ffc0b650: 4b ff ff c8 b ffc0b618 <rtems_iterate_over_all_threads+0x38>
(*routine)(the_thread);
}
}
}
ffc0b654: 39 61 00 20 addi r11,r1,32
ffc0b658: 4b ff 5c d4 b ffc0132c <_restgpr_27_x>
ffc09d1c <rtems_partition_create>:
uint32_t length,
uint32_t buffer_size,
rtems_attribute attribute_set,
rtems_id *id
)
{
ffc09d1c: 94 21 ff d0 stwu r1,-48(r1)
ffc09d20: 7c 08 02 a6 mflr r0
ffc09d24: bf 21 00 14 stmw r25,20(r1)
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
ffc09d28: 7c 7b 1b 79 mr. r27,r3
uint32_t length,
uint32_t buffer_size,
rtems_attribute attribute_set,
rtems_id *id
)
{
ffc09d2c: 90 01 00 34 stw r0,52(r1)
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
ffc09d30: 41 a2 00 dc beq+ ffc09e0c <rtems_partition_create+0xf0>
return RTEMS_INVALID_NAME;
if ( !starting_address )
ffc09d34: 2f 84 00 00 cmpwi cr7,r4,0
return RTEMS_INVALID_ADDRESS;
ffc09d38: 38 60 00 09 li r3,9
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
return RTEMS_INVALID_NAME;
if ( !starting_address )
ffc09d3c: 41 9e 00 d4 beq- cr7,ffc09e10 <rtems_partition_create+0xf4>
return RTEMS_INVALID_ADDRESS;
if ( !id )
ffc09d40: 2f 88 00 00 cmpwi cr7,r8,0
ffc09d44: 7d 1c 43 78 mr r28,r8
ffc09d48: 41 9e 00 c8 beq- cr7,ffc09e10 <rtems_partition_create+0xf4><== NEVER TAKEN
return RTEMS_INVALID_ADDRESS;
if ( length == 0 || buffer_size == 0 || length < buffer_size ||
ffc09d4c: 2f 85 00 00 cmpwi cr7,r5,0
ffc09d50: 7c be 2b 78 mr r30,r5
!_Partition_Is_buffer_size_aligned( buffer_size ) )
return RTEMS_INVALID_SIZE;
ffc09d54: 38 60 00 08 li r3,8
return RTEMS_INVALID_ADDRESS;
if ( !id )
return RTEMS_INVALID_ADDRESS;
if ( length == 0 || buffer_size == 0 || length < buffer_size ||
ffc09d58: 41 be 00 b8 beq+ cr7,ffc09e10 <rtems_partition_create+0xf4>
ffc09d5c: 2f 86 00 00 cmpwi cr7,r6,0
ffc09d60: 41 be 00 b0 beq+ cr7,ffc09e10 <rtems_partition_create+0xf4>
ffc09d64: 7f 85 30 40 cmplw cr7,r5,r6
ffc09d68: 41 bc 00 a8 blt+ cr7,ffc09e10 <rtems_partition_create+0xf4>
ffc09d6c: 70 c9 00 07 andi. r9,r6,7
ffc09d70: 40 a2 00 a0 bne+ ffc09e10 <rtems_partition_create+0xf4>
!_Partition_Is_buffer_size_aligned( buffer_size ) )
return RTEMS_INVALID_SIZE;
if ( !_Addresses_Is_aligned( starting_address ) )
ffc09d74: 70 99 00 07 andi. r25,r4,7
if ( !rtems_is_name_valid( name ) )
return RTEMS_INVALID_NAME;
if ( !starting_address )
return RTEMS_INVALID_ADDRESS;
ffc09d78: 38 60 00 09 li r3,9
if ( length == 0 || buffer_size == 0 || length < buffer_size ||
!_Partition_Is_buffer_size_aligned( buffer_size ) )
return RTEMS_INVALID_SIZE;
if ( !_Addresses_Is_aligned( starting_address ) )
ffc09d7c: 40 a2 00 94 bne+ ffc09e10 <rtems_partition_create+0xf4>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc09d80: 3d 20 00 00 lis r9,0
ffc09d84: 81 49 28 a8 lwz r10,10408(r9)
ffc09d88: 7c fa 3b 78 mr r26,r7
++level;
ffc09d8c: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc09d90: 91 49 28 a8 stw r10,10408(r9)
* This function allocates a partition control block from
* the inactive chain of free partition control blocks.
*/
RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Allocate ( void )
{
return (Partition_Control *) _Objects_Allocate( &_Partition_Information );
ffc09d94: 3f a0 00 00 lis r29,0
ffc09d98: 90 81 00 08 stw r4,8(r1)
ffc09d9c: 3b bd 54 d8 addi r29,r29,21720
ffc09da0: 7f a3 eb 78 mr r3,r29
ffc09da4: 90 c1 00 0c stw r6,12(r1)
ffc09da8: 48 00 1c e5 bl ffc0ba8c <_Objects_Allocate>
_Thread_Disable_dispatch(); /* prevents deletion */
the_partition = _Partition_Allocate();
if ( !the_partition ) {
ffc09dac: 7c 7f 1b 79 mr. r31,r3
ffc09db0: 80 81 00 08 lwz r4,8(r1)
ffc09db4: 80 c1 00 0c lwz r6,12(r1)
ffc09db8: 40 a2 00 10 bne+ ffc09dc8 <rtems_partition_create+0xac>
_Thread_Enable_dispatch();
ffc09dbc: 48 00 31 0d bl ffc0cec8 <_Thread_Enable_dispatch>
return RTEMS_TOO_MANY;
ffc09dc0: 38 60 00 05 li r3,5
ffc09dc4: 48 00 00 4c b ffc09e10 <rtems_partition_create+0xf4>
the_partition->length = length;
the_partition->buffer_size = buffer_size;
the_partition->attribute_set = attribute_set;
the_partition->number_of_used_blocks = 0;
_Chain_Initialize( &the_partition->Memory, starting_address,
ffc09dc8: 7c be 33 96 divwu r5,r30,r6
_Thread_Enable_dispatch();
return RTEMS_TOO_MANY;
}
#endif
the_partition->starting_address = starting_address;
ffc09dcc: 90 9f 00 10 stw r4,16(r31)
the_partition->length = length;
the_partition->buffer_size = buffer_size;
ffc09dd0: 90 df 00 18 stw r6,24(r31)
return RTEMS_TOO_MANY;
}
#endif
the_partition->starting_address = starting_address;
the_partition->length = length;
ffc09dd4: 93 df 00 14 stw r30,20(r31)
the_partition->buffer_size = buffer_size;
the_partition->attribute_set = attribute_set;
ffc09dd8: 93 5f 00 1c stw r26,28(r31)
the_partition->number_of_used_blocks = 0;
ffc09ddc: 93 3f 00 20 stw r25,32(r31)
_Chain_Initialize( &the_partition->Memory, starting_address,
ffc09de0: 38 7f 00 24 addi r3,r31,36
ffc09de4: 48 00 12 69 bl ffc0b04c <_Chain_Initialize>
Objects_Name name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc09de8: 81 3f 00 08 lwz r9,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc09dec: 81 1d 00 1c lwz r8,28(r29)
ffc09df0: 55 2a 13 ba rlwinm r10,r9,2,14,29
ffc09df4: 7f e8 51 2e stwx r31,r8,r10
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
ffc09df8: 93 7f 00 0c stw r27,12(r31)
&_Partition_Information,
&the_partition->Object,
(Objects_Name) name
);
*id = the_partition->Object.id;
ffc09dfc: 91 3c 00 00 stw r9,0(r28)
name,
0 /* Not used */
);
#endif
_Thread_Enable_dispatch();
ffc09e00: 48 00 30 c9 bl ffc0cec8 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc09e04: 38 60 00 00 li r3,0
ffc09e08: 48 00 00 08 b ffc09e10 <rtems_partition_create+0xf4>
)
{
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
return RTEMS_INVALID_NAME;
ffc09e0c: 38 60 00 03 li r3,3
);
#endif
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
ffc09e10: 39 61 00 30 addi r11,r1,48
ffc09e14: 48 01 2f 88 b ffc1cd9c <_restgpr_25_x>
ffc348a8 <rtems_rate_monotonic_period>:
rtems_status_code rtems_rate_monotonic_period(
rtems_id id,
rtems_interval length
)
{
ffc348a8: 94 21 ff d8 stwu r1,-40(r1)
ffc348ac: 7c 08 02 a6 mflr r0
ffc348b0: bf 81 00 18 stmw r28,24(r1)
ffc348b4: 7c 7e 1b 78 mr r30,r3
ffc348b8: 3c 60 00 00 lis r3,0
ffc348bc: 7c 9d 23 78 mr r29,r4
ffc348c0: 90 01 00 2c stw r0,44(r1)
ffc348c4: 38 63 6f 3c addi r3,r3,28476
ffc348c8: 7f c4 f3 78 mr r4,r30
ffc348cc: 38 a1 00 08 addi r5,r1,8
ffc348d0: 4b fd 53 2d bl ffc09bfc <_Objects_Get>
rtems_rate_monotonic_period_states local_state;
ISR_Level level;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
ffc348d4: 81 21 00 08 lwz r9,8(r1)
ffc348d8: 2f 89 00 00 cmpwi cr7,r9,0
ffc348dc: 40 9e 01 8c bne- cr7,ffc34a68 <rtems_rate_monotonic_period+0x1c0>
case OBJECTS_LOCAL:
if ( !_Thread_Is_executing( the_period->owner ) ) {
ffc348e0: 3d 40 00 00 lis r10,0
ffc348e4: 81 23 00 40 lwz r9,64(r3)
ffc348e8: 81 4a 69 30 lwz r10,26928(r10)
ffc348ec: 7c 7f 1b 78 mr r31,r3
ffc348f0: 7f 89 50 00 cmpw cr7,r9,r10
ffc348f4: 41 9e 00 10 beq- cr7,ffc34904 <rtems_rate_monotonic_period+0x5c>
_Thread_Enable_dispatch();
ffc348f8: 4b fd 61 59 bl ffc0aa50 <_Thread_Enable_dispatch>
return RTEMS_NOT_OWNER_OF_RESOURCE;
ffc348fc: 3b c0 00 17 li r30,23
ffc34900: 48 00 01 6c b ffc34a6c <rtems_rate_monotonic_period+0x1c4>
}
if ( length == RTEMS_PERIOD_STATUS ) {
ffc34904: 2f 9d 00 00 cmpwi cr7,r29,0
ffc34908: 40 9e 00 28 bne- cr7,ffc34930 <rtems_rate_monotonic_period+0x88>
switch ( the_period->state ) {
ffc3490c: 81 23 00 38 lwz r9,56(r3)
ffc34910: 3b c0 00 00 li r30,0
ffc34914: 2b 89 00 04 cmplwi cr7,r9,4
ffc34918: 41 9d 00 10 bgt- cr7,ffc34928 <rtems_rate_monotonic_period+0x80><== NEVER TAKEN
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
ffc3491c: 3d 40 ff c6 lis r10,-58
ffc34920: 39 4a e4 90 addi r10,r10,-7024
ffc34924: 7f ca 48 ae lbzx r30,r10,r9
case RATE_MONOTONIC_ACTIVE:
default: /* unreached -- only to remove warnings */
return_value = RTEMS_SUCCESSFUL;
break;
}
_Thread_Enable_dispatch();
ffc34928: 4b fd 61 29 bl ffc0aa50 <_Thread_Enable_dispatch>
ffc3492c: 48 00 01 40 b ffc34a6c <rtems_rate_monotonic_period+0x1c4>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc34930: 7f 80 00 a6 mfmsr r28
ffc34934: 7d 30 42 a6 mfsprg r9,0
ffc34938: 7f 89 48 78 andc r9,r28,r9
ffc3493c: 7d 20 01 24 mtmsr r9
return( return_value );
}
_ISR_Disable( level );
if ( the_period->state == RATE_MONOTONIC_INACTIVE ) {
ffc34940: 81 23 00 38 lwz r9,56(r3)
ffc34944: 2f 89 00 00 cmpwi cr7,r9,0
ffc34948: 40 be 00 4c bne+ cr7,ffc34994 <rtems_rate_monotonic_period+0xec>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc3494c: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
the_period->next_length = length;
ffc34950: 93 a3 00 3c stw r29,60(r3)
/*
* Baseline statistics information for the beginning of a period.
*/
_Rate_monotonic_Initiate_statistics( the_period );
ffc34954: 4b ff fe b9 bl ffc3480c <_Rate_monotonic_Initiate_statistics>
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc34958: 39 20 00 02 li r9,2
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
ffc3495c: 3d 40 ff c3 lis r10,-61
ffc34960: 91 3f 00 38 stw r9,56(r31)
ffc34964: 39 4a 4a 78 addi r10,r10,19064
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc34968: 39 20 00 00 li r9,0
the_watchdog->routine = routine;
ffc3496c: 91 5f 00 2c stw r10,44(r31)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc34970: 3c 60 00 00 lis r3,0
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc34974: 91 3f 00 18 stw r9,24(r31)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc34978: 38 63 65 28 addi r3,r3,25896
ffc3497c: 38 9f 00 10 addi r4,r31,16
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
ffc34980: 93 df 00 30 stw r30,48(r31)
the_watchdog->user_data = user_data;
ffc34984: 91 3f 00 34 stw r9,52(r31)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc34988: 93 bf 00 1c stw r29,28(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc3498c: 4b fd 6e 31 bl ffc0b7bc <_Watchdog_Insert>
ffc34990: 48 00 00 74 b ffc34a04 <rtems_rate_monotonic_period+0x15c>
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
if ( the_period->state == RATE_MONOTONIC_ACTIVE ) {
ffc34994: 2f 89 00 02 cmpwi cr7,r9,2
ffc34998: 40 be 00 78 bne+ cr7,ffc34a10 <rtems_rate_monotonic_period+0x168>
/*
* Update statistics from the concluding period.
*/
_Rate_monotonic_Update_statistics( the_period );
ffc3499c: 4b ff fd 45 bl ffc346e0 <_Rate_monotonic_Update_statistics>
/*
* This tells the _Rate_monotonic_Timeout that this task is
* in the process of blocking on the period and that we
* may be changing the length of the next period.
*/
the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING;
ffc349a0: 39 20 00 01 li r9,1
ffc349a4: 91 3f 00 38 stw r9,56(r31)
the_period->next_length = length;
ffc349a8: 93 bf 00 3c stw r29,60(r31)
ffc349ac: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
_Thread_Executing->Wait.id = the_period->Object.id;
ffc349b0: 3d 20 00 00 lis r9,0
ffc349b4: 80 69 69 30 lwz r3,26928(r9)
_Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc349b8: 38 80 40 00 li r4,16384
the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING;
the_period->next_length = length;
_ISR_Enable( level );
_Thread_Executing->Wait.id = the_period->Object.id;
ffc349bc: 81 3f 00 08 lwz r9,8(r31)
ffc349c0: 91 23 00 20 stw r9,32(r3)
_Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc349c4: 4b fd 69 e9 bl ffc0b3ac <_Thread_Set_state>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc349c8: 7d 40 00 a6 mfmsr r10
ffc349cc: 7d 30 42 a6 mfsprg r9,0
ffc349d0: 7d 49 48 78 andc r9,r10,r9
ffc349d4: 7d 20 01 24 mtmsr r9
* Did the watchdog timer expire while we were actually blocking
* on it?
*/
_ISR_Disable( level );
local_state = the_period->state;
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc349d8: 39 00 00 02 li r8,2
/*
* Did the watchdog timer expire while we were actually blocking
* on it?
*/
_ISR_Disable( level );
local_state = the_period->state;
ffc349dc: 81 3f 00 38 lwz r9,56(r31)
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc349e0: 91 1f 00 38 stw r8,56(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc349e4: 7d 40 01 24 mtmsr r10
/*
* If it did, then we want to unblock ourself and continue as
* if nothing happen. The period was reset in the timeout routine.
*/
if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING )
ffc349e8: 2f 89 00 03 cmpwi cr7,r9,3
ffc349ec: 40 be 00 18 bne+ cr7,ffc34a04 <rtems_rate_monotonic_period+0x15c><== ALWAYS TAKEN
_Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc349f0: 3d 20 00 00 lis r9,0 <== NOT EXECUTED
ffc349f4: 39 29 69 20 addi r9,r9,26912 <== NOT EXECUTED
ffc349f8: 80 69 00 10 lwz r3,16(r9) <== NOT EXECUTED
ffc349fc: 38 80 40 00 li r4,16384 <== NOT EXECUTED
ffc34a00: 4b fd 5c 31 bl ffc0a630 <_Thread_Clear_state> <== NOT EXECUTED
_Thread_Enable_dispatch();
ffc34a04: 4b fd 60 4d bl ffc0aa50 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc34a08: 3b c0 00 00 li r30,0
ffc34a0c: 48 00 00 60 b ffc34a6c <rtems_rate_monotonic_period+0x1c4>
}
if ( the_period->state == RATE_MONOTONIC_EXPIRED ) {
ffc34a10: 2f 89 00 04 cmpwi cr7,r9,4
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc34a14: 3b c0 00 04 li r30,4
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
if ( the_period->state == RATE_MONOTONIC_EXPIRED ) {
ffc34a18: 40 be 00 54 bne+ cr7,ffc34a6c <rtems_rate_monotonic_period+0x1c4><== NEVER TAKEN
/*
* Update statistics from the concluding period
*/
_Rate_monotonic_Update_statistics( the_period );
ffc34a1c: 4b ff fc c5 bl ffc346e0 <_Rate_monotonic_Update_statistics>
ffc34a20: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc34a24: 39 20 00 02 li r9,2
the_period->next_length = length;
ffc34a28: 93 bf 00 3c stw r29,60(r31)
ffc34a2c: 3c 60 00 00 lis r3,0
*/
_Rate_monotonic_Update_statistics( the_period );
_ISR_Enable( level );
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc34a30: 91 3f 00 38 stw r9,56(r31)
ffc34a34: 38 63 65 28 addi r3,r3,25896
ffc34a38: 38 9f 00 10 addi r4,r31,16
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc34a3c: 93 bf 00 1c stw r29,28(r31)
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Scheduler_Release_job(the_period->owner, the_period->next_length);
_Thread_Enable_dispatch();
return RTEMS_TIMEOUT;
ffc34a40: 3b c0 00 06 li r30,6
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc34a44: 4b fd 6d 79 bl ffc0b7bc <_Watchdog_Insert>
ffc34a48: 3d 20 00 00 lis r9,0
ffc34a4c: 81 29 20 c0 lwz r9,8384(r9)
ffc34a50: 80 7f 00 40 lwz r3,64(r31)
ffc34a54: 80 9f 00 3c lwz r4,60(r31)
ffc34a58: 7d 29 03 a6 mtctr r9
ffc34a5c: 4e 80 04 21 bctrl
the_period->state = RATE_MONOTONIC_ACTIVE;
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Scheduler_Release_job(the_period->owner, the_period->next_length);
_Thread_Enable_dispatch();
ffc34a60: 4b fd 5f f1 bl ffc0aa50 <_Thread_Enable_dispatch>
ffc34a64: 48 00 00 08 b ffc34a6c <rtems_rate_monotonic_period+0x1c4>
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc34a68: 3b c0 00 04 li r30,4
}
ffc34a6c: 39 61 00 28 addi r11,r1,40
ffc34a70: 7f c3 f3 78 mr r3,r30
ffc34a74: 48 01 fa 8c b ffc54500 <_restgpr_28_x>
ffc27858 <rtems_rate_monotonic_report_statistics_with_plugin>:
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
ffc27858: 94 21 ff 70 stwu r1,-144(r1)
ffc2785c: 7c 08 02 a6 mflr r0
ffc27860: be e1 00 6c stmw r23,108(r1)
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
ffc27864: 7c 9f 23 79 mr. r31,r4
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
ffc27868: 90 01 00 94 stw r0,148(r1)
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
ffc2786c: 41 82 01 cc beq- ffc27a38 <rtems_rate_monotonic_report_statistics_with_plugin+0x1e0><== NEVER TAKEN
return;
(*print)( context, "Period information by period\n" );
ffc27870: 3c 80 ff c6 lis r4,-58
ffc27874: 7f e9 03 a6 mtctr r31
ffc27878: 38 84 b8 d0 addi r4,r4,-18224
ffc2787c: 7c 7e 1b 78 mr r30,r3
rtems_object_get_name( the_status.owner, sizeof(name), name );
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc27880: 3f 40 ff c6 lis r26,-58
struct timespec *min_cpu = &the_stats.min_cpu_time;
struct timespec *max_cpu = &the_stats.max_cpu_time;
struct timespec *total_cpu = &the_stats.total_cpu_time;
_Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average );
(*print)( context,
ffc27884: 3f 20 ff c6 lis r25,-58
char name[5];
if ( !print )
return;
(*print)( context, "Period information by period\n" );
ffc27888: 4c c6 31 82 crclr 4*cr1+eq
ffc2788c: 4e 80 04 21 bctrl
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
(*print)( context, "--- CPU times are in seconds ---\n" );
ffc27890: 3c 80 ff c6 lis r4,-58
ffc27894: 38 84 b8 ee addi r4,r4,-18194
ffc27898: 7f e9 03 a6 mtctr r31
ffc2789c: 7f c3 f3 78 mr r3,r30
struct timespec *min_wall = &the_stats.min_wall_time;
struct timespec *max_wall = &the_stats.max_wall_time;
struct timespec *total_wall = &the_stats.total_wall_time;
_Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average);
(*print)( context,
ffc278a0: 3f 00 ff c6 lis r24,-58
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
(*print)( context, "\n" );
ffc278a4: 3e e0 ff c5 lis r23,-59
rtems_object_get_name( the_status.owner, sizeof(name), name );
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc278a8: 3b 5a b9 ca addi r26,r26,-17974
if ( !print )
return;
(*print)( context, "Period information by period\n" );
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
(*print)( context, "--- CPU times are in seconds ---\n" );
ffc278ac: 4c c6 31 82 crclr 4*cr1+eq
ffc278b0: 4e 80 04 21 bctrl
(*print)( context, "--- Wall times are in seconds ---\n" );
ffc278b4: 3c 80 ff c6 lis r4,-58
ffc278b8: 38 84 b9 10 addi r4,r4,-18160
ffc278bc: 7f e9 03 a6 mtctr r31
ffc278c0: 7f c3 f3 78 mr r3,r30
struct timespec *min_cpu = &the_stats.min_cpu_time;
struct timespec *max_cpu = &the_stats.max_cpu_time;
struct timespec *total_cpu = &the_stats.total_cpu_time;
_Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average );
(*print)( context,
ffc278c4: 3b 39 b9 e1 addi r25,r25,-17951
struct timespec *min_wall = &the_stats.min_wall_time;
struct timespec *max_wall = &the_stats.max_wall_time;
struct timespec *total_wall = &the_stats.total_wall_time;
_Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average);
(*print)( context,
ffc278c8: 3b 18 ba 00 addi r24,r24,-17920
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
(*print)( context, "\n" );
ffc278cc: 3a f7 61 e6 addi r23,r23,25062
return;
(*print)( context, "Period information by period\n" );
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
(*print)( context, "--- CPU times are in seconds ---\n" );
(*print)( context, "--- Wall times are in seconds ---\n" );
ffc278d0: 4c c6 31 82 crclr 4*cr1+eq
ffc278d4: 4e 80 04 21 bctrl
Be sure to test the various cases.
(*print)( context,"\
1234567890123456789012345678901234567890123456789012345678901234567890123456789\
\n");
*/
(*print)( context, " ID OWNER COUNT MISSED "
ffc278d8: 3c 80 ff c6 lis r4,-58
ffc278dc: 38 84 b9 33 addi r4,r4,-18125
ffc278e0: 7f e9 03 a6 mtctr r31
ffc278e4: 7f c3 f3 78 mr r3,r30
ffc278e8: 4c c6 31 82 crclr 4*cr1+eq
ffc278ec: 4e 80 04 21 bctrl
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
" "
#endif
" WALL TIME\n"
);
(*print)( context, " "
ffc278f0: 3c 80 ff c6 lis r4,-58
ffc278f4: 7f c3 f3 78 mr r3,r30
ffc278f8: 7f e9 03 a6 mtctr r31
ffc278fc: 38 84 b9 7e addi r4,r4,-18050
ffc27900: 4c c6 31 82 crclr 4*cr1+eq
ffc27904: 4e 80 04 21 bctrl
/*
* Cycle through all possible ids and try to report on each one. If it
* is a period that is inactive, we just get an error back. No big deal.
*/
for ( id=_Rate_monotonic_Information.minimum_id ;
ffc27908: 3d 20 00 00 lis r9,0
ffc2790c: 39 49 6f 3c addi r10,r9,28476
ffc27910: 83 aa 00 08 lwz r29,8(r10)
id <= _Rate_monotonic_Information.maximum_id ;
ffc27914: 7d 3b 4b 78 mr r27,r9
/*
* Cycle through all possible ids and try to report on each one. If it
* is a period that is inactive, we just get an error back. No big deal.
*/
for ( id=_Rate_monotonic_Information.minimum_id ;
ffc27918: 48 00 01 10 b ffc27a28 <rtems_rate_monotonic_report_statistics_with_plugin+0x1d0>
id <= _Rate_monotonic_Information.maximum_id ;
id++ ) {
status = rtems_rate_monotonic_get_statistics( id, &the_stats );
ffc2791c: 7f a3 eb 78 mr r3,r29
ffc27920: 38 81 00 08 addi r4,r1,8
ffc27924: 48 00 c9 dd bl ffc34300 <rtems_rate_monotonic_get_statistics>
if ( status != RTEMS_SUCCESSFUL )
ffc27928: 2f 83 00 00 cmpwi cr7,r3,0
ffc2792c: 40 be 00 f8 bne+ cr7,ffc27a24 <rtems_rate_monotonic_report_statistics_with_plugin+0x1cc>
#if defined(RTEMS_DEBUG)
status = rtems_rate_monotonic_get_status( id, &the_status );
if ( status != RTEMS_SUCCESSFUL )
continue;
#else
(void) rtems_rate_monotonic_get_status( id, &the_status );
ffc27930: 38 81 00 40 addi r4,r1,64
ffc27934: 7f a3 eb 78 mr r3,r29
ffc27938: 48 00 cb b9 bl ffc344f0 <rtems_rate_monotonic_get_status>
#endif
rtems_object_get_name( the_status.owner, sizeof(name), name );
ffc2793c: 80 61 00 40 lwz r3,64(r1)
ffc27940: 38 80 00 05 li r4,5
ffc27944: 38 a1 00 60 addi r5,r1,96
ffc27948: 4b fe 85 d1 bl ffc0ff18 <rtems_object_get_name>
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc2794c: 7f 44 d3 78 mr r4,r26
ffc27950: 7f c3 f3 78 mr r3,r30
ffc27954: 80 e1 00 08 lwz r7,8(r1)
ffc27958: 7f a5 eb 78 mr r5,r29
ffc2795c: 81 01 00 0c lwz r8,12(r1)
ffc27960: 38 c1 00 60 addi r6,r1,96
ffc27964: 7f e9 03 a6 mtctr r31
ffc27968: 4c c6 31 82 crclr 4*cr1+eq
ffc2796c: 4e 80 04 21 bctrl
);
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
ffc27970: 80 81 00 08 lwz r4,8(r1)
ffc27974: 2f 84 00 00 cmpwi cr7,r4,0
ffc27978: 40 9e 00 1c bne- cr7,ffc27994 <rtems_rate_monotonic_report_statistics_with_plugin+0x13c>
(*print)( context, "\n" );
ffc2797c: 7f c3 f3 78 mr r3,r30
ffc27980: 7f e9 03 a6 mtctr r31
ffc27984: 7e e4 bb 78 mr r4,r23
ffc27988: 4c c6 31 82 crclr 4*cr1+eq
ffc2798c: 4e 80 04 21 bctrl
continue;
ffc27990: 48 00 00 94 b ffc27a24 <rtems_rate_monotonic_report_statistics_with_plugin+0x1cc>
struct timespec cpu_average;
struct timespec *min_cpu = &the_stats.min_cpu_time;
struct timespec *max_cpu = &the_stats.max_cpu_time;
struct timespec *total_cpu = &the_stats.total_cpu_time;
_Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average );
ffc27994: 38 61 00 20 addi r3,r1,32
ffc27998: 38 a1 00 58 addi r5,r1,88
ffc2799c: 48 00 0c c9 bl ffc28664 <_Timespec_Divide_by_integer>
(*print)( context,
ffc279a0: 80 c1 00 14 lwz r6,20(r1)
ffc279a4: 81 01 00 1c lwz r8,28(r1)
ffc279a8: 3b 80 03 e8 li r28,1000
ffc279ac: 81 41 00 5c lwz r10,92(r1)
ffc279b0: 7c c6 e3 d6 divw r6,r6,r28
ffc279b4: 80 e1 00 18 lwz r7,24(r1)
ffc279b8: 7f e9 03 a6 mtctr r31
ffc279bc: 81 21 00 58 lwz r9,88(r1)
ffc279c0: 80 a1 00 10 lwz r5,16(r1)
ffc279c4: 7d 08 e3 d6 divw r8,r8,r28
ffc279c8: 7d 4a e3 d6 divw r10,r10,r28
ffc279cc: 7f 24 cb 78 mr r4,r25
ffc279d0: 7f c3 f3 78 mr r3,r30
ffc279d4: 4c c6 31 82 crclr 4*cr1+eq
ffc279d8: 4e 80 04 21 bctrl
struct timespec wall_average;
struct timespec *min_wall = &the_stats.min_wall_time;
struct timespec *max_wall = &the_stats.max_wall_time;
struct timespec *total_wall = &the_stats.total_wall_time;
_Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average);
ffc279dc: 80 81 00 08 lwz r4,8(r1)
ffc279e0: 38 61 00 38 addi r3,r1,56
ffc279e4: 38 a1 00 58 addi r5,r1,88
ffc279e8: 48 00 0c 7d bl ffc28664 <_Timespec_Divide_by_integer>
(*print)( context,
ffc279ec: 80 c1 00 2c lwz r6,44(r1)
ffc279f0: 81 01 00 34 lwz r8,52(r1)
ffc279f4: 7f c3 f3 78 mr r3,r30
ffc279f8: 81 41 00 5c lwz r10,92(r1)
ffc279fc: 7f 04 c3 78 mr r4,r24
ffc27a00: 80 a1 00 28 lwz r5,40(r1)
ffc27a04: 7c c6 e3 d6 divw r6,r6,r28
ffc27a08: 80 e1 00 30 lwz r7,48(r1)
ffc27a0c: 7f e9 03 a6 mtctr r31
ffc27a10: 81 21 00 58 lwz r9,88(r1)
ffc27a14: 7d 08 e3 d6 divw r8,r8,r28
ffc27a18: 7d 4a e3 d6 divw r10,r10,r28
ffc27a1c: 4c c6 31 82 crclr 4*cr1+eq
ffc27a20: 4e 80 04 21 bctrl
* Cycle through all possible ids and try to report on each one. If it
* is a period that is inactive, we just get an error back. No big deal.
*/
for ( id=_Rate_monotonic_Information.minimum_id ;
id <= _Rate_monotonic_Information.maximum_id ;
id++ ) {
ffc27a24: 3b bd 00 01 addi r29,r29,1
/*
* Cycle through all possible ids and try to report on each one. If it
* is a period that is inactive, we just get an error back. No big deal.
*/
for ( id=_Rate_monotonic_Information.minimum_id ;
id <= _Rate_monotonic_Information.maximum_id ;
ffc27a28: 39 3b 6f 3c addi r9,r27,28476
/*
* Cycle through all possible ids and try to report on each one. If it
* is a period that is inactive, we just get an error back. No big deal.
*/
for ( id=_Rate_monotonic_Information.minimum_id ;
ffc27a2c: 81 29 00 0c lwz r9,12(r9)
ffc27a30: 7f 9d 48 40 cmplw cr7,r29,r9
ffc27a34: 40 9d fe e8 ble+ cr7,ffc2791c <rtems_rate_monotonic_report_statistics_with_plugin+0xc4>
the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall
);
#endif
}
}
}
ffc27a38: 39 61 00 90 addi r11,r1,144
ffc27a3c: 48 02 ca b0 b ffc544ec <_restgpr_23_x>
ffc09764 <rtems_rbheap_allocate>:
return big_enough;
}
void *rtems_rbheap_allocate(rtems_rbheap_control *control, size_t size)
{
ffc09764: 94 21 ff e0 stwu r1,-32(r1)
ffc09768: 7c 08 02 a6 mflr r0
ffc0976c: 2f 84 00 00 cmpwi cr7,r4,0
ffc09770: 90 01 00 24 stw r0,36(r1)
void *ptr = NULL;
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
uintptr_t alignment = control->alignment;
ffc09774: 81 23 00 30 lwz r9,48(r3)
return big_enough;
}
void *rtems_rbheap_allocate(rtems_rbheap_control *control, size_t size)
{
ffc09778: bf 61 00 0c stmw r27,12(r1)
ffc0977c: 7c 7c 1b 78 mr r28,r3
#include <stdlib.h>
static uintptr_t align_up(uintptr_t alignment, uintptr_t value)
{
uintptr_t excess = value % alignment;
ffc09780: 7f a4 4b 96 divwu r29,r4,r9
ffc09784: 7f bd 49 d6 mullw r29,r29,r9
if (excess > 0) {
ffc09788: 7d 5d 20 51 subf. r10,r29,r4
ffc0978c: 41 82 00 dc beq- ffc09868 <rtems_rbheap_allocate+0x104> <== ALWAYS TAKEN
value += alignment - excess;
ffc09790: 7f a4 4a 14 add r29,r4,r9 <== NOT EXECUTED
ffc09794: 7f aa e8 50 subf r29,r10,r29 <== NOT EXECUTED
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
uintptr_t alignment = control->alignment;
uintptr_t aligned_size = align_up(alignment, size);
if (size > 0 && size <= aligned_size) {
ffc09798: 40 be 00 0c bne+ cr7,ffc097a4 <rtems_rbheap_allocate+0x40><== NOT EXECUTED
return big_enough;
}
void *rtems_rbheap_allocate(rtems_rbheap_control *control, size_t size)
{
void *ptr = NULL;
ffc0979c: 38 60 00 00 li r3,0
ffc097a0: 48 00 00 d0 b ffc09870 <rtems_rbheap_allocate+0x10c>
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
uintptr_t alignment = control->alignment;
uintptr_t aligned_size = align_up(alignment, size);
if (size > 0 && size <= aligned_size) {
ffc097a4: 7f 84 e8 40 cmplw cr7,r4,r29 <== NOT EXECUTED
ffc097a8: 40 bd 00 0c ble+ cr7,ffc097b4 <rtems_rbheap_allocate+0x50><== NOT EXECUTED
ffc097ac: 4b ff ff f0 b ffc0979c <rtems_rbheap_allocate+0x38> <== NOT EXECUTED
ffc097b0: 7c 9d 23 78 mr r29,r4
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First(
Chain_Control *the_chain
)
{
return _Chain_Head( the_chain )->next;
ffc097b4: 81 3c 00 00 lwz r9,0(r28)
rtems_chain_control *free_chain,
size_t size
)
{
rtems_chain_node *current = rtems_chain_first(free_chain);
const rtems_chain_node *tail = rtems_chain_tail(free_chain);
ffc097b8: 39 1c 00 04 addi r8,r28,4
rtems_rbheap_chunk *big_enough = NULL;
ffc097bc: 3b e0 00 00 li r31,0
ffc097c0: 48 00 00 18 b ffc097d8 <rtems_rbheap_allocate+0x74>
while (current != tail && big_enough == NULL) {
rtems_rbheap_chunk *free_chunk = (rtems_rbheap_chunk *) current;
if (free_chunk->size >= size) {
ffc097c4: 81 49 00 1c lwz r10,28(r9)
ffc097c8: 7f 8a e8 40 cmplw cr7,r10,r29
ffc097cc: 41 9c 00 08 blt- cr7,ffc097d4 <rtems_rbheap_allocate+0x70>
ffc097d0: 7d 3f 4b 78 mr r31,r9
rtems_rbheap_chunk *chunk = malloc(sizeof(*chunk));
if (chunk != NULL) {
rtems_rbheap_add_to_spare_descriptor_chain(control, chunk);
}
}
ffc097d4: 81 29 00 00 lwz r9,0(r9)
{
rtems_chain_node *current = rtems_chain_first(free_chain);
const rtems_chain_node *tail = rtems_chain_tail(free_chain);
rtems_rbheap_chunk *big_enough = NULL;
while (current != tail && big_enough == NULL) {
ffc097d8: 7f 09 40 00 cmpw cr6,r9,r8
ffc097dc: 2f 9f 00 00 cmpwi cr7,r31,0
ffc097e0: 40 ba 00 0c bne+ cr6,ffc097ec <rtems_rbheap_allocate+0x88>
uintptr_t aligned_size = align_up(alignment, size);
if (size > 0 && size <= aligned_size) {
rtems_rbheap_chunk *free_chunk = search_free_chunk(free_chain, aligned_size);
if (free_chunk != NULL) {
ffc097e4: 40 be 00 0c bne+ cr7,ffc097f0 <rtems_rbheap_allocate+0x8c>
ffc097e8: 4b ff ff b4 b ffc0979c <rtems_rbheap_allocate+0x38>
{
rtems_chain_node *current = rtems_chain_first(free_chain);
const rtems_chain_node *tail = rtems_chain_tail(free_chain);
rtems_rbheap_chunk *big_enough = NULL;
while (current != tail && big_enough == NULL) {
ffc097ec: 41 9e ff d8 beq+ cr7,ffc097c4 <rtems_rbheap_allocate+0x60><== ALWAYS TAKEN
if (size > 0 && size <= aligned_size) {
rtems_rbheap_chunk *free_chunk = search_free_chunk(free_chain, aligned_size);
if (free_chunk != NULL) {
uintptr_t free_size = free_chunk->size;
ffc097f0: 83 7f 00 1c lwz r27,28(r31)
if (free_size > aligned_size) {
ffc097f4: 7f 9b e8 40 cmplw cr7,r27,r29
ffc097f8: 40 9d 00 4c ble- cr7,ffc09844 <rtems_rbheap_allocate+0xe0>
rtems_rbheap_chunk *new_chunk = get_chunk(control);
ffc097fc: 7f 83 e3 78 mr r3,r28
ffc09800: 4b ff fd c5 bl ffc095c4 <get_chunk>
if (new_chunk != NULL) {
ffc09804: 7c 7e 1b 79 mr. r30,r3
ffc09808: 41 a2 ff 94 beq- ffc0979c <rtems_rbheap_allocate+0x38> <== NEVER TAKEN
uintptr_t new_free_size = free_size - aligned_size;
free_chunk->size = new_free_size;
new_chunk->begin = free_chunk->begin + new_free_size;
ffc0980c: 81 3f 00 18 lwz r9,24(r31)
if (free_size > aligned_size) {
rtems_rbheap_chunk *new_chunk = get_chunk(control);
if (new_chunk != NULL) {
uintptr_t new_free_size = free_size - aligned_size;
ffc09810: 7f 7d d8 50 subf r27,r29,r27
free_chunk->size = new_free_size;
ffc09814: 93 7f 00 1c stw r27,28(r31)
static void insert_into_tree(
rtems_rbtree_control *tree,
rtems_rbheap_chunk *chunk
)
{
_RBTree_Insert_unprotected(tree, &chunk->tree_node);
ffc09818: 38 7c 00 18 addi r3,r28,24
if (new_chunk != NULL) {
uintptr_t new_free_size = free_size - aligned_size;
free_chunk->size = new_free_size;
new_chunk->begin = free_chunk->begin + new_free_size;
ffc0981c: 7f 7b 4a 14 add r27,r27,r9
*/
RTEMS_INLINE_ROUTINE void _Chain_Set_off_chain(
Chain_Node *node
)
{
node->next = node->previous = NULL;
ffc09820: 39 20 00 00 li r9,0
ffc09824: 93 7e 00 18 stw r27,24(r30)
static void insert_into_tree(
rtems_rbtree_control *tree,
rtems_rbheap_chunk *chunk
)
{
_RBTree_Insert_unprotected(tree, &chunk->tree_node);
ffc09828: 38 9e 00 08 addi r4,r30,8
if (new_chunk != NULL) {
uintptr_t new_free_size = free_size - aligned_size;
free_chunk->size = new_free_size;
new_chunk->begin = free_chunk->begin + new_free_size;
new_chunk->size = aligned_size;
ffc0982c: 93 be 00 1c stw r29,28(r30)
ffc09830: 91 3e 00 04 stw r9,4(r30)
ffc09834: 91 3e 00 00 stw r9,0(r30)
static void insert_into_tree(
rtems_rbtree_control *tree,
rtems_rbheap_chunk *chunk
)
{
_RBTree_Insert_unprotected(tree, &chunk->tree_node);
ffc09838: 48 00 1a f1 bl ffc0b328 <_RBTree_Insert_unprotected>
free_chunk->size = new_free_size;
new_chunk->begin = free_chunk->begin + new_free_size;
new_chunk->size = aligned_size;
rtems_chain_set_off_chain(&new_chunk->chain_node);
insert_into_tree(chunk_tree, new_chunk);
ptr = (void *) new_chunk->begin;
ffc0983c: 80 7e 00 18 lwz r3,24(r30)
ffc09840: 48 00 00 30 b ffc09870 <rtems_rbheap_allocate+0x10c>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
ffc09844: 81 3f 00 00 lwz r9,0(r31)
previous = the_node->previous;
ffc09848: 81 5f 00 04 lwz r10,4(r31)
}
} else {
rtems_chain_extract_unprotected(&free_chunk->chain_node);
rtems_chain_set_off_chain(&free_chunk->chain_node);
ptr = (void *) free_chunk->begin;
ffc0984c: 80 7f 00 18 lwz r3,24(r31)
next->previous = previous;
ffc09850: 91 49 00 04 stw r10,4(r9)
previous->next = next;
ffc09854: 91 2a 00 00 stw r9,0(r10)
*/
RTEMS_INLINE_ROUTINE void _Chain_Set_off_chain(
Chain_Node *node
)
{
node->next = node->previous = NULL;
ffc09858: 39 20 00 00 li r9,0
ffc0985c: 91 3f 00 04 stw r9,4(r31)
ffc09860: 91 3f 00 00 stw r9,0(r31)
ffc09864: 48 00 00 0c b ffc09870 <rtems_rbheap_allocate+0x10c>
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
uintptr_t alignment = control->alignment;
uintptr_t aligned_size = align_up(alignment, size);
if (size > 0 && size <= aligned_size) {
ffc09868: 40 9e ff 48 bne+ cr7,ffc097b0 <rtems_rbheap_allocate+0x4c>
ffc0986c: 4b ff ff 30 b ffc0979c <rtems_rbheap_allocate+0x38>
}
}
}
return ptr;
}
ffc09870: 39 61 00 20 addi r11,r1,32
ffc09874: 4b ff 74 f4 b ffc00d68 <_restgpr_27_x>
ffc099a8 <rtems_rbheap_extend_descriptors_with_malloc>:
/* Do nothing */
}
void rtems_rbheap_extend_descriptors_with_malloc(rtems_rbheap_control *control)
{
ffc099a8: 7c 2b 0b 78 mr r11,r1 <== NOT EXECUTED
ffc099ac: 94 21 ff f0 stwu r1,-16(r1) <== NOT EXECUTED
ffc099b0: 7c 08 02 a6 mflr r0 <== NOT EXECUTED
ffc099b4: 4b ff 73 79 bl ffc00d2c <_savegpr_31> <== NOT EXECUTED
ffc099b8: 7c 7f 1b 78 mr r31,r3 <== NOT EXECUTED
rtems_rbheap_chunk *chunk = malloc(sizeof(*chunk));
ffc099bc: 38 60 00 20 li r3,32 <== NOT EXECUTED
{
/* Do nothing */
}
void rtems_rbheap_extend_descriptors_with_malloc(rtems_rbheap_control *control)
{
ffc099c0: 90 01 00 14 stw r0,20(r1) <== NOT EXECUTED
rtems_rbheap_chunk *chunk = malloc(sizeof(*chunk));
ffc099c4: 4b ff b3 e9 bl ffc04dac <malloc> <== NOT EXECUTED
if (chunk != NULL) {
ffc099c8: 2c 03 00 00 cmpwi r3,0 <== NOT EXECUTED
ffc099cc: 41 82 00 1c beq- ffc099e8 <rtems_rbheap_extend_descriptors_with_malloc+0x40><== NOT EXECUTED
RTEMS_INLINE_ROUTINE void _Chain_Prepend_unprotected(
Chain_Control *the_chain,
Chain_Node *the_node
)
{
_Chain_Insert_unprotected(_Chain_Head(the_chain), the_node);
ffc099d0: 39 5f 00 0c addi r10,r31,12 <== NOT EXECUTED
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
ffc099d4: 91 43 00 04 stw r10,4(r3) <== NOT EXECUTED
before_node = after_node->next;
ffc099d8: 81 5f 00 0c lwz r10,12(r31) <== NOT EXECUTED
after_node->next = the_node;
ffc099dc: 90 7f 00 0c stw r3,12(r31) <== NOT EXECUTED
the_node->next = before_node;
before_node->previous = the_node;
ffc099e0: 90 6a 00 04 stw r3,4(r10) <== NOT EXECUTED
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
ffc099e4: 91 43 00 00 stw r10,0(r3) <== NOT EXECUTED
rtems_rbheap_add_to_spare_descriptor_chain(control, chunk);
}
}
ffc099e8: 39 61 00 10 addi r11,r1,16 <== NOT EXECUTED
ffc099ec: 4b ff 73 8c b ffc00d78 <_restgpr_31_x> <== NOT EXECUTED
ffc09878 <rtems_rbheap_free>:
_RBTree_Extract_unprotected(chunk_tree, &b->tree_node);
}
}
rtems_status_code rtems_rbheap_free(rtems_rbheap_control *control, void *ptr)
{
ffc09878: 94 21 ff c0 stwu r1,-64(r1)
ffc0987c: 7c 08 02 a6 mflr r0
ffc09880: bf 61 00 2c stmw r27,44(r1)
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (ptr != NULL) {
ffc09884: 7c 9f 23 79 mr. r31,r4
_RBTree_Extract_unprotected(chunk_tree, &b->tree_node);
}
}
rtems_status_code rtems_rbheap_free(rtems_rbheap_control *control, void *ptr)
{
ffc09888: 90 01 00 44 stw r0,68(r1)
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (ptr != NULL) {
ffc0988c: 41 82 01 0c beq- ffc09998 <rtems_rbheap_free+0x120>
ffc09890: 7c 7d 1b 78 mr r29,r3
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
ffc09894: 3b 83 00 18 addi r28,r3,24
#define NULL_PAGE rtems_rbheap_chunk_of_node(NULL)
static rtems_rbheap_chunk *find(rtems_rbtree_control *chunk_tree, uintptr_t key)
{
rtems_rbheap_chunk chunk = { .begin = key };
ffc09898: 38 80 00 00 li r4,0
ffc0989c: 38 61 00 08 addi r3,r1,8
ffc098a0: 38 a0 00 20 li r5,32
ffc098a4: 48 00 88 f9 bl ffc1219c <memset>
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
RBTree_Node* iter_node = the_rbtree->root;
RBTree_Node* found = NULL;
ffc098a8: 3b c0 00 00 li r30,0
ffc098ac: 93 e1 00 20 stw r31,32(r1)
RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Find_unprotected(
RBTree_Control *the_rbtree,
RBTree_Node *the_node
)
{
RBTree_Node* iter_node = the_rbtree->root;
ffc098b0: 83 fd 00 1c lwz r31,28(r29)
ffc098b4: 48 00 00 44 b ffc098f8 <rtems_rbheap_free+0x80>
RBTree_Node* found = NULL;
int compare_result;
while (iter_node) {
compare_result = the_rbtree->compare_function(the_node, iter_node);
ffc098b8: 81 3c 00 10 lwz r9,16(r28)
ffc098bc: 38 61 00 10 addi r3,r1,16
ffc098c0: 7f e4 fb 78 mr r4,r31
ffc098c4: 7d 29 03 a6 mtctr r9
ffc098c8: 4e 80 04 21 bctrl
if ( _RBTree_Is_equal( compare_result ) ) {
ffc098cc: 2c 03 00 00 cmpwi r3,0
ffc098d0: 40 82 00 14 bne- ffc098e4 <rtems_rbheap_free+0x6c>
found = iter_node;
if ( the_rbtree->is_unique )
ffc098d4: 89 5c 00 14 lbz r10,20(r28)
ffc098d8: 2f 8a 00 00 cmpwi cr7,r10,0
ffc098dc: 40 9e 00 28 bne- cr7,ffc09904 <rtems_rbheap_free+0x8c> <== ALWAYS TAKEN
ffc098e0: 7f fe fb 78 mr r30,r31 <== NOT EXECUTED
RTEMS_INLINE_ROUTINE bool _RBTree_Is_greater(
int compare_result
)
{
return compare_result > 0;
ffc098e4: 7c 6a fe 70 srawi r10,r3,31
ffc098e8: 7d 23 50 50 subf r9,r3,r10
break;
}
RBTree_Direction dir =
(RBTree_Direction) _RBTree_Is_greater( compare_result );
iter_node = iter_node->child[dir];
ffc098ec: 55 29 1f 7a rlwinm r9,r9,3,29,29
ffc098f0: 7f ff 4a 14 add r31,r31,r9
ffc098f4: 83 ff 00 04 lwz r31,4(r31)
)
{
RBTree_Node* iter_node = the_rbtree->root;
RBTree_Node* found = NULL;
int compare_result;
while (iter_node) {
ffc098f8: 2f 9f 00 00 cmpwi cr7,r31,0
ffc098fc: 40 9e ff bc bne+ cr7,ffc098b8 <rtems_rbheap_free+0x40>
ffc09900: 7f df f3 78 mr r31,r30
if (ptr != NULL) {
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
rtems_rbheap_chunk *chunk = find(chunk_tree, (uintptr_t) ptr);
if (chunk != NULL_PAGE) {
ffc09904: 2f 9f 00 00 cmpwi cr7,r31,0
check_and_merge(free_chain, chunk_tree, chunk, pred);
} else {
sc = RTEMS_INCORRECT_STATE;
}
} else {
sc = RTEMS_INVALID_ID;
ffc09908: 38 60 00 04 li r3,4
if (ptr != NULL) {
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
rtems_rbheap_chunk *chunk = find(chunk_tree, (uintptr_t) ptr);
if (chunk != NULL_PAGE) {
ffc0990c: 3b df ff f8 addi r30,r31,-8
ffc09910: 41 9e 00 8c beq- cr7,ffc0999c <rtems_rbheap_free+0x124>
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_node_off_chain(
const Chain_Node *node
)
{
return (node->next == NULL) && (node->previous == NULL);
ffc09914: 81 5f ff f8 lwz r10,-8(r31)
ffc09918: 39 20 00 00 li r9,0
ffc0991c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc09920: 40 be 00 10 bne+ cr7,ffc09930 <rtems_rbheap_free+0xb8>
ffc09924: 81 3e 00 04 lwz r9,4(r30)
ffc09928: 7d 29 00 34 cntlzw r9,r9
ffc0992c: 55 29 d9 7e rlwinm r9,r9,27,5,31
if (!rtems_rbheap_is_chunk_free(chunk)) {
ffc09930: 2f 89 00 00 cmpwi cr7,r9,0
check_and_merge(free_chain, chunk_tree, chunk, succ);
add_to_chain(free_chain, chunk);
check_and_merge(free_chain, chunk_tree, chunk, pred);
} else {
sc = RTEMS_INCORRECT_STATE;
ffc09934: 38 60 00 0e li r3,14
rtems_chain_control *free_chain = &control->free_chunk_chain;
rtems_rbtree_control *chunk_tree = &control->chunk_tree;
rtems_rbheap_chunk *chunk = find(chunk_tree, (uintptr_t) ptr);
if (chunk != NULL_PAGE) {
if (!rtems_rbheap_is_chunk_free(chunk)) {
ffc09938: 41 be 00 64 beq+ cr7,ffc0999c <rtems_rbheap_free+0x124>
static rtems_rbheap_chunk *get_next(
const rtems_rbheap_chunk *chunk,
RBTree_Direction dir
)
{
return rtems_rbheap_chunk_of_node(
ffc0993c: 3b fe 00 08 addi r31,r30,8
ffc09940: 38 80 00 00 li r4,0
ffc09944: 7f e3 fb 78 mr r3,r31
ffc09948: 48 00 1c 9d bl ffc0b5e4 <_RBTree_Next_unprotected>
ffc0994c: 38 80 00 01 li r4,1
ffc09950: 7c 7b 1b 78 mr r27,r3
ffc09954: 7f e3 fb 78 mr r3,r31
ffc09958: 48 00 1c 8d bl ffc0b5e4 <_RBTree_Next_unprotected>
if (chunk != NULL_PAGE) {
if (!rtems_rbheap_is_chunk_free(chunk)) {
rtems_rbheap_chunk *pred = get_next(chunk, RBT_LEFT);
rtems_rbheap_chunk *succ = get_next(chunk, RBT_RIGHT);
check_and_merge(free_chain, chunk_tree, chunk, succ);
ffc0995c: 7f 84 e3 78 mr r4,r28
static rtems_rbheap_chunk *get_next(
const rtems_rbheap_chunk *chunk,
RBTree_Direction dir
)
{
return rtems_rbheap_chunk_of_node(
ffc09960: 38 c3 ff f8 addi r6,r3,-8
if (chunk != NULL_PAGE) {
if (!rtems_rbheap_is_chunk_free(chunk)) {
rtems_rbheap_chunk *pred = get_next(chunk, RBT_LEFT);
rtems_rbheap_chunk *succ = get_next(chunk, RBT_RIGHT);
check_and_merge(free_chain, chunk_tree, chunk, succ);
ffc09964: 7f c5 f3 78 mr r5,r30
ffc09968: 7f a3 eb 78 mr r3,r29
ffc0996c: 4b ff fb d1 bl ffc0953c <check_and_merge>
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
ffc09970: 81 3d 00 00 lwz r9,0(r29)
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
ffc09974: 93 be 00 04 stw r29,4(r30)
add_to_chain(free_chain, chunk);
check_and_merge(free_chain, chunk_tree, chunk, pred);
ffc09978: 7f a3 eb 78 mr r3,r29
ffc0997c: 7f 84 e3 78 mr r4,r28
before_node = after_node->next;
after_node->next = the_node;
ffc09980: 93 dd 00 00 stw r30,0(r29)
ffc09984: 7f c5 f3 78 mr r5,r30
ffc09988: 38 db ff f8 addi r6,r27,-8
the_node->next = before_node;
ffc0998c: 91 3e 00 00 stw r9,0(r30)
before_node->previous = the_node;
ffc09990: 93 c9 00 04 stw r30,4(r9)
ffc09994: 4b ff fb a9 bl ffc0953c <check_and_merge>
}
}
rtems_status_code rtems_rbheap_free(rtems_rbheap_control *control, void *ptr)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
ffc09998: 38 60 00 00 li r3,0
sc = RTEMS_INVALID_ID;
}
}
return sc;
}
ffc0999c: 39 61 00 40 addi r11,r1,64
ffc099a0: 4b ff 73 c8 b ffc00d68 <_restgpr_27_x>
ffc09638 <rtems_rbheap_initialize>:
void *handler_arg
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (alignment > 0) {
ffc09638: 7c ca 33 79 mr. r10,r6
ffc0963c: 41 a2 01 04 beq+ ffc09740 <rtems_rbheap_initialize+0x108>
uintptr_t area_size,
uintptr_t alignment,
rtems_rbheap_extend_descriptors extend_descriptors,
void *handler_arg
)
{
ffc09640: 94 21 ff e8 stwu r1,-24(r1)
ffc09644: 7c 08 02 a6 mflr r0
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (alignment > 0) {
uintptr_t begin = (uintptr_t) area_begin;
uintptr_t end = begin + area_size;
ffc09648: 7c a5 22 14 add r5,r5,r4
uintptr_t area_size,
uintptr_t alignment,
rtems_rbheap_extend_descriptors extend_descriptors,
void *handler_arg
)
{
ffc0964c: bf a1 00 0c stmw r29,12(r1)
#include <stdlib.h>
static uintptr_t align_up(uintptr_t alignment, uintptr_t value)
{
uintptr_t excess = value % alignment;
ffc09650: 7f c4 53 96 divwu r30,r4,r10
uintptr_t area_size,
uintptr_t alignment,
rtems_rbheap_extend_descriptors extend_descriptors,
void *handler_arg
)
{
ffc09654: 90 01 00 1c stw r0,28(r1)
#include <stdlib.h>
static uintptr_t align_up(uintptr_t alignment, uintptr_t value)
{
uintptr_t excess = value % alignment;
ffc09658: 7f de 51 d6 mullw r30,r30,r10
ffc0965c: 7c 7f 1b 78 mr r31,r3
if (excess > 0) {
ffc09660: 7d 3e 20 51 subf. r9,r30,r4
ffc09664: 41 82 00 e8 beq- ffc0974c <rtems_rbheap_initialize+0x114>
uintptr_t begin = (uintptr_t) area_begin;
uintptr_t end = begin + area_size;
uintptr_t aligned_begin = align_up(alignment, begin);
uintptr_t aligned_end = align_down(alignment, end);
if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) {
ffc09668: 7f 84 28 40 cmplw cr7,r4,r5
static uintptr_t align_up(uintptr_t alignment, uintptr_t value)
{
uintptr_t excess = value % alignment;
if (excess > 0) {
value += alignment - excess;
ffc0966c: 7f ca 22 14 add r30,r10,r4
ffc09670: 7f c9 f0 50 subf r30,r9,r30
insert_into_tree(chunk_tree, first);
} else {
sc = RTEMS_NO_MEMORY;
}
} else {
sc = RTEMS_INVALID_ADDRESS;
ffc09674: 39 20 00 09 li r9,9
uintptr_t begin = (uintptr_t) area_begin;
uintptr_t end = begin + area_size;
uintptr_t aligned_begin = align_up(alignment, begin);
uintptr_t aligned_end = align_down(alignment, end);
if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) {
ffc09678: 40 bc 00 e0 bge+ cr7,ffc09758 <rtems_rbheap_initialize+0x120>
ffc0967c: 7f 84 f0 40 cmplw cr7,r4,r30
ffc09680: 41 bd 00 d8 bgt+ cr7,ffc09758 <rtems_rbheap_initialize+0x120><== NEVER TAKEN
ffc09684: 48 00 00 08 b ffc0968c <rtems_rbheap_initialize+0x54>
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (alignment > 0) {
uintptr_t begin = (uintptr_t) area_begin;
ffc09688: 7c 9e 23 78 mr r30,r4
return value;
}
static uintptr_t align_down(uintptr_t alignment, uintptr_t value)
{
uintptr_t excess = value % alignment;
ffc0968c: 7c a5 53 96 divwu r5,r5,r10
return value - excess;
ffc09690: 7f a5 51 d6 mullw r29,r5,r10
insert_into_tree(chunk_tree, first);
} else {
sc = RTEMS_NO_MEMORY;
}
} else {
sc = RTEMS_INVALID_ADDRESS;
ffc09694: 39 20 00 09 li r9,9
uintptr_t begin = (uintptr_t) area_begin;
uintptr_t end = begin + area_size;
uintptr_t aligned_begin = align_up(alignment, begin);
uintptr_t aligned_end = align_down(alignment, end);
if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) {
ffc09698: 7f 9e e8 40 cmplw cr7,r30,r29
ffc0969c: 40 bc 00 bc bge+ cr7,ffc09758 <rtems_rbheap_initialize+0x120>
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
ffc096a0: 39 3f 00 04 addi r9,r31,4
head->next = tail;
head->previous = NULL;
tail->previous = head;
ffc096a4: 93 ff 00 08 stw r31,8(r31)
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
ffc096a8: 38 df 00 0c addi r6,r31,12
head->next = tail;
ffc096ac: 91 3f 00 00 stw r9,0(r31)
head->previous = NULL;
ffc096b0: 39 20 00 00 li r9,0
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
ffc096b4: 38 bf 00 10 addi r5,r31,16
head->next = tail;
head->previous = NULL;
ffc096b8: 91 3f 00 04 stw r9,4(r31)
rtems_rbtree_initialize_empty(chunk_tree, chunk_compare, true);
control->alignment = alignment;
control->handler_arg = handler_arg;
control->extend_descriptors = extend_descriptors;
first = get_chunk(control);
ffc096bc: 7f e3 fb 78 mr r3,r31
ffc096c0: 91 3f 00 10 stw r9,16(r31)
RBTree_Control *the_rbtree,
RBTree_Compare_function compare_function,
bool is_unique
)
{
the_rbtree->permanent_null = NULL;
ffc096c4: 91 3f 00 18 stw r9,24(r31)
the_rbtree->root = NULL;
ffc096c8: 91 3f 00 1c stw r9,28(r31)
the_rbtree->first[0] = NULL;
ffc096cc: 91 3f 00 20 stw r9,32(r31)
the_rbtree->first[1] = NULL;
ffc096d0: 91 3f 00 24 stw r9,36(r31)
the_rbtree->compare_function = compare_function;
ffc096d4: 3d 20 ff c1 lis r9,-63
ffc096d8: 39 29 95 2c addi r9,r9,-27348
ffc096dc: 91 3f 00 28 stw r9,40(r31)
the_rbtree->is_unique = is_unique;
ffc096e0: 39 20 00 01 li r9,1
ffc096e4: 99 3f 00 2c stb r9,44(r31)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc096e8: 90 bf 00 0c stw r5,12(r31)
head->previous = NULL;
tail->previous = head;
ffc096ec: 90 df 00 14 stw r6,20(r31)
rtems_rbheap_chunk *first = NULL;
rtems_chain_initialize_empty(free_chain);
rtems_chain_initialize_empty(&control->spare_descriptor_chain);
rtems_rbtree_initialize_empty(chunk_tree, chunk_compare, true);
control->alignment = alignment;
ffc096f0: 91 5f 00 30 stw r10,48(r31)
control->handler_arg = handler_arg;
ffc096f4: 91 1f 00 38 stw r8,56(r31)
control->extend_descriptors = extend_descriptors;
ffc096f8: 90 ff 00 34 stw r7,52(r31)
first = get_chunk(control);
ffc096fc: 4b ff fe c9 bl ffc095c4 <get_chunk>
first->begin = aligned_begin;
first->size = aligned_end - aligned_begin;
add_to_chain(free_chain, first);
insert_into_tree(chunk_tree, first);
} else {
sc = RTEMS_NO_MEMORY;
ffc09700: 39 20 00 1a li r9,26
control->alignment = alignment;
control->handler_arg = handler_arg;
control->extend_descriptors = extend_descriptors;
first = get_chunk(control);
if (first != NULL) {
ffc09704: 7c 64 1b 79 mr. r4,r3
ffc09708: 41 82 00 50 beq- ffc09758 <rtems_rbheap_initialize+0x120>
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
ffc0970c: 81 3f 00 00 lwz r9,0(r31)
static void insert_into_tree(
rtems_rbtree_control *tree,
rtems_rbheap_chunk *chunk
)
{
_RBTree_Insert_unprotected(tree, &chunk->tree_node);
ffc09710: 38 7f 00 18 addi r3,r31,24
control->handler_arg = handler_arg;
control->extend_descriptors = extend_descriptors;
first = get_chunk(control);
if (first != NULL) {
first->begin = aligned_begin;
ffc09714: 93 c4 00 18 stw r30,24(r4)
first->size = aligned_end - aligned_begin;
ffc09718: 7f de e8 50 subf r30,r30,r29
ffc0971c: 93 c4 00 1c stw r30,28(r4)
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
ffc09720: 93 e4 00 04 stw r31,4(r4)
before_node = after_node->next;
after_node->next = the_node;
ffc09724: 90 9f 00 00 stw r4,0(r31)
the_node->next = before_node;
before_node->previous = the_node;
ffc09728: 90 89 00 04 stw r4,4(r9)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
ffc0972c: 91 24 00 00 stw r9,0(r4)
static void insert_into_tree(
rtems_rbtree_control *tree,
rtems_rbheap_chunk *chunk
)
{
_RBTree_Insert_unprotected(tree, &chunk->tree_node);
ffc09730: 38 84 00 08 addi r4,r4,8
ffc09734: 48 00 1b f5 bl ffc0b328 <_RBTree_Insert_unprotected>
uintptr_t alignment,
rtems_rbheap_extend_descriptors extend_descriptors,
void *handler_arg
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
ffc09738: 39 20 00 00 li r9,0
ffc0973c: 48 00 00 1c b ffc09758 <rtems_rbheap_initialize+0x120>
}
} else {
sc = RTEMS_INVALID_ADDRESS;
}
} else {
sc = RTEMS_INVALID_NUMBER;
ffc09740: 39 20 00 0a li r9,10
}
return sc;
}
ffc09744: 7d 23 4b 78 mr r3,r9
ffc09748: 4e 80 00 20 blr
uintptr_t begin = (uintptr_t) area_begin;
uintptr_t end = begin + area_size;
uintptr_t aligned_begin = align_up(alignment, begin);
uintptr_t aligned_end = align_down(alignment, end);
if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) {
ffc0974c: 7f 84 28 40 cmplw cr7,r4,r5
ffc09750: 41 bc ff 38 blt- cr7,ffc09688 <rtems_rbheap_initialize+0x50>
insert_into_tree(chunk_tree, first);
} else {
sc = RTEMS_NO_MEMORY;
}
} else {
sc = RTEMS_INVALID_ADDRESS;
ffc09754: 39 20 00 09 li r9,9
} else {
sc = RTEMS_INVALID_NUMBER;
}
return sc;
}
ffc09758: 39 61 00 18 addi r11,r1,24
ffc0975c: 7d 23 4b 78 mr r3,r9
ffc09760: 4b ff 76 10 b ffc00d70 <_restgpr_29_x>
ffc189f4 <rtems_signal_send>:
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
ffc189f4: 7c 2b 0b 78 mr r11,r1
ffc189f8: 94 21 ff e0 stwu r1,-32(r1)
ffc189fc: 7c 08 02 a6 mflr r0
ffc18a00: 48 01 6a 11 bl ffc2f410 <_savegpr_31>
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
ffc18a04: 7c 9f 23 79 mr. r31,r4
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
ffc18a08: 90 01 00 24 stw r0,36(r1)
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
ffc18a0c: 41 a2 00 a8 beq+ ffc18ab4 <rtems_signal_send+0xc0>
return RTEMS_INVALID_NUMBER;
the_thread = _Thread_Get( id, &location );
ffc18a10: 38 81 00 08 addi r4,r1,8
ffc18a14: 48 00 4d 55 bl ffc1d768 <_Thread_Get>
switch ( location ) {
ffc18a18: 81 21 00 08 lwz r9,8(r1)
ffc18a1c: 2f 89 00 00 cmpwi cr7,r9,0
ffc18a20: 40 9e 00 9c bne- cr7,ffc18abc <rtems_signal_send+0xc8>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
ffc18a24: 81 23 01 4c lwz r9,332(r3)
asr = &api->Signal;
if ( ! _ASR_Is_null_handler( asr->handler ) ) {
ffc18a28: 81 49 00 0c lwz r10,12(r9)
ffc18a2c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc18a30: 41 9e 00 78 beq- cr7,ffc18aa8 <rtems_signal_send+0xb4>
if ( asr->is_enabled ) {
ffc18a34: 89 49 00 08 lbz r10,8(r9)
ffc18a38: 2f 8a 00 00 cmpwi cr7,r10,0
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc18a3c: 7d 00 00 a6 mfmsr r8
ffc18a40: 7d 50 42 a6 mfsprg r10,0
ffc18a44: 7d 0a 50 78 andc r10,r8,r10
ffc18a48: 7d 40 01 24 mtmsr r10
ffc18a4c: 41 9e 00 40 beq- cr7,ffc18a8c <rtems_signal_send+0x98>
)
{
ISR_Level _level;
_ISR_Disable( _level );
*signal_set |= signals;
ffc18a50: 81 49 00 14 lwz r10,20(r9)
ffc18a54: 7d 5f fb 78 or r31,r10,r31
ffc18a58: 93 e9 00 14 stw r31,20(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc18a5c: 7d 00 01 24 mtmsr r8
_ASR_Post_signals( signal_set, &asr->signals_posted );
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
ffc18a60: 3d 20 00 00 lis r9,0
ffc18a64: 39 29 75 c0 addi r9,r9,30144
ffc18a68: 81 49 00 08 lwz r10,8(r9)
ffc18a6c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc18a70: 41 9e 00 2c beq- cr7,ffc18a9c <rtems_signal_send+0xa8>
ffc18a74: 81 49 00 10 lwz r10,16(r9)
ffc18a78: 7f 83 50 00 cmpw cr7,r3,r10
ffc18a7c: 40 be 00 20 bne+ cr7,ffc18a9c <rtems_signal_send+0xa8> <== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc18a80: 39 40 00 01 li r10,1
ffc18a84: 99 49 00 0c stb r10,12(r9)
ffc18a88: 48 00 00 14 b ffc18a9c <rtems_signal_send+0xa8>
ffc18a8c: 81 49 00 18 lwz r10,24(r9)
ffc18a90: 7d 5f fb 78 or r31,r10,r31
ffc18a94: 93 e9 00 18 stw r31,24(r9)
ffc18a98: 7d 00 01 24 mtmsr r8
} else {
_ASR_Post_signals( signal_set, &asr->signals_pending );
}
_Thread_Enable_dispatch();
ffc18a9c: 48 00 4c b1 bl ffc1d74c <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc18aa0: 38 60 00 00 li r3,0
ffc18aa4: 48 00 00 1c b ffc18ac0 <rtems_signal_send+0xcc>
}
_Thread_Enable_dispatch();
ffc18aa8: 48 00 4c a5 bl ffc1d74c <_Thread_Enable_dispatch>
return RTEMS_NOT_DEFINED;
ffc18aac: 38 60 00 0b li r3,11
ffc18ab0: 48 00 00 10 b ffc18ac0 <rtems_signal_send+0xcc>
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
return RTEMS_INVALID_NUMBER;
ffc18ab4: 38 60 00 0a li r3,10
ffc18ab8: 48 00 00 08 b ffc18ac0 <rtems_signal_send+0xcc>
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc18abc: 38 60 00 04 li r3,4
}
ffc18ac0: 39 61 00 20 addi r11,r1,32
ffc18ac4: 4b ff 58 f8 b ffc0e3bc <_restgpr_31_x>
ffc1210c <rtems_task_mode>:
ASR_Information *asr;
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
ffc1210c: 7c a6 2b 79 mr. r6,r5
rtems_status_code rtems_task_mode(
rtems_mode mode_set,
rtems_mode mask,
rtems_mode *previous_mode_set
)
{
ffc12110: 94 21 ff f8 stwu r1,-8(r1)
ffc12114: 7c 08 02 a6 mflr r0
ffc12118: 90 01 00 0c stw r0,12(r1)
ASR_Information *asr;
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
ffc1211c: 41 82 01 7c beq- ffc12298 <rtems_task_mode+0x18c>
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
ffc12120: 3d 20 00 00 lis r9,0
ffc12124: 81 49 32 10 lwz r10,12816(r9)
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
ffc12128: 80 ea 00 78 lwz r7,120(r10)
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
ffc1212c: 89 0a 00 70 lbz r8,112(r10)
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
ffc12130: 2f 87 00 00 cmpwi cr7,r7,0
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
ffc12134: 81 2a 01 4c lwz r9,332(r10)
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
ffc12138: 7d 08 00 34 cntlzw r8,r8
ffc1213c: 55 08 d9 7e rlwinm r8,r8,27,5,31
ffc12140: 55 08 40 2e rlwinm r8,r8,8,0,23
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
ffc12144: 41 9e 00 08 beq- cr7,ffc1214c <rtems_task_mode+0x40>
old_mode |= RTEMS_NO_TIMESLICE;
else
old_mode |= RTEMS_TIMESLICE;
ffc12148: 61 08 02 00 ori r8,r8,512
old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR;
ffc1214c: 88 e9 00 08 lbz r7,8(r9)
ffc12150: 7c e7 00 34 cntlzw r7,r7
ffc12154: 54 e7 d9 7e rlwinm r7,r7,27,5,31
ffc12158: 54 e7 50 2a rlwinm r7,r7,10,0,21
ffc1215c: 7c e7 43 78 or r7,r7,r8
#ifndef ASM
static inline uint32_t _CPU_ISR_Get_level( void )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc12160: 39 00 00 00 li r8,0
ffc12164: 7d 00 00 a6 mfmsr r8
if (msr & MSR_EE) return 0;
ffc12168: 69 08 80 00 xori r8,r8,32768
ffc1216c: 55 05 8f fe rlwinm r5,r8,17,31,31
old_mode |= _ISR_Get_level();
ffc12170: 7c e8 2b 78 or r8,r7,r5
*previous_mode_set = old_mode;
ffc12174: 91 06 00 00 stw r8,0(r6)
/*
* These are generic thread scheduling characteristics.
*/
if ( mask & RTEMS_PREEMPT_MASK )
ffc12178: 70 88 01 00 andi. r8,r4,256
ffc1217c: 41 82 00 10 beq- ffc1218c <rtems_task_mode+0x80>
*/
RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt (
Modes_Control mode_set
)
{
return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT;
ffc12180: 68 68 01 00 xori r8,r3,256
ffc12184: 55 08 c7 fe rlwinm r8,r8,24,31,31
executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false;
ffc12188: 99 0a 00 70 stb r8,112(r10)
if ( mask & RTEMS_TIMESLICE_MASK ) {
ffc1218c: 70 88 02 00 andi. r8,r4,512
ffc12190: 41 82 00 28 beq- ffc121b8 <rtems_task_mode+0xac>
if ( _Modes_Is_timeslice(mode_set) ) {
ffc12194: 70 68 02 00 andi. r8,r3,512
ffc12198: 41 82 00 1c beq- ffc121b4 <rtems_task_mode+0xa8>
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
ffc1219c: 39 00 00 01 li r8,1
ffc121a0: 91 0a 00 78 stw r8,120(r10)
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc121a4: 3d 00 00 00 lis r8,0
ffc121a8: 81 08 28 1c lwz r8,10268(r8)
ffc121ac: 91 0a 00 74 stw r8,116(r10)
ffc121b0: 48 00 00 08 b ffc121b8 <rtems_task_mode+0xac>
} else
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
ffc121b4: 91 0a 00 78 stw r8,120(r10)
}
/*
* Set the new interrupt level
*/
if ( mask & RTEMS_INTERRUPT_MASK )
ffc121b8: 70 8a 00 01 andi. r10,r4,1
ffc121bc: 41 a2 00 28 beq+ ffc121e4 <rtems_task_mode+0xd8>
}
static inline void _CPU_ISR_Set_level( uint32_t level )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc121c0: 39 40 00 00 li r10,0
ffc121c4: 7d 40 00 a6 mfmsr r10
if (!(level & CPU_MODES_INTERRUPT_MASK)) {
ffc121c8: 70 68 00 01 andi. r8,r3,1
static inline uint32_t ppc_interrupt_get_disable_mask( void )
{
uint32_t mask;
__asm__ volatile (
ffc121cc: 7d 10 42 a6 mfsprg r8,0
ffc121d0: 40 a2 00 0c bne+ ffc121dc <rtems_task_mode+0xd0>
msr |= ppc_interrupt_get_disable_mask();
ffc121d4: 7d 0a 53 78 or r10,r8,r10
ffc121d8: 48 00 00 08 b ffc121e0 <rtems_task_mode+0xd4>
}
else {
msr &= ~ppc_interrupt_get_disable_mask();
ffc121dc: 7d 4a 40 78 andc r10,r10,r8
}
_CPU_MSR_SET(msr);
ffc121e0: 7d 40 01 24 mtmsr r10
* This is specific to the RTEMS API
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
ffc121e4: 70 8a 04 00 andi. r10,r4,1024
/*
* This is specific to the RTEMS API
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
ffc121e8: 38 e0 00 00 li r7,0
if ( mask & RTEMS_ASR_MASK ) {
ffc121ec: 41 82 00 50 beq- ffc1223c <rtems_task_mode+0x130>
is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true;
ffc121f0: 68 63 04 00 xori r3,r3,1024
if ( is_asr_enabled != asr->is_enabled ) {
ffc121f4: 89 49 00 08 lbz r10,8(r9)
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true;
ffc121f8: 54 63 b7 fe rlwinm r3,r3,22,31,31
if ( is_asr_enabled != asr->is_enabled ) {
ffc121fc: 7f 8a 18 00 cmpw cr7,r10,r3
ffc12200: 41 9e 00 3c beq- cr7,ffc1223c <rtems_task_mode+0x130>
asr->is_enabled = is_asr_enabled;
ffc12204: 98 69 00 08 stb r3,8(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc12208: 7d 00 00 a6 mfmsr r8
ffc1220c: 7d 50 42 a6 mfsprg r10,0
ffc12210: 7d 0a 50 78 andc r10,r8,r10
ffc12214: 7d 40 01 24 mtmsr r10
{
rtems_signal_set _signals;
ISR_Level _level;
_ISR_Disable( _level );
_signals = information->signals_pending;
ffc12218: 80 e9 00 18 lwz r7,24(r9)
information->signals_pending = information->signals_posted;
ffc1221c: 81 49 00 14 lwz r10,20(r9)
information->signals_posted = _signals;
ffc12220: 90 e9 00 14 stw r7,20(r9)
rtems_signal_set _signals;
ISR_Level _level;
_ISR_Disable( _level );
_signals = information->signals_pending;
information->signals_pending = information->signals_posted;
ffc12224: 91 49 00 18 stw r10,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc12228: 7d 00 01 24 mtmsr r8
_ASR_Swap_signals( asr );
if ( _ASR_Are_signals_pending( asr ) ) {
ffc1222c: 81 29 00 14 lwz r9,20(r9)
ffc12230: 7d 29 00 34 cntlzw r9,r9
ffc12234: 55 29 d9 7e rlwinm r9,r9,27,5,31
ffc12238: 69 27 00 01 xori r7,r9,1
needs_asr_dispatching = true;
}
}
}
if ( _System_state_Is_up( _System_state_Get() ) ) {
ffc1223c: 3d 20 00 00 lis r9,0
ffc12240: 81 29 28 48 lwz r9,10312(r9)
if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) )
_Thread_Dispatch();
}
return RTEMS_SUCCESSFUL;
ffc12244: 38 60 00 00 li r3,0
needs_asr_dispatching = true;
}
}
}
if ( _System_state_Is_up( _System_state_Get() ) ) {
ffc12248: 2f 89 00 03 cmpwi cr7,r9,3
ffc1224c: 40 be 00 50 bne+ cr7,ffc1229c <rtems_task_mode+0x190>
{
Thread_Control *executing;
executing = _Thread_Executing;
if ( are_signals_pending ||
ffc12250: 2f 87 00 00 cmpwi cr7,r7,0
bool are_signals_pending
)
{
Thread_Control *executing;
executing = _Thread_Executing;
ffc12254: 3d 00 00 00 lis r8,0
ffc12258: 39 08 32 00 addi r8,r8,12800
ffc1225c: 81 48 00 10 lwz r10,16(r8)
if ( are_signals_pending ||
ffc12260: 40 9e 00 1c bne- cr7,ffc1227c <rtems_task_mode+0x170>
ffc12264: 81 28 00 14 lwz r9,20(r8)
ffc12268: 7f 8a 48 00 cmpw cr7,r10,r9
ffc1226c: 41 9e 00 30 beq- cr7,ffc1229c <rtems_task_mode+0x190>
(!_Thread_Is_heir( executing ) && executing->is_preemptible) ) {
ffc12270: 89 2a 00 70 lbz r9,112(r10)
ffc12274: 2f 89 00 00 cmpwi cr7,r9,0
ffc12278: 41 9e 00 24 beq- cr7,ffc1229c <rtems_task_mode+0x190> <== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc1227c: 3d 20 00 00 lis r9,0
ffc12280: 39 40 00 01 li r10,1
ffc12284: 39 29 32 00 addi r9,r9,12800
ffc12288: 99 49 00 0c stb r10,12(r9)
if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) )
_Thread_Dispatch();
ffc1228c: 4b ff 9f a5 bl ffc0c230 <_Thread_Dispatch>
}
return RTEMS_SUCCESSFUL;
ffc12290: 38 60 00 00 li r3,0
ffc12294: 48 00 00 08 b ffc1229c <rtems_task_mode+0x190>
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
ffc12298: 38 60 00 09 li r3,9
if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) )
_Thread_Dispatch();
}
return RTEMS_SUCCESSFUL;
}
ffc1229c: 80 01 00 0c lwz r0,12(r1)
ffc122a0: 38 21 00 08 addi r1,r1,8
ffc122a4: 7c 08 03 a6 mtlr r0
ffc122a8: 4e 80 00 20 blr
ffc0cfdc <rtems_task_set_priority>:
rtems_status_code rtems_task_set_priority(
rtems_id id,
rtems_task_priority new_priority,
rtems_task_priority *old_priority
)
{
ffc0cfdc: 94 21 ff e0 stwu r1,-32(r1)
ffc0cfe0: 7c 08 02 a6 mflr r0
ffc0cfe4: bf c1 00 18 stmw r30,24(r1)
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0cfe8: 7c 9f 23 79 mr. r31,r4
rtems_status_code rtems_task_set_priority(
rtems_id id,
rtems_task_priority new_priority,
rtems_task_priority *old_priority
)
{
ffc0cfec: 7c be 2b 78 mr r30,r5
ffc0cff0: 90 01 00 24 stw r0,36(r1)
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0cff4: 41 82 00 18 beq- ffc0d00c <rtems_task_set_priority+0x30>
RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid (
rtems_task_priority the_priority
)
{
return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) &&
( the_priority <= RTEMS_MAXIMUM_PRIORITY ) );
ffc0cff8: 3d 20 00 00 lis r9,0
ffc0cffc: 89 49 27 64 lbz r10,10084(r9)
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
ffc0d000: 39 20 00 13 li r9,19
)
{
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0d004: 7f 9f 50 40 cmplw cr7,r31,r10
ffc0d008: 41 bd 00 6c bgt+ cr7,ffc0d074 <rtems_task_set_priority+0x98>
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
ffc0d00c: 2f 9e 00 00 cmpwi cr7,r30,0
return RTEMS_INVALID_ADDRESS;
ffc0d010: 39 20 00 09 li r9,9
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
ffc0d014: 41 9e 00 60 beq- cr7,ffc0d074 <rtems_task_set_priority+0x98>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get( id, &location );
ffc0d018: 38 81 00 08 addi r4,r1,8
ffc0d01c: 48 00 26 a1 bl ffc0f6bc <_Thread_Get>
switch ( location ) {
ffc0d020: 81 21 00 08 lwz r9,8(r1)
ffc0d024: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d028: 40 9e 00 48 bne- cr7,ffc0d070 <rtems_task_set_priority+0x94>
case OBJECTS_LOCAL:
/* XXX need helper to "convert" from core priority */
*old_priority = the_thread->current_priority;
if ( new_priority != RTEMS_CURRENT_PRIORITY ) {
ffc0d02c: 2f 9f 00 00 cmpwi cr7,r31,0
the_thread = _Thread_Get( id, &location );
switch ( location ) {
case OBJECTS_LOCAL:
/* XXX need helper to "convert" from core priority */
*old_priority = the_thread->current_priority;
ffc0d030: 81 23 00 14 lwz r9,20(r3)
ffc0d034: 91 3e 00 00 stw r9,0(r30)
if ( new_priority != RTEMS_CURRENT_PRIORITY ) {
ffc0d038: 41 9e 00 2c beq- cr7,ffc0d064 <rtems_task_set_priority+0x88>
the_thread->real_priority = new_priority;
if ( the_thread->resource_count == 0 ||
ffc0d03c: 81 23 00 1c lwz r9,28(r3)
case OBJECTS_LOCAL:
/* XXX need helper to "convert" from core priority */
*old_priority = the_thread->current_priority;
if ( new_priority != RTEMS_CURRENT_PRIORITY ) {
the_thread->real_priority = new_priority;
ffc0d040: 93 e3 00 18 stw r31,24(r3)
if ( the_thread->resource_count == 0 ||
ffc0d044: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d048: 41 9e 00 10 beq- cr7,ffc0d058 <rtems_task_set_priority+0x7c>
ffc0d04c: 81 23 00 14 lwz r9,20(r3)
ffc0d050: 7f 89 f8 40 cmplw cr7,r9,r31
ffc0d054: 40 9d 00 10 ble- cr7,ffc0d064 <rtems_task_set_priority+0x88><== ALWAYS TAKEN
the_thread->current_priority > new_priority )
_Thread_Change_priority( the_thread, new_priority, false );
ffc0d058: 7f e4 fb 78 mr r4,r31
ffc0d05c: 38 a0 00 00 li r5,0
ffc0d060: 48 00 20 fd bl ffc0f15c <_Thread_Change_priority>
}
_Thread_Enable_dispatch();
ffc0d064: 48 00 26 3d bl ffc0f6a0 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc0d068: 39 20 00 00 li r9,0
ffc0d06c: 48 00 00 08 b ffc0d074 <rtems_task_set_priority+0x98>
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc0d070: 39 20 00 04 li r9,4
}
ffc0d074: 39 61 00 20 addi r11,r1,32
ffc0d078: 7d 23 4b 78 mr r3,r9
ffc0d07c: 4b ff 40 d0 b ffc0114c <_restgpr_30_x>
ffc1955c <rtems_timer_cancel>:
*/
rtems_status_code rtems_timer_cancel(
rtems_id id
)
{
ffc1955c: 94 21 ff e8 stwu r1,-24(r1)
ffc19560: 7c 08 02 a6 mflr r0
ffc19564: 7c 64 1b 78 mr r4,r3
RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Timer_Control *)
ffc19568: 3c 60 00 00 lis r3,0
ffc1956c: 90 01 00 1c stw r0,28(r1)
ffc19570: 38 63 7a 1c addi r3,r3,31260
ffc19574: 38 a1 00 08 addi r5,r1,8
ffc19578: 48 00 32 e9 bl ffc1c860 <_Objects_Get>
Timer_Control *the_timer;
Objects_Locations location;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
ffc1957c: 81 21 00 08 lwz r9,8(r1)
ffc19580: 2f 89 00 00 cmpwi cr7,r9,0
ffc19584: 40 9e 00 24 bne- cr7,ffc195a8 <rtems_timer_cancel+0x4c>
case OBJECTS_LOCAL:
if ( !_Timer_Is_dormant_class( the_timer->the_class ) )
ffc19588: 81 23 00 38 lwz r9,56(r3)
ffc1958c: 2f 89 00 04 cmpwi cr7,r9,4
ffc19590: 41 9e 00 0c beq- cr7,ffc1959c <rtems_timer_cancel+0x40> <== NEVER TAKEN
(void) _Watchdog_Remove( &the_timer->Ticker );
ffc19594: 38 63 00 10 addi r3,r3,16
ffc19598: 48 00 52 79 bl ffc1e810 <_Watchdog_Remove>
_Thread_Enable_dispatch();
ffc1959c: 48 00 41 b1 bl ffc1d74c <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc195a0: 38 60 00 00 li r3,0
ffc195a4: 48 00 00 08 b ffc195ac <rtems_timer_cancel+0x50>
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc195a8: 38 60 00 04 li r3,4
}
ffc195ac: 80 01 00 1c lwz r0,28(r1)
ffc195b0: 38 21 00 18 addi r1,r1,24
ffc195b4: 7c 08 03 a6 mtlr r0
ffc195b8: 4e 80 00 20 blr
ffc19b24 <rtems_timer_server_fire_when>:
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
ffc19b24: 94 21 ff c8 stwu r1,-56(r1)
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
ffc19b28: 3d 20 00 00 lis r9,0
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
ffc19b2c: 7c 08 02 a6 mflr r0
ffc19b30: bf 01 00 18 stmw r24,24(r1)
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
ffc19b34: 83 c9 29 80 lwz r30,10624(r9)
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
ffc19b38: 90 01 00 3c stw r0,60(r1)
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
ffc19b3c: 2f 9e 00 00 cmpwi cr7,r30,0
ffc19b40: 41 9e 01 04 beq- cr7,ffc19c44 <rtems_timer_server_fire_when+0x120>
return RTEMS_INCORRECT_STATE;
if ( !_TOD.is_set )
ffc19b44: 3f a0 00 00 lis r29,0
ffc19b48: 3b bd 70 80 addi r29,r29,28800
ffc19b4c: 89 5d 00 14 lbz r10,20(r29)
ffc19b50: 7c 7b 1b 78 mr r27,r3
return RTEMS_NOT_DEFINED;
ffc19b54: 38 60 00 0b li r3,11
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
return RTEMS_INCORRECT_STATE;
if ( !_TOD.is_set )
ffc19b58: 2f 8a 00 00 cmpwi cr7,r10,0
ffc19b5c: 41 be 00 f0 beq+ cr7,ffc19c4c <rtems_timer_server_fire_when+0x128><== NEVER TAKEN
return RTEMS_NOT_DEFINED;
if ( !routine )
ffc19b60: 2f 85 00 00 cmpwi cr7,r5,0
ffc19b64: 7c ba 2b 78 mr r26,r5
return RTEMS_INVALID_ADDRESS;
ffc19b68: 38 60 00 09 li r3,9
return RTEMS_INCORRECT_STATE;
if ( !_TOD.is_set )
return RTEMS_NOT_DEFINED;
if ( !routine )
ffc19b6c: 41 9e 00 e0 beq- cr7,ffc19c4c <rtems_timer_server_fire_when+0x128>
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
ffc19b70: 7c 83 23 78 mr r3,r4
ffc19b74: 7c 9f 23 78 mr r31,r4
ffc19b78: 7c d8 33 78 mr r24,r6
ffc19b7c: 4b ff c9 01 bl ffc1647c <_TOD_Validate>
ffc19b80: 2f 83 00 00 cmpwi cr7,r3,0
ffc19b84: 40 9e 00 0c bne- cr7,ffc19b90 <rtems_timer_server_fire_when+0x6c>
return RTEMS_INVALID_CLOCK;
ffc19b88: 38 60 00 14 li r3,20
ffc19b8c: 48 00 00 c0 b ffc19c4c <rtems_timer_server_fire_when+0x128>
seconds = _TOD_To_seconds( wall_time );
ffc19b90: 7f e3 fb 78 mr r3,r31
ffc19b94: 4b ff c8 45 bl ffc163d8 <_TOD_To_seconds>
ffc19b98: 80 9d 00 04 lwz r4,4(r29)
ffc19b9c: 7c 7c 1b 78 mr r28,r3
ffc19ba0: 80 7d 00 00 lwz r3,0(r29)
ffc19ba4: 3c c0 3b 9a lis r6,15258
ffc19ba8: 38 a0 00 00 li r5,0
ffc19bac: 60 c6 ca 00 ori r6,r6,51712
ffc19bb0: 48 01 48 d9 bl ffc2e488 <__divdi3>
if ( seconds <= _TOD_Seconds_since_epoch() )
ffc19bb4: 7f 9c 20 40 cmplw cr7,r28,r4
ffc19bb8: 40 9d ff d0 ble+ cr7,ffc19b88 <rtems_timer_server_fire_when+0x64>
ffc19bbc: 3c 60 00 00 lis r3,0
ffc19bc0: 38 63 7a 1c addi r3,r3,31260
ffc19bc4: 7f 64 db 78 mr r4,r27
ffc19bc8: 38 a1 00 08 addi r5,r1,8
ffc19bcc: 48 00 2c 95 bl ffc1c860 <_Objects_Get>
return RTEMS_INVALID_CLOCK;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
ffc19bd0: 83 21 00 08 lwz r25,8(r1)
ffc19bd4: 7c 7f 1b 78 mr r31,r3
ffc19bd8: 2f 99 00 00 cmpwi cr7,r25,0
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc19bdc: 38 60 00 04 li r3,4
seconds = _TOD_To_seconds( wall_time );
if ( seconds <= _TOD_Seconds_since_epoch() )
return RTEMS_INVALID_CLOCK;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
ffc19be0: 40 9e 00 6c bne- cr7,ffc19c4c <rtems_timer_server_fire_when+0x128>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
ffc19be4: 38 7f 00 10 addi r3,r31,16
ffc19be8: 48 00 4c 29 bl ffc1e810 <_Watchdog_Remove>
the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK;
ffc19bec: 39 20 00 03 li r9,3
ffc19bf0: 91 3f 00 38 stw r9,56(r31)
ffc19bf4: 3c c0 3b 9a lis r6,15258
ffc19bf8: 38 a0 00 00 li r5,0
ffc19bfc: 80 7d 00 00 lwz r3,0(r29)
ffc19c00: 60 c6 ca 00 ori r6,r6,51712
ffc19c04: 80 9d 00 04 lwz r4,4(r29)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc19c08: 93 3f 00 18 stw r25,24(r31)
the_watchdog->routine = routine;
ffc19c0c: 93 5f 00 2c stw r26,44(r31)
the_watchdog->id = id;
ffc19c10: 93 7f 00 30 stw r27,48(r31)
the_watchdog->user_data = user_data;
ffc19c14: 93 1f 00 34 stw r24,52(r31)
ffc19c18: 48 01 48 71 bl ffc2e488 <__divdi3>
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
(*timer_server->schedule_operation)( timer_server, the_timer );
ffc19c1c: 81 3e 00 04 lwz r9,4(r30)
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK;
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
ffc19c20: 7c 84 e0 50 subf r4,r4,r28
(*timer_server->schedule_operation)( timer_server, the_timer );
ffc19c24: 7f c3 f3 78 mr r3,r30
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK;
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
ffc19c28: 90 9f 00 1c stw r4,28(r31)
(*timer_server->schedule_operation)( timer_server, the_timer );
ffc19c2c: 7d 29 03 a6 mtctr r9
ffc19c30: 7f e4 fb 78 mr r4,r31
ffc19c34: 4e 80 04 21 bctrl
_Thread_Enable_dispatch();
ffc19c38: 48 00 3b 15 bl ffc1d74c <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc19c3c: 38 60 00 00 li r3,0
ffc19c40: 48 00 00 0c b ffc19c4c <rtems_timer_server_fire_when+0x128>
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
return RTEMS_INCORRECT_STATE;
ffc19c44: 38 60 00 0e li r3,14
ffc19c48: 48 00 00 04 b ffc19c4c <rtems_timer_server_fire_when+0x128>
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
ffc19c4c: 39 61 00 38 addi r11,r1,56
ffc19c50: 4b ff 47 50 b ffc0e3a0 <_restgpr_24_x>
ffc08c1c <sched_get_priority_max>:
int sched_get_priority_max(
int policy
)
{
switch ( policy ) {
ffc08c1c: 2b 83 00 04 cmplwi cr7,r3,4
#include <rtems/posix/priority.h>
int sched_get_priority_max(
int policy
)
{
ffc08c20: 94 21 ff f8 stwu r1,-8(r1)
ffc08c24: 7c 08 02 a6 mflr r0
ffc08c28: 90 01 00 0c stw r0,12(r1)
switch ( policy ) {
ffc08c2c: 41 9d 00 14 bgt- cr7,ffc08c40 <sched_get_priority_max+0x24>
ffc08c30: 39 20 00 01 li r9,1
ffc08c34: 7d 23 18 30 slw r3,r9,r3
ffc08c38: 70 69 00 17 andi. r9,r3,23
ffc08c3c: 40 82 00 18 bne- ffc08c54 <sched_get_priority_max+0x38> <== ALWAYS TAKEN
case SCHED_RR:
case SCHED_SPORADIC:
break;
default:
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08c40: 48 00 82 21 bl ffc10e60 <__errno>
ffc08c44: 39 20 00 16 li r9,22
ffc08c48: 91 23 00 00 stw r9,0(r3)
ffc08c4c: 38 60 ff ff li r3,-1
ffc08c50: 48 00 00 10 b ffc08c60 <sched_get_priority_max+0x44>
}
return POSIX_SCHEDULER_MAXIMUM_PRIORITY;
ffc08c54: 3d 20 00 00 lis r9,0
ffc08c58: 88 69 27 84 lbz r3,10116(r9)
ffc08c5c: 38 63 ff ff addi r3,r3,-1
}
ffc08c60: 80 01 00 0c lwz r0,12(r1)
ffc08c64: 38 21 00 08 addi r1,r1,8
ffc08c68: 7c 08 03 a6 mtlr r0
ffc08c6c: 4e 80 00 20 blr
ffc08c70 <sched_get_priority_min>:
*/
int sched_get_priority_min(
int policy
)
{
switch ( policy ) {
ffc08c70: 2b 83 00 04 cmplwi cr7,r3,4
* 13.3.6 Get Scheduling Parameter Limits, P1003.1b-1993, p. 258
*/
int sched_get_priority_min(
int policy
)
{
ffc08c74: 94 21 ff f8 stwu r1,-8(r1)
ffc08c78: 7c 08 02 a6 mflr r0
ffc08c7c: 90 01 00 0c stw r0,12(r1)
switch ( policy ) {
ffc08c80: 41 9d 00 18 bgt- cr7,ffc08c98 <sched_get_priority_min+0x28>
ffc08c84: 39 20 00 01 li r9,1
ffc08c88: 7d 29 18 30 slw r9,r9,r3
ffc08c8c: 71 2a 00 17 andi. r10,r9,23
default:
rtems_set_errno_and_return_minus_one( EINVAL );
}
return POSIX_SCHEDULER_MINIMUM_PRIORITY;
ffc08c90: 38 60 00 01 li r3,1
*/
int sched_get_priority_min(
int policy
)
{
switch ( policy ) {
ffc08c94: 40 82 00 14 bne- ffc08ca8 <sched_get_priority_min+0x38> <== ALWAYS TAKEN
case SCHED_RR:
case SCHED_SPORADIC:
break;
default:
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08c98: 48 00 81 c9 bl ffc10e60 <__errno>
ffc08c9c: 39 20 00 16 li r9,22
ffc08ca0: 91 23 00 00 stw r9,0(r3)
ffc08ca4: 38 60 ff ff li r3,-1
}
return POSIX_SCHEDULER_MINIMUM_PRIORITY;
}
ffc08ca8: 80 01 00 0c lwz r0,12(r1)
ffc08cac: 38 21 00 08 addi r1,r1,8
ffc08cb0: 7c 08 03 a6 mtlr r0
ffc08cb4: 4e 80 00 20 blr
ffc08cb8 <sched_rr_get_interval>:
int sched_rr_get_interval(
pid_t pid,
struct timespec *interval
)
{
ffc08cb8: 7c 2b 0b 78 mr r11,r1
ffc08cbc: 94 21 ff e8 stwu r1,-24(r1)
ffc08cc0: 7c 08 02 a6 mflr r0
ffc08cc4: 48 01 3a 41 bl ffc1c704 <_savegpr_31>
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid && pid != getpid() )
ffc08cc8: 7c 7f 1b 79 mr. r31,r3
int sched_rr_get_interval(
pid_t pid,
struct timespec *interval
)
{
ffc08ccc: 90 01 00 1c stw r0,28(r1)
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid && pid != getpid() )
ffc08cd0: 41 a2 00 24 beq+ ffc08cf4 <sched_rr_get_interval+0x3c> <== NEVER TAKEN
ffc08cd4: 90 81 00 08 stw r4,8(r1)
ffc08cd8: 4b ff bc 41 bl ffc04918 <getpid>
ffc08cdc: 7f 9f 18 00 cmpw cr7,r31,r3
ffc08ce0: 80 81 00 08 lwz r4,8(r1)
ffc08ce4: 41 be 00 10 beq+ cr7,ffc08cf4 <sched_rr_get_interval+0x3c>
rtems_set_errno_and_return_minus_one( ESRCH );
ffc08ce8: 48 00 81 79 bl ffc10e60 <__errno>
ffc08cec: 39 20 00 03 li r9,3
ffc08cf0: 48 00 00 14 b ffc08d04 <sched_rr_get_interval+0x4c>
if ( !interval )
ffc08cf4: 2f 84 00 00 cmpwi cr7,r4,0
ffc08cf8: 40 be 00 18 bne+ cr7,ffc08d10 <sched_rr_get_interval+0x58>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08cfc: 48 00 81 65 bl ffc10e60 <__errno>
ffc08d00: 39 20 00 16 li r9,22
ffc08d04: 91 23 00 00 stw r9,0(r3)
ffc08d08: 38 60 ff ff li r3,-1
ffc08d0c: 48 00 00 14 b ffc08d20 <sched_rr_get_interval+0x68>
_Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval );
ffc08d10: 3d 20 00 00 lis r9,0
ffc08d14: 80 69 28 68 lwz r3,10344(r9)
ffc08d18: 48 00 3b e9 bl ffc0c900 <_Timespec_From_ticks>
return 0;
ffc08d1c: 38 60 00 00 li r3,0
}
ffc08d20: 39 61 00 18 addi r11,r1,24
ffc08d24: 4b ff 7e 8c b ffc00bb0 <_restgpr_31_x>
ffc0963c <sem_open>:
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc0963c: 3d 20 00 00 lis r9,0
int oflag,
...
/* mode_t mode, */
/* unsigned int value */
)
{
ffc09640: 94 21 ff b8 stwu r1,-72(r1)
ffc09644: 7c 08 02 a6 mflr r0
ffc09648: 81 49 28 a8 lwz r10,10408(r9)
ffc0964c: bf 41 00 30 stmw r26,48(r1)
ffc09650: 7c 7d 1b 78 mr r29,r3
++level;
ffc09654: 39 4a 00 01 addi r10,r10,1
ffc09658: 90 01 00 4c stw r0,76(r1)
ffc0965c: 7c 9f 23 78 mr r31,r4
ffc09660: 90 a1 00 28 stw r5,40(r1)
ffc09664: 90 c1 00 2c stw r6,44(r1)
_Thread_Dispatch_disable_level = level;
ffc09668: 91 49 28 a8 stw r10,10408(r9)
Objects_Locations location;
size_t name_len;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
ffc0966c: 70 9a 02 00 andi. r26,r4,512
/* unsigned int value */
)
{
va_list arg;
mode_t mode;
unsigned int value = 0;
ffc09670: 3b c0 00 00 li r30,0
Objects_Locations location;
size_t name_len;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
ffc09674: 41 a2 00 20 beq+ ffc09694 <sem_open+0x58>
va_start(arg, oflag);
ffc09678: 39 21 00 50 addi r9,r1,80
mode = va_arg( arg, mode_t );
value = va_arg( arg, unsigned int );
ffc0967c: 83 c1 00 2c lwz r30,44(r1)
size_t name_len;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
va_start(arg, oflag);
ffc09680: 91 21 00 0c stw r9,12(r1)
ffc09684: 39 21 00 20 addi r9,r1,32
ffc09688: 91 21 00 10 stw r9,16(r1)
mode = va_arg( arg, mode_t );
ffc0968c: 39 20 00 03 li r9,3
ffc09690: 99 21 00 08 stb r9,8(r1)
const char *name,
Objects_Id *id,
size_t *len
)
{
return _POSIX_Name_to_id( &_POSIX_Semaphore_Information, name, id, len );
ffc09694: 3f 80 00 00 lis r28,0
ffc09698: 3b 9c 59 00 addi r28,r28,22784
ffc0969c: 7f 83 e3 78 mr r3,r28
ffc096a0: 7f a4 eb 78 mr r4,r29
ffc096a4: 38 a1 00 20 addi r5,r1,32
ffc096a8: 38 c1 00 14 addi r6,r1,20
ffc096ac: 4b ff f9 99 bl ffc09044 <_POSIX_Name_to_id>
* and we can just return a pointer to the id. Otherwise we may
* need to check to see if this is a "semaphore does not exist"
* or some other miscellaneous error on the name.
*/
if ( status ) {
ffc096b0: 7c 7b 1b 79 mr. r27,r3
ffc096b4: 41 82 00 24 beq- ffc096d8 <sem_open+0x9c>
/*
* Unless provided a valid name that did not already exist
* and we are willing to create then it is an error.
*/
if ( !( status == ENOENT && (oflag & O_CREAT) ) ) {
ffc096b8: 2f 9b 00 02 cmpwi cr7,r27,2
ffc096bc: 40 9e 00 0c bne- cr7,ffc096c8 <sem_open+0x8c>
ffc096c0: 2f 9a 00 00 cmpwi cr7,r26,0
ffc096c4: 40 9e 00 60 bne- cr7,ffc09724 <sem_open+0xe8>
_Thread_Enable_dispatch();
ffc096c8: 48 00 38 01 bl ffc0cec8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one_cast( status, sem_t * );
ffc096cc: 48 00 8e 49 bl ffc12514 <__errno>
ffc096d0: 93 63 00 00 stw r27,0(r3)
ffc096d4: 48 00 00 84 b ffc09758 <sem_open+0x11c>
/*
* Check for existence with creation.
*/
if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) {
ffc096d8: 73 ff 0a 00 andi. r31,r31,2560
ffc096dc: 2f 9f 0a 00 cmpwi cr7,r31,2560
ffc096e0: 40 be 00 18 bne+ cr7,ffc096f8 <sem_open+0xbc>
_Thread_Enable_dispatch();
ffc096e4: 48 00 37 e5 bl ffc0cec8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * );
ffc096e8: 48 00 8e 2d bl ffc12514 <__errno>
ffc096ec: 39 20 00 11 li r9,17
ffc096f0: 91 23 00 00 stw r9,0(r3)
ffc096f4: 48 00 00 64 b ffc09758 <sem_open+0x11c>
RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Get (
sem_t *id,
Objects_Locations *location
)
{
return (POSIX_Semaphore_Control *)
ffc096f8: 80 81 00 20 lwz r4,32(r1)
ffc096fc: 38 a1 00 18 addi r5,r1,24
ffc09700: 7f 83 e3 78 mr r3,r28
ffc09704: 48 00 28 7d bl ffc0bf80 <_Objects_Get>
}
the_semaphore = _POSIX_Semaphore_Get( (sem_t *) &the_semaphore_id, &location );
the_semaphore->open_count += 1;
ffc09708: 81 23 00 18 lwz r9,24(r3)
if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) {
_Thread_Enable_dispatch();
rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * );
}
the_semaphore = _POSIX_Semaphore_Get( (sem_t *) &the_semaphore_id, &location );
ffc0970c: 90 61 00 1c stw r3,28(r1)
the_semaphore->open_count += 1;
ffc09710: 39 29 00 01 addi r9,r9,1
ffc09714: 91 23 00 18 stw r9,24(r3)
_Thread_Enable_dispatch();
ffc09718: 48 00 37 b1 bl ffc0cec8 <_Thread_Enable_dispatch>
_Thread_Enable_dispatch();
ffc0971c: 48 00 37 ad bl ffc0cec8 <_Thread_Enable_dispatch>
goto return_id;
ffc09720: 48 00 00 2c b ffc0974c <sem_open+0x110>
/*
* At this point, the semaphore does not exist and everything has been
* checked. We should go ahead and create a semaphore.
*/
status =_POSIX_Semaphore_Create_support(
ffc09724: 80 81 00 14 lwz r4,20(r1)
ffc09728: 38 a0 00 00 li r5,0
ffc0972c: 7f c6 f3 78 mr r6,r30
ffc09730: 38 e1 00 1c addi r7,r1,28
ffc09734: 7f a3 eb 78 mr r3,r29
ffc09738: 48 00 65 e1 bl ffc0fd18 <_POSIX_Semaphore_Create_support>
ffc0973c: 7c 7f 1b 78 mr r31,r3
/*
* errno was set by Create_support, so don't set it again.
*/
_Thread_Enable_dispatch();
ffc09740: 48 00 37 89 bl ffc0cec8 <_Thread_Enable_dispatch>
if ( status == -1 )
ffc09744: 2f 9f ff ff cmpwi cr7,r31,-1
ffc09748: 41 9e 00 10 beq- cr7,ffc09758 <sem_open+0x11c> <== NEVER TAKEN
return_id:
#if defined(RTEMS_USE_16_BIT_OBJECT)
the_semaphore->Semaphore_id = the_semaphore->Object.id;
return &the_semaphore->Semaphore_id;
#else
return (sem_t *)&the_semaphore->Object.id;
ffc0974c: 80 61 00 1c lwz r3,28(r1)
ffc09750: 38 63 00 08 addi r3,r3,8
ffc09754: 48 00 00 08 b ffc0975c <sem_open+0x120>
*/
_Thread_Enable_dispatch();
if ( status == -1 )
return SEM_FAILED;
ffc09758: 38 60 ff ff li r3,-1
the_semaphore->Semaphore_id = the_semaphore->Object.id;
return &the_semaphore->Semaphore_id;
#else
return (sem_t *)&the_semaphore->Object.id;
#endif
}
ffc0975c: 39 61 00 48 addi r11,r1,72
ffc09760: 48 01 36 40 b ffc1cda0 <_restgpr_26_x>
ffc08b34 <sigaction>:
struct sigaction *oact
)
{
ISR_Level level;
if ( oact )
ffc08b34: 7c a9 2b 79 mr. r9,r5
int sigaction(
int sig,
const struct sigaction *act,
struct sigaction *oact
)
{
ffc08b38: 94 21 ff e8 stwu r1,-24(r1)
ffc08b3c: 7c 08 02 a6 mflr r0
ffc08b40: bf 81 00 08 stmw r28,8(r1)
ffc08b44: 7c 7f 1b 78 mr r31,r3
ffc08b48: 7c 9e 23 78 mr r30,r4
ffc08b4c: 90 01 00 1c stw r0,28(r1)
ISR_Level level;
if ( oact )
ffc08b50: 41 82 00 1c beq- ffc08b6c <sigaction+0x38>
*oact = _POSIX_signals_Vectors[ sig ];
ffc08b54: 1d 03 00 0c mulli r8,r3,12
ffc08b58: 3d 40 00 00 lis r10,0
ffc08b5c: 39 4a 32 60 addi r10,r10,12896
ffc08b60: 7d 4a 42 14 add r10,r10,r8
ffc08b64: 7c aa 64 aa lswi r5,r10,12
ffc08b68: 7c a9 65 aa stswi r5,r9,12
if ( !sig )
ffc08b6c: 2f 9f 00 00 cmpwi cr7,r31,0
ffc08b70: 40 be 00 08 bne+ cr7,ffc08b78 <sigaction+0x44>
ffc08b74: 48 00 00 1c b ffc08b90 <sigaction+0x5c>
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc08b78: 39 3f ff ff addi r9,r31,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
ffc08b7c: 2b 89 00 1f cmplwi cr7,r9,31
ffc08b80: 40 bd 00 08 ble+ cr7,ffc08b88 <sigaction+0x54>
ffc08b84: 48 00 00 0c b ffc08b90 <sigaction+0x5c>
*
* NOTE: Solaris documentation claims to "silently enforce" this which
* contradicts the POSIX specification.
*/
if ( sig == SIGKILL )
ffc08b88: 2f 9f 00 09 cmpwi cr7,r31,9
ffc08b8c: 40 be 00 18 bne+ cr7,ffc08ba4 <sigaction+0x70>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08b90: 48 00 86 41 bl ffc111d0 <__errno>
ffc08b94: 39 20 00 16 li r9,22
ffc08b98: 91 23 00 00 stw r9,0(r3)
ffc08b9c: 38 60 ff ff li r3,-1
ffc08ba0: 48 00 00 74 b ffc08c14 <sigaction+0xe0>
/*
* Evaluate the new action structure and set the global signal vector
* appropriately.
*/
if ( act ) {
ffc08ba4: 2f 9e 00 00 cmpwi cr7,r30,0
* now (signals not posted when SIG_IGN).
* + If we are now ignoring a signal that was previously pending,
* we clear the pending signal indicator.
*/
return 0;
ffc08ba8: 38 60 00 00 li r3,0
/*
* Evaluate the new action structure and set the global signal vector
* appropriately.
*/
if ( act ) {
ffc08bac: 41 9e 00 68 beq- cr7,ffc08c14 <sigaction+0xe0> <== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc08bb0: 7f 80 00 a6 mfmsr r28
ffc08bb4: 7d 30 42 a6 mfsprg r9,0
ffc08bb8: 7f 89 48 78 andc r9,r28,r9
ffc08bbc: 7d 20 01 24 mtmsr r9
* Unless the user is installing the default signal actions, then
* we can just copy the provided sigaction structure into the vectors.
*/
_ISR_Disable( level );
if ( act->sa_handler == SIG_DFL ) {
ffc08bc0: 81 3e 00 08 lwz r9,8(r30)
ffc08bc4: 3f a0 00 00 lis r29,0
ffc08bc8: 3b bd 32 60 addi r29,r29,12896
ffc08bcc: 2f 89 00 00 cmpwi cr7,r9,0
ffc08bd0: 40 be 00 24 bne+ cr7,ffc08bf4 <sigaction+0xc0>
_POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ];
ffc08bd4: 1f ff 00 0c mulli r31,r31,12
ffc08bd8: 3d 20 ff c2 lis r9,-62
ffc08bdc: 39 29 ab 0c addi r9,r9,-21748
ffc08be0: 7f bd fa 14 add r29,r29,r31
ffc08be4: 7f e9 fa 14 add r31,r9,r31
ffc08be8: 7c bf 64 aa lswi r5,r31,12
ffc08bec: 7c bd 65 aa stswi r5,r29,12
ffc08bf0: 48 00 00 1c b ffc08c0c <sigaction+0xd8>
} else {
_POSIX_signals_Clear_process_signals( sig );
ffc08bf4: 7f e3 fb 78 mr r3,r31
_POSIX_signals_Vectors[ sig ] = *act;
ffc08bf8: 1f ff 00 0c mulli r31,r31,12
_ISR_Disable( level );
if ( act->sa_handler == SIG_DFL ) {
_POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ];
} else {
_POSIX_signals_Clear_process_signals( sig );
ffc08bfc: 48 00 5a 1d bl ffc0e618 <_POSIX_signals_Clear_process_signals>
_POSIX_signals_Vectors[ sig ] = *act;
ffc08c00: 7f bd fa 14 add r29,r29,r31
ffc08c04: 7c be 64 aa lswi r5,r30,12
ffc08c08: 7c bd 65 aa stswi r5,r29,12
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc08c0c: 7f 80 01 24 mtmsr r28
* now (signals not posted when SIG_IGN).
* + If we are now ignoring a signal that was previously pending,
* we clear the pending signal indicator.
*/
return 0;
ffc08c10: 38 60 00 00 li r3,0
}
ffc08c14: 39 61 00 18 addi r11,r1,24
ffc08c18: 4b ff 7d 74 b ffc0098c <_restgpr_28_x>
ffc0912c <sigtimedwait>:
int sigtimedwait(
const sigset_t *set,
siginfo_t *info,
const struct timespec *timeout
)
{
ffc0912c: 94 21 ff d0 stwu r1,-48(r1)
ffc09130: 7c 08 02 a6 mflr r0
ffc09134: bf 61 00 1c stmw r27,28(r1)
ISR_Level level;
/*
* Error check parameters before disabling interrupts.
*/
if ( !set )
ffc09138: 7c 7c 1b 79 mr. r28,r3
int sigtimedwait(
const sigset_t *set,
siginfo_t *info,
const struct timespec *timeout
)
{
ffc0913c: 90 01 00 34 stw r0,52(r1)
ISR_Level level;
/*
* Error check parameters before disabling interrupts.
*/
if ( !set )
ffc09140: 40 a2 00 08 bne+ ffc09148 <sigtimedwait+0x1c>
ffc09144: 48 00 00 38 b ffc0917c <sigtimedwait+0x50>
/* NOTE: This is very specifically a RELATIVE not ABSOLUTE time
* in the Open Group specification.
*/
interval = 0;
if ( timeout ) {
ffc09148: 2f 85 00 00 cmpwi cr7,r5,0
ffc0914c: 7c 9f 23 78 mr r31,r4
ffc09150: 7c be 2b 78 mr r30,r5
ffc09154: 41 9e 00 34 beq- cr7,ffc09188 <sigtimedwait+0x5c>
if ( !_Timespec_Is_valid( timeout ) )
ffc09158: 7c a3 2b 78 mr r3,r5
ffc0915c: 48 00 3d 01 bl ffc0ce5c <_Timespec_Is_valid>
ffc09160: 2f 83 00 00 cmpwi cr7,r3,0
ffc09164: 40 be 00 08 bne+ cr7,ffc0916c <sigtimedwait+0x40>
ffc09168: 48 00 00 14 b ffc0917c <sigtimedwait+0x50>
rtems_set_errno_and_return_minus_one( EINVAL );
interval = _Timespec_To_ticks( timeout );
ffc0916c: 7f c3 f3 78 mr r3,r30
ffc09170: 48 00 3d 2d bl ffc0ce9c <_Timespec_To_ticks>
if ( !interval )
ffc09174: 7c 64 1b 79 mr. r4,r3
ffc09178: 40 a2 00 14 bne+ ffc0918c <sigtimedwait+0x60> <== ALWAYS TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
ffc0917c: 48 00 87 c1 bl ffc1193c <__errno>
ffc09180: 39 20 00 16 li r9,22
ffc09184: 48 00 01 7c b ffc09300 <sigtimedwait+0x1d4>
/* NOTE: This is very specifically a RELATIVE not ABSOLUTE time
* in the Open Group specification.
*/
interval = 0;
ffc09188: 38 80 00 00 li r4,0
/*
* Initialize local variables.
*/
the_info = ( info ) ? info : &signal_information;
ffc0918c: 2f 9f 00 00 cmpwi cr7,r31,0
ffc09190: 40 be 00 08 bne+ cr7,ffc09198 <sigtimedwait+0x6c>
ffc09194: 3b e1 00 08 addi r31,r1,8
the_thread = _Thread_Executing;
ffc09198: 3d 20 00 00 lis r9,0
ffc0919c: 81 29 31 f0 lwz r9,12784(r9)
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc091a0: 83 a9 01 50 lwz r29,336(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
__asm__ volatile (
ffc091a4: 7f 60 00 a6 mfmsr r27
ffc091a8: 7d 50 42 a6 mfsprg r10,0
ffc091ac: 7f 6a 50 78 andc r10,r27,r10
ffc091b0: 7d 40 01 24 mtmsr r10
*/
/* API signals pending? */
_ISR_Disable( level );
if ( *set & api->signals_pending ) {
ffc091b4: 81 5c 00 00 lwz r10,0(r28)
ffc091b8: 80 7d 00 d4 lwz r3,212(r29)
ffc091bc: 7d 48 18 39 and. r8,r10,r3
ffc091c0: 41 a2 00 40 beq+ ffc09200 <sigtimedwait+0xd4>
/* XXX real info later */
the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending );
ffc091c4: 4b ff ff 11 bl ffc090d4 <_POSIX_signals_Get_lowest>
_POSIX_signals_Clear_signals(
ffc091c8: 7f e5 fb 78 mr r5,r31
/* API signals pending? */
_ISR_Disable( level );
if ( *set & api->signals_pending ) {
/* XXX real info later */
the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending );
ffc091cc: 90 7f 00 00 stw r3,0(r31)
ffc091d0: 7c 64 1b 78 mr r4,r3
_POSIX_signals_Clear_signals(
ffc091d4: 38 c0 00 00 li r6,0
ffc091d8: 7f a3 eb 78 mr r3,r29
ffc091dc: 38 e0 00 00 li r7,0
ffc091e0: 48 00 5c e5 bl ffc0eec4 <_POSIX_signals_Clear_signals>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
__asm__ volatile (
ffc091e4: 7f 60 01 24 mtmsr r27
false,
false
);
_ISR_Enable( level );
the_info->si_code = SI_USER;
ffc091e8: 39 20 00 01 li r9,1
the_info->si_value.sival_int = 0;
return the_info->si_signo;
ffc091ec: 83 df 00 00 lwz r30,0(r31)
false,
false
);
_ISR_Enable( level );
the_info->si_code = SI_USER;
ffc091f0: 91 3f 00 04 stw r9,4(r31)
the_info->si_value.sival_int = 0;
ffc091f4: 39 20 00 00 li r9,0
ffc091f8: 91 3f 00 08 stw r9,8(r31)
ffc091fc: 48 00 01 0c b ffc09308 <sigtimedwait+0x1dc>
return the_info->si_signo;
}
/* Process pending signals? */
if ( *set & _POSIX_signals_Pending ) {
ffc09200: 3d 00 00 00 lis r8,0
ffc09204: 80 68 29 04 lwz r3,10500(r8)
ffc09208: 7d 48 18 39 and. r8,r10,r3
ffc0920c: 41 a2 00 40 beq+ ffc0924c <sigtimedwait+0x120>
signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending );
ffc09210: 4b ff fe c5 bl ffc090d4 <_POSIX_signals_Get_lowest>
_POSIX_signals_Clear_signals( api, signo, the_info, true, false );
ffc09214: 7f e5 fb 78 mr r5,r31
}
/* Process pending signals? */
if ( *set & _POSIX_signals_Pending ) {
signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending );
ffc09218: 7c 7e 1b 78 mr r30,r3
_POSIX_signals_Clear_signals( api, signo, the_info, true, false );
ffc0921c: 7f c4 f3 78 mr r4,r30
ffc09220: 7f a3 eb 78 mr r3,r29
ffc09224: 38 c0 00 01 li r6,1
ffc09228: 38 e0 00 00 li r7,0
ffc0922c: 48 00 5c 99 bl ffc0eec4 <_POSIX_signals_Clear_signals>
ffc09230: 7f 60 01 24 mtmsr r27
_ISR_Enable( level );
the_info->si_signo = signo;
the_info->si_code = SI_USER;
ffc09234: 39 20 00 01 li r9,1
if ( *set & _POSIX_signals_Pending ) {
signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending );
_POSIX_signals_Clear_signals( api, signo, the_info, true, false );
_ISR_Enable( level );
the_info->si_signo = signo;
ffc09238: 93 df 00 00 stw r30,0(r31)
the_info->si_code = SI_USER;
ffc0923c: 91 3f 00 04 stw r9,4(r31)
the_info->si_value.sival_int = 0;
ffc09240: 39 20 00 00 li r9,0
ffc09244: 91 3f 00 08 stw r9,8(r31)
ffc09248: 48 00 00 c0 b ffc09308 <sigtimedwait+0x1dc>
return signo;
}
the_info->si_signo = -1;
ffc0924c: 39 40 ff ff li r10,-1
ffc09250: 91 5f 00 00 stw r10,0(r31)
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc09254: 3d 40 00 00 lis r10,0
ffc09258: 81 0a 28 d4 lwz r8,10452(r10)
++level;
ffc0925c: 39 08 00 01 addi r8,r8,1
_Thread_Dispatch_disable_level = level;
ffc09260: 91 0a 28 d4 stw r8,10452(r10)
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
the_thread->Wait.return_code = EINTR;
ffc09264: 39 00 00 04 li r8,4
ffc09268: 91 09 00 34 stw r8,52(r9)
}
the_info->si_signo = -1;
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
ffc0926c: 3d 40 00 00 lis r10,0
ffc09270: 39 4a 33 ec addi r10,r10,13292
the_thread->Wait.return_code = EINTR;
the_thread->Wait.option = *set;
ffc09274: 81 1c 00 00 lwz r8,0(r28)
}
the_info->si_signo = -1;
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
ffc09278: 91 49 00 44 stw r10,68(r9)
the_thread->Wait.return_code = EINTR;
the_thread->Wait.option = *set;
ffc0927c: 91 09 00 30 stw r8,48(r9)
the_thread->Wait.return_argument = the_info;
ffc09280: 93 e9 00 28 stw r31,40(r9)
RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section (
Thread_queue_Control *the_thread_queue
)
{
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
ffc09284: 39 20 00 01 li r9,1
ffc09288: 91 2a 00 30 stw r9,48(r10)
ffc0928c: 7f 60 01 24 mtmsr r27
_Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue );
_ISR_Enable( level );
_Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval );
ffc09290: 3c 60 00 00 lis r3,0
ffc09294: 3c a0 ff c1 lis r5,-63
ffc09298: 38 63 33 ec addi r3,r3,13292
ffc0929c: 38 a5 cb f4 addi r5,r5,-13324
ffc092a0: 48 00 35 a1 bl ffc0c840 <_Thread_queue_Enqueue_with_handler>
_Thread_Enable_dispatch();
ffc092a4: 48 00 30 4d bl ffc0c2f0 <_Thread_Enable_dispatch>
/*
* When the thread is set free by a signal, it is need to eliminate
* the signal.
*/
_POSIX_signals_Clear_signals( api, the_info->si_signo, the_info, false, false );
ffc092a8: 80 9f 00 00 lwz r4,0(r31)
ffc092ac: 7f a3 eb 78 mr r3,r29
ffc092b0: 7f e5 fb 78 mr r5,r31
ffc092b4: 38 c0 00 00 li r6,0
ffc092b8: 38 e0 00 00 li r7,0
ffc092bc: 48 00 5c 09 bl ffc0eec4 <_POSIX_signals_Clear_signals>
/* Set errno only if return code is not EINTR or
* if EINTR was caused by a signal being caught, which
* was not in our set.
*/
if ( (_Thread_Executing->Wait.return_code != EINTR)
ffc092c0: 3d 20 00 00 lis r9,0
ffc092c4: 81 29 31 f0 lwz r9,12784(r9)
ffc092c8: 81 29 00 34 lwz r9,52(r9)
ffc092cc: 2f 89 00 04 cmpwi cr7,r9,4
ffc092d0: 40 9e 00 20 bne- cr7,ffc092f0 <sigtimedwait+0x1c4>
|| !(*set & signo_to_mask( the_info->si_signo )) ) {
ffc092d4: 83 df 00 00 lwz r30,0(r31)
ffc092d8: 39 40 00 01 li r10,1
ffc092dc: 39 3e ff ff addi r9,r30,-1
ffc092e0: 7d 4a 48 30 slw r10,r10,r9
ffc092e4: 81 3c 00 00 lwz r9,0(r28)
ffc092e8: 7d 48 48 39 and. r8,r10,r9
ffc092ec: 40 a2 00 1c bne+ ffc09308 <sigtimedwait+0x1dc>
errno = _Thread_Executing->Wait.return_code;
ffc092f0: 48 00 86 4d bl ffc1193c <__errno>
ffc092f4: 3d 20 00 00 lis r9,0
ffc092f8: 81 29 31 f0 lwz r9,12784(r9)
ffc092fc: 81 29 00 34 lwz r9,52(r9)
ffc09300: 91 23 00 00 stw r9,0(r3)
return -1;
ffc09304: 3b c0 ff ff li r30,-1
}
return the_info->si_signo;
}
ffc09308: 39 61 00 30 addi r11,r1,48
ffc0930c: 7f c3 f3 78 mr r3,r30
ffc09310: 4b ff 7a 80 b ffc00d90 <_restgpr_27_x>
ffc0b308 <sigwait>:
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0b308: 7c 2b 0b 78 mr r11,r1
ffc0b30c: 94 21 ff f0 stwu r1,-16(r1)
ffc0b310: 7c 08 02 a6 mflr r0
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0b314: 38 a0 00 00 li r5,0
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0b318: 4b ff 75 11 bl ffc02828 <_savegpr_31>
ffc0b31c: 7c 9f 23 78 mr r31,r4
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0b320: 38 80 00 00 li r4,0
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0b324: 90 01 00 14 stw r0,20(r1)
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0b328: 4b ff fd f1 bl ffc0b118 <sigtimedwait>
if ( status != -1 ) {
ffc0b32c: 2f 83 ff ff cmpwi cr7,r3,-1
ffc0b330: 41 9e 00 14 beq- cr7,ffc0b344 <sigwait+0x3c>
if ( sig )
ffc0b334: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0b338: 41 9e 00 18 beq- cr7,ffc0b350 <sigwait+0x48> <== NEVER TAKEN
*sig = status;
ffc0b33c: 90 7f 00 00 stw r3,0(r31)
ffc0b340: 48 00 00 10 b ffc0b350 <sigwait+0x48>
return 0;
}
return errno;
ffc0b344: 48 00 82 cd bl ffc13610 <__errno>
ffc0b348: 80 63 00 00 lwz r3,0(r3)
ffc0b34c: 48 00 00 08 b ffc0b354 <sigwait+0x4c>
status = sigtimedwait( set, NULL, NULL );
if ( status != -1 ) {
if ( sig )
*sig = status;
return 0;
ffc0b350: 38 60 00 00 li r3,0
}
return errno;
}
ffc0b354: 39 61 00 10 addi r11,r1,16
ffc0b358: 4b ff 75 1c b ffc02874 <_restgpr_31_x>
ffc07db4 <sysconf>:
long sysconf(
int name
)
{
if ( name == _SC_CLK_TCK )
ffc07db4: 2f 83 00 02 cmpwi cr7,r3,2
ffc07db8: 40 be 00 20 bne+ cr7,ffc07dd8 <sysconf+0x24>
return (TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick());
ffc07dbc: 3d 20 ff c1 lis r9,-63
long sysconf(
int name
)
{
if ( name == _SC_CLK_TCK )
return (TOD_MICROSECONDS_PER_SECOND /
ffc07dc0: 81 49 65 e0 lwz r10,26080(r9)
ffc07dc4: 3d 20 00 0f lis r9,15
ffc07dc8: 61 29 42 40 ori r9,r9,16960
ffc07dcc: 7d 29 53 96 divwu r9,r9,r10
if ( name == 515 ) /* Solaris _SC_STACK_PROT */
return 0;
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
}
ffc07dd0: 7d 23 4b 78 mr r3,r9
ffc07dd4: 4e 80 00 20 blr
{
if ( name == _SC_CLK_TCK )
return (TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick());
if ( name == _SC_OPEN_MAX )
ffc07dd8: 2f 83 00 04 cmpwi cr7,r3,4
return rtems_libio_number_iops;
ffc07ddc: 3d 20 00 00 lis r9,0
ffc07de0: 81 29 27 a0 lwz r9,10144(r9)
{
if ( name == _SC_CLK_TCK )
return (TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick());
if ( name == _SC_OPEN_MAX )
ffc07de4: 41 be ff ec beq- cr7,ffc07dd0 <sysconf+0x1c>
return rtems_libio_number_iops;
if ( name == _SC_GETPW_R_SIZE_MAX )
ffc07de8: 2f 83 00 33 cmpwi cr7,r3,51
return 1024;
ffc07dec: 39 20 04 00 li r9,1024
rtems_configuration_get_microseconds_per_tick());
if ( name == _SC_OPEN_MAX )
return rtems_libio_number_iops;
if ( name == _SC_GETPW_R_SIZE_MAX )
ffc07df0: 41 be ff e0 beq- cr7,ffc07dd0 <sysconf+0x1c>
return 1024;
if ( name == _SC_PAGESIZE )
ffc07df4: 2f 83 00 08 cmpwi cr7,r3,8
return PAGE_SIZE;
ffc07df8: 39 20 10 00 li r9,4096
return rtems_libio_number_iops;
if ( name == _SC_GETPW_R_SIZE_MAX )
return 1024;
if ( name == _SC_PAGESIZE )
ffc07dfc: 41 be ff d4 beq- cr7,ffc07dd0 <sysconf+0x1c>
return PAGE_SIZE;
if ( name == _SC_SYMLOOP_MAX )
ffc07e00: 2f 83 00 4f cmpwi cr7,r3,79
return RTEMS_FILESYSTEM_SYMLOOP_MAX;
ffc07e04: 39 20 00 20 li r9,32
return 1024;
if ( name == _SC_PAGESIZE )
return PAGE_SIZE;
if ( name == _SC_SYMLOOP_MAX )
ffc07e08: 41 9e ff c8 beq+ cr7,ffc07dd0 <sysconf+0x1c> <== NEVER TAKEN
*/
long sysconf(
int name
)
{
ffc07e0c: 94 21 ff f8 stwu r1,-8(r1)
ffc07e10: 7c 08 02 a6 mflr r0
ffc07e14: 90 01 00 0c stw r0,12(r1)
#if defined(__sparc__)
if ( name == 515 ) /* Solaris _SC_STACK_PROT */
return 0;
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
ffc07e18: 48 00 85 5d bl ffc10374 <__errno>
ffc07e1c: 39 20 00 16 li r9,22
}
ffc07e20: 80 01 00 0c lwz r0,12(r1)
#if defined(__sparc__)
if ( name == 515 ) /* Solaris _SC_STACK_PROT */
return 0;
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
ffc07e24: 91 23 00 00 stw r9,0(r3)
ffc07e28: 39 20 ff ff li r9,-1
}
ffc07e2c: 7c 08 03 a6 mtlr r0
ffc07e30: 7d 23 4b 78 mr r3,r9
ffc07e34: 38 21 00 08 addi r1,r1,8
ffc07e38: 4e 80 00 20 blr
ffc09764 <timer_create>:
timer_t *timerid
)
{
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
ffc09764: 2f 83 00 01 cmpwi cr7,r3,1
int timer_create(
clockid_t clock_id,
struct sigevent *evp,
timer_t *timerid
)
{
ffc09768: 94 21 ff f0 stwu r1,-16(r1)
ffc0976c: 7c 08 02 a6 mflr r0
ffc09770: bf c1 00 08 stmw r30,8(r1)
ffc09774: 90 01 00 14 stw r0,20(r1)
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
ffc09778: 41 be 00 08 beq+ cr7,ffc09780 <timer_create+0x1c>
ffc0977c: 48 00 00 50 b ffc097cc <timer_create+0x68>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !timerid )
ffc09780: 2f 85 00 00 cmpwi cr7,r5,0
ffc09784: 7c be 2b 78 mr r30,r5
ffc09788: 40 be 00 08 bne+ cr7,ffc09790 <timer_create+0x2c>
ffc0978c: 48 00 00 40 b ffc097cc <timer_create+0x68>
/*
* The data of the structure evp are checked in order to verify if they
* are coherent.
*/
if (evp != NULL) {
ffc09790: 2f 84 00 00 cmpwi cr7,r4,0
ffc09794: 7c 9f 23 78 mr r31,r4
ffc09798: 41 9e 00 40 beq- cr7,ffc097d8 <timer_create+0x74>
/* The structure has data */
if ( ( evp->sigev_notify != SIGEV_NONE ) &&
ffc0979c: 81 24 00 00 lwz r9,0(r4)
ffc097a0: 39 29 ff ff addi r9,r9,-1
ffc097a4: 2b 89 00 01 cmplwi cr7,r9,1
ffc097a8: 40 bd 00 08 ble+ cr7,ffc097b0 <timer_create+0x4c> <== ALWAYS TAKEN
ffc097ac: 48 00 00 20 b ffc097cc <timer_create+0x68> <== NOT EXECUTED
( evp->sigev_notify != SIGEV_SIGNAL ) ) {
/* The value of the field sigev_notify is not valid */
rtems_set_errno_and_return_minus_one( EINVAL );
}
if ( !evp->sigev_signo )
ffc097b0: 81 24 00 04 lwz r9,4(r4)
ffc097b4: 2f 89 00 00 cmpwi cr7,r9,0
ffc097b8: 40 be 00 08 bne+ cr7,ffc097c0 <timer_create+0x5c> <== ALWAYS TAKEN
ffc097bc: 48 00 00 10 b ffc097cc <timer_create+0x68> <== NOT EXECUTED
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc097c0: 39 29 ff ff addi r9,r9,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(evp->sigev_signo) )
ffc097c4: 2b 89 00 1f cmplwi cr7,r9,31
ffc097c8: 40 bd 00 10 ble+ cr7,ffc097d8 <timer_create+0x74> <== ALWAYS TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
ffc097cc: 48 00 8d 49 bl ffc12514 <__errno>
ffc097d0: 39 20 00 16 li r9,22
ffc097d4: 48 00 00 34 b ffc09808 <timer_create+0xa4>
*
* This rountine increments the thread dispatch level
*/
RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void)
{
uint32_t level = _Thread_Dispatch_disable_level;
ffc097d8: 3d 20 00 00 lis r9,0
ffc097dc: 81 49 28 a8 lwz r10,10408(r9)
++level;
ffc097e0: 39 4a 00 01 addi r10,r10,1
_Thread_Dispatch_disable_level = level;
ffc097e4: 91 49 28 a8 stw r10,10408(r9)
* the inactive chain of free timer control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Allocate( void )
{
return (POSIX_Timer_Control *) _Objects_Allocate( &_POSIX_Timer_Information );
ffc097e8: 3c 60 00 00 lis r3,0
ffc097ec: 38 63 59 40 addi r3,r3,22848
ffc097f0: 48 00 22 9d bl ffc0ba8c <_Objects_Allocate>
/*
* Allocate a timer
*/
ptimer = _POSIX_Timer_Allocate();
if ( !ptimer ) {
ffc097f4: 2c 03 00 00 cmpwi r3,0
ffc097f8: 40 a2 00 1c bne+ ffc09814 <timer_create+0xb0>
_Thread_Enable_dispatch();
ffc097fc: 48 00 36 cd bl ffc0cec8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EAGAIN );
ffc09800: 48 00 8d 15 bl ffc12514 <__errno>
ffc09804: 39 20 00 0b li r9,11
ffc09808: 91 23 00 00 stw r9,0(r3)
ffc0980c: 38 60 ff ff li r3,-1
ffc09810: 48 00 00 88 b ffc09898 <timer_create+0x134>
}
/* The data of the created timer are stored to use them later */
ptimer->state = POSIX_TIMER_STATE_CREATE_NEW;
ffc09814: 39 40 00 02 li r10,2
ffc09818: 99 43 00 3c stb r10,60(r3)
ptimer->thread_id = _Thread_Executing->Object.id;
if ( evp != NULL ) {
ffc0981c: 2f 9f 00 00 cmpwi cr7,r31,0
}
/* The data of the created timer are stored to use them later */
ptimer->state = POSIX_TIMER_STATE_CREATE_NEW;
ptimer->thread_id = _Thread_Executing->Object.id;
ffc09820: 3d 40 00 00 lis r10,0
ffc09824: 81 4a 5b b0 lwz r10,23472(r10)
ffc09828: 81 4a 00 08 lwz r10,8(r10)
ffc0982c: 91 43 00 38 stw r10,56(r3)
if ( evp != NULL ) {
ffc09830: 41 9e 00 1c beq- cr7,ffc0984c <timer_create+0xe8>
ptimer->inf.sigev_notify = evp->sigev_notify;
ffc09834: 81 5f 00 00 lwz r10,0(r31)
ffc09838: 91 43 00 40 stw r10,64(r3)
ptimer->inf.sigev_signo = evp->sigev_signo;
ffc0983c: 81 5f 00 04 lwz r10,4(r31)
ffc09840: 91 43 00 44 stw r10,68(r3)
ptimer->inf.sigev_value = evp->sigev_value;
ffc09844: 81 5f 00 08 lwz r10,8(r31)
ffc09848: 91 43 00 48 stw r10,72(r3)
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc0984c: 81 03 00 08 lwz r8,8(r3)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc09850: 3c e0 00 00 lis r7,0
ffc09854: 80 c7 59 5c lwz r6,22876(r7)
}
ptimer->overrun = 0;
ffc09858: 39 40 00 00 li r10,0
ffc0985c: 55 07 13 ba rlwinm r7,r8,2,14,29
ffc09860: 91 43 00 68 stw r10,104(r3)
ptimer->timer_data.it_value.tv_sec = 0;
ffc09864: 91 43 00 5c stw r10,92(r3)
ptimer->timer_data.it_value.tv_nsec = 0;
ffc09868: 91 43 00 60 stw r10,96(r3)
ptimer->timer_data.it_interval.tv_sec = 0;
ffc0986c: 91 43 00 54 stw r10,84(r3)
ptimer->timer_data.it_interval.tv_nsec = 0;
ffc09870: 91 43 00 58 stw r10,88(r3)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc09874: 91 43 00 18 stw r10,24(r3)
the_watchdog->routine = routine;
ffc09878: 91 43 00 2c stw r10,44(r3)
the_watchdog->id = id;
ffc0987c: 91 43 00 30 stw r10,48(r3)
the_watchdog->user_data = user_data;
ffc09880: 91 43 00 34 stw r10,52(r3)
ffc09884: 7c 66 39 2e stwx r3,r6,r7
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc09888: 91 43 00 0c stw r10,12(r3)
_Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL );
_Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0);
*timerid = ptimer->Object.id;
ffc0988c: 91 1e 00 00 stw r8,0(r30)
_Thread_Enable_dispatch();
ffc09890: 48 00 36 39 bl ffc0cec8 <_Thread_Enable_dispatch>
return 0;
ffc09894: 38 60 00 00 li r3,0
}
ffc09898: 39 61 00 10 addi r11,r1,16
ffc0989c: 48 01 35 14 b ffc1cdb0 <_restgpr_30_x>
ffc08438 <timer_settime>:
timer_t timerid,
int flags,
const struct itimerspec *value,
struct itimerspec *ovalue
)
{
ffc08438: 94 21 ff c8 stwu r1,-56(r1)
ffc0843c: 7c 08 02 a6 mflr r0
ffc08440: bf 81 00 28 stmw r28,40(r1)
Objects_Locations location;
bool activated;
uint32_t initial_period;
struct itimerspec normalize;
if ( !value )
ffc08444: 7c bd 2b 79 mr. r29,r5
timer_t timerid,
int flags,
const struct itimerspec *value,
struct itimerspec *ovalue
)
{
ffc08448: 90 01 00 3c stw r0,60(r1)
Objects_Locations location;
bool activated;
uint32_t initial_period;
struct itimerspec normalize;
if ( !value )
ffc0844c: 40 a2 00 08 bne+ ffc08454 <timer_settime+0x1c> <== ALWAYS TAKEN
ffc08450: 48 00 01 78 b ffc085c8 <timer_settime+0x190> <== NOT EXECUTED
ffc08454: 7c 7c 1b 78 mr r28,r3
/*
* First, it verifies if the structure "value" is correct
* if the number of nanoseconds is not correct return EINVAL
*/
if ( !_Timespec_Is_valid( &(value->it_value) ) ) {
ffc08458: 38 7d 00 08 addi r3,r29,8
ffc0845c: 7c 9f 23 78 mr r31,r4
ffc08460: 7c de 33 78 mr r30,r6
ffc08464: 48 00 3e b1 bl ffc0c314 <_Timespec_Is_valid>
ffc08468: 2f 83 00 00 cmpwi cr7,r3,0
ffc0846c: 40 be 00 08 bne+ cr7,ffc08474 <timer_settime+0x3c>
ffc08470: 48 00 01 58 b ffc085c8 <timer_settime+0x190>
rtems_set_errno_and_return_minus_one( EINVAL );
}
if ( !_Timespec_Is_valid( &(value->it_interval) ) ) {
ffc08474: 7f a3 eb 78 mr r3,r29
ffc08478: 48 00 3e 9d bl ffc0c314 <_Timespec_Is_valid>
ffc0847c: 2f 83 00 00 cmpwi cr7,r3,0
ffc08480: 40 be 00 08 bne+ cr7,ffc08488 <timer_settime+0x50> <== ALWAYS TAKEN
ffc08484: 48 00 01 44 b ffc085c8 <timer_settime+0x190> <== NOT EXECUTED
rtems_set_errno_and_return_minus_one( EINVAL );
}
if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) {
ffc08488: 2f 9f 00 04 cmpwi cr7,r31,4
ffc0848c: 41 9e 00 10 beq- cr7,ffc0849c <timer_settime+0x64>
ffc08490: 2f 9f 00 00 cmpwi cr7,r31,0
ffc08494: 41 be 00 08 beq+ cr7,ffc0849c <timer_settime+0x64>
ffc08498: 48 00 01 30 b ffc085c8 <timer_settime+0x190>
}
normalize = *value;
/* Convert absolute to relative time */
if (flags == TIMER_ABSTIME) {
ffc0849c: 2f 9f 00 04 cmpwi cr7,r31,4
if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) {
rtems_set_errno_and_return_minus_one( EINVAL );
}
normalize = *value;
ffc084a0: 39 21 00 08 addi r9,r1,8
ffc084a4: 7c bd 84 aa lswi r5,r29,16
ffc084a8: 7c a9 85 aa stswi r5,r9,16
/* Convert absolute to relative time */
if (flags == TIMER_ABSTIME) {
ffc084ac: 40 be 00 34 bne+ cr7,ffc084e0 <timer_settime+0xa8>
struct timespec now;
_TOD_Get( &now );
ffc084b0: 38 61 00 18 addi r3,r1,24
ffc084b4: 4b ff ff 19 bl ffc083cc <_TOD_Get>
/* Check for seconds in the past */
if ( _Timespec_Greater_than( &now, &normalize.it_value ) )
ffc084b8: 38 61 00 10 addi r3,r1,16
ffc084bc: 38 81 00 18 addi r4,r1,24
ffc084c0: 48 00 3e 95 bl ffc0c354 <_Timespec_Less_than>
ffc084c4: 2f 83 00 00 cmpwi cr7,r3,0
ffc084c8: 41 be 00 08 beq+ cr7,ffc084d0 <timer_settime+0x98>
ffc084cc: 48 00 00 fc b ffc085c8 <timer_settime+0x190>
rtems_set_errno_and_return_minus_one( EINVAL );
_Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value );
ffc084d0: 38 81 00 10 addi r4,r1,16
ffc084d4: 38 61 00 18 addi r3,r1,24
ffc084d8: 7c 85 23 78 mr r5,r4
ffc084dc: 48 00 3e b5 bl ffc0c390 <_Timespec_Subtract>
RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get (
timer_t id,
Objects_Locations *location
)
{
return (POSIX_Timer_Control *)
ffc084e0: 3c 60 00 00 lis r3,0
ffc084e4: 38 63 2f 80 addi r3,r3,12160
ffc084e8: 7f 84 e3 78 mr r4,r28
ffc084ec: 38 a1 00 20 addi r5,r1,32
ffc084f0: 48 00 24 65 bl ffc0a954 <_Objects_Get>
* something with the structure of times of the timer: to stop, start
* or start it again
*/
ptimer = _POSIX_Timer_Get( timerid, &location );
switch ( location ) {
ffc084f4: 81 21 00 20 lwz r9,32(r1)
ffc084f8: 7c 7f 1b 78 mr r31,r3
ffc084fc: 2f 89 00 00 cmpwi cr7,r9,0
ffc08500: 40 9e 00 c8 bne- cr7,ffc085c8 <timer_settime+0x190>
case OBJECTS_LOCAL:
/* First, it verifies if the timer must be stopped */
if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) {
ffc08504: 81 21 00 10 lwz r9,16(r1)
ffc08508: 2f 89 00 00 cmpwi cr7,r9,0
ffc0850c: 40 9e 00 44 bne- cr7,ffc08550 <timer_settime+0x118>
ffc08510: 81 21 00 14 lwz r9,20(r1)
ffc08514: 2f 89 00 00 cmpwi cr7,r9,0
ffc08518: 40 be 00 38 bne+ cr7,ffc08550 <timer_settime+0x118>
/* Stop the timer */
(void) _Watchdog_Remove( &ptimer->Timer );
ffc0851c: 38 63 00 10 addi r3,r3,16
ffc08520: 48 00 42 71 bl ffc0c790 <_Watchdog_Remove>
/* The old data of the timer are returned */
if ( ovalue )
ffc08524: 2f 9e 00 00 cmpwi cr7,r30,0
ffc08528: 39 3f 00 54 addi r9,r31,84
ffc0852c: 41 9e 00 0c beq- cr7,ffc08538 <timer_settime+0x100>
*ovalue = ptimer->timer_data;
ffc08530: 7c a9 84 aa lswi r5,r9,16
ffc08534: 7c be 85 aa stswi r5,r30,16
/* The new data are set */
ptimer->timer_data = normalize;
ffc08538: 39 41 00 08 addi r10,r1,8
ffc0853c: 7c aa 84 aa lswi r5,r10,16
ffc08540: 7c a9 85 aa stswi r5,r9,16
/* Indicates that the timer is created and stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
ffc08544: 39 20 00 04 li r9,4
ffc08548: 99 3f 00 3c stb r9,60(r31)
ffc0854c: 48 00 00 70 b ffc085bc <timer_settime+0x184>
_Thread_Enable_dispatch();
return 0;
}
/* Convert from seconds and nanoseconds to ticks */
ptimer->ticks = _Timespec_To_ticks( &value->it_interval );
ffc08550: 7f a3 eb 78 mr r3,r29
ffc08554: 48 00 3e 7d bl ffc0c3d0 <_Timespec_To_ticks>
ffc08558: 90 7f 00 64 stw r3,100(r31)
initial_period = _Timespec_To_ticks( &normalize.it_value );
ffc0855c: 38 61 00 10 addi r3,r1,16
ffc08560: 48 00 3e 71 bl ffc0c3d0 <_Timespec_To_ticks>
activated = _POSIX_Timer_Insert_helper(
ffc08564: 80 bf 00 08 lwz r5,8(r31)
ffc08568: 3c c0 ff c1 lis r6,-63
return 0;
}
/* Convert from seconds and nanoseconds to ticks */
ptimer->ticks = _Timespec_To_ticks( &value->it_interval );
initial_period = _Timespec_To_ticks( &normalize.it_value );
ffc0856c: 7c 64 1b 78 mr r4,r3
activated = _POSIX_Timer_Insert_helper(
ffc08570: 38 c6 85 e0 addi r6,r6,-31264
ffc08574: 38 7f 00 10 addi r3,r31,16
ffc08578: 7f e7 fb 78 mr r7,r31
ffc0857c: 48 00 60 89 bl ffc0e604 <_POSIX_Timer_Insert_helper>
initial_period,
ptimer->Object.id,
_POSIX_Timer_TSR,
ptimer
);
if ( !activated ) {
ffc08580: 2f 83 00 00 cmpwi cr7,r3,0
ffc08584: 40 be 00 08 bne+ cr7,ffc0858c <timer_settime+0x154>
ffc08588: 48 00 00 34 b ffc085bc <timer_settime+0x184>
/*
* The timer has been started and is running. So we return the
* old ones in "ovalue"
*/
if ( ovalue )
ffc0858c: 2f 9e 00 00 cmpwi cr7,r30,0
ffc08590: 39 3f 00 54 addi r9,r31,84
ffc08594: 41 9e 00 0c beq- cr7,ffc085a0 <timer_settime+0x168>
*ovalue = ptimer->timer_data;
ffc08598: 7c a9 84 aa lswi r5,r9,16
ffc0859c: 7c be 85 aa stswi r5,r30,16
ptimer->timer_data = normalize;
ffc085a0: 39 41 00 08 addi r10,r1,8
ffc085a4: 7c aa 84 aa lswi r5,r10,16
ffc085a8: 7c a9 85 aa stswi r5,r9,16
/* Indicate that the time is running */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
ffc085ac: 39 20 00 03 li r9,3
_TOD_Get( &ptimer->time );
ffc085b0: 38 7f 00 6c addi r3,r31,108
if ( ovalue )
*ovalue = ptimer->timer_data;
ptimer->timer_data = normalize;
/* Indicate that the time is running */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
ffc085b4: 99 3f 00 3c stb r9,60(r31)
_TOD_Get( &ptimer->time );
ffc085b8: 4b ff fe 15 bl ffc083cc <_TOD_Get>
_Thread_Enable_dispatch();
ffc085bc: 48 00 31 ed bl ffc0b7a8 <_Thread_Enable_dispatch>
return 0;
ffc085c0: 38 60 00 00 li r3,0
ffc085c4: 48 00 00 14 b ffc085d8 <timer_settime+0x1a0>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
ffc085c8: 48 00 88 bd bl ffc10e84 <__errno>
ffc085cc: 39 20 00 16 li r9,22
ffc085d0: 91 23 00 00 stw r9,0(r3)
ffc085d4: 38 60 ff ff li r3,-1
}
ffc085d8: 39 61 00 38 addi r11,r1,56
ffc085dc: 4b ff 80 c0 b ffc0069c <_restgpr_28_x>
ffc081e0 <ualarm>:
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
ffc081e0: 94 21 ff d8 stwu r1,-40(r1)
ffc081e4: 7c 08 02 a6 mflr r0
ffc081e8: bf a1 00 1c stmw r29,28(r1)
/*
* Initialize the timer used to implement alarm().
*/
if ( !the_timer->routine ) {
ffc081ec: 3f e0 00 00 lis r31,0
ffc081f0: 3b ff 35 f4 addi r31,r31,13812
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
ffc081f4: 90 01 00 2c stw r0,44(r1)
ffc081f8: 7c 7d 1b 78 mr r29,r3
/*
* Initialize the timer used to implement alarm().
*/
if ( !the_timer->routine ) {
ffc081fc: 81 3f 00 1c lwz r9,28(r31)
ffc08200: 2f 89 00 00 cmpwi cr7,r9,0
ffc08204: 40 be 00 24 bne+ cr7,ffc08228 <ualarm+0x48>
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
ffc08208: 3d 40 ff c1 lis r10,-63
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0820c: 91 3f 00 08 stw r9,8(r31)
the_watchdog->routine = routine;
ffc08210: 39 4a 81 90 addi r10,r10,-32368
ffc08214: 91 5f 00 1c stw r10,28(r31)
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
useconds_t remaining = 0;
ffc08218: 3b c0 00 00 li r30,0
the_watchdog->id = id;
ffc0821c: 91 3f 00 20 stw r9,32(r31)
the_watchdog->user_data = user_data;
ffc08220: 91 3f 00 24 stw r9,36(r31)
ffc08224: 48 00 00 58 b ffc0827c <ualarm+0x9c>
if ( !the_timer->routine ) {
_Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL );
} else {
Watchdog_States state;
state = _Watchdog_Remove( the_timer );
ffc08228: 7f e3 fb 78 mr r3,r31
ffc0822c: 48 00 40 35 bl ffc0c260 <_Watchdog_Remove>
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
useconds_t remaining = 0;
ffc08230: 3b c0 00 00 li r30,0
_Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL );
} else {
Watchdog_States state;
state = _Watchdog_Remove( the_timer );
if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) {
ffc08234: 38 63 ff fe addi r3,r3,-2
ffc08238: 2b 83 00 01 cmplwi cr7,r3,1
ffc0823c: 41 bd 00 40 bgt+ cr7,ffc0827c <ualarm+0x9c> <== NEVER TAKEN
* boot. Since alarm() is dealing in seconds, we must account for
* this.
*/
ticks = the_timer->initial;
ticks -= (the_timer->stop_time - the_timer->start_time);
ffc08240: 81 3f 00 0c lwz r9,12(r31)
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
ffc08244: 38 81 00 08 addi r4,r1,8
* boot. Since alarm() is dealing in seconds, we must account for
* this.
*/
ticks = the_timer->initial;
ticks -= (the_timer->stop_time - the_timer->start_time);
ffc08248: 80 7f 00 14 lwz r3,20(r31)
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
remaining += tp.tv_nsec / 1000;
ffc0824c: 3b c0 03 e8 li r30,1000
* boot. Since alarm() is dealing in seconds, we must account for
* this.
*/
ticks = the_timer->initial;
ticks -= (the_timer->stop_time - the_timer->start_time);
ffc08250: 81 5f 00 18 lwz r10,24(r31)
ffc08254: 7c 63 4a 14 add r3,r3,r9
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
ffc08258: 7c 6a 18 50 subf r3,r10,r3
ffc0825c: 48 00 3b 59 bl ffc0bdb4 <_Timespec_From_ticks>
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
ffc08260: 81 21 00 08 lwz r9,8(r1)
ffc08264: 3d 40 00 0f lis r10,15
ffc08268: 61 4a 42 40 ori r10,r10,16960
ffc0826c: 7d 4a 49 d6 mullw r10,r10,r9
remaining += tp.tv_nsec / 1000;
ffc08270: 81 21 00 0c lwz r9,12(r1)
ffc08274: 7f c9 f3 d6 divw r30,r9,r30
ffc08278: 7f de 52 14 add r30,r30,r10
/*
* If useconds is non-zero, then the caller wants to schedule
* the alarm repeatedly at that interval. If the interval is
* less than a single clock tick, then fudge it to a clock tick.
*/
if ( useconds ) {
ffc0827c: 2f 9d 00 00 cmpwi cr7,r29,0
ffc08280: 41 be 00 4c beq+ cr7,ffc082cc <ualarm+0xec>
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
ffc08284: 3d 20 00 0f lis r9,15
ffc08288: 61 29 42 40 ori r9,r9,16960
ffc0828c: 7d 5d 4b 96 divwu r10,r29,r9
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ffc08290: 7d 2a 49 d6 mullw r9,r10,r9
* less than a single clock tick, then fudge it to a clock tick.
*/
if ( useconds ) {
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
ffc08294: 91 41 00 08 stw r10,8(r1)
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ticks = _Timespec_To_ticks( &tp );
ffc08298: 38 61 00 08 addi r3,r1,8
*/
if ( useconds ) {
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ffc0829c: 7f a9 e8 50 subf r29,r9,r29
ffc082a0: 1f bd 03 e8 mulli r29,r29,1000
ffc082a4: 93 a1 00 0c stw r29,12(r1)
ticks = _Timespec_To_ticks( &tp );
ffc082a8: 48 00 3b 3d bl ffc0bde4 <_Timespec_To_ticks>
if ( ticks == 0 )
ticks = 1;
_Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) );
ffc082ac: 38 61 00 08 addi r3,r1,8
ffc082b0: 48 00 3b 35 bl ffc0bde4 <_Timespec_To_ticks>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc082b4: 3c 80 00 00 lis r4,0
ffc082b8: 38 84 35 f4 addi r4,r4,13812
ffc082bc: 90 64 00 0c stw r3,12(r4)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc082c0: 3c 60 00 00 lis r3,0
ffc082c4: 38 63 2e 08 addi r3,r3,11784
ffc082c8: 48 00 3e 3d bl ffc0c104 <_Watchdog_Insert>
}
return remaining;
}
ffc082cc: 39 61 00 28 addi r11,r1,40
ffc082d0: 7f c3 f3 78 mr r3,r30
ffc082d4: 4b ff 83 40 b ffc00614 <_restgpr_29_x>