RTEMS 4.11Annotated Report
Sun Nov 28 00:05:22 2010
ffc0b23c <_CORE_RWLock_Release>:
*/
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
ffc0b23c: 7c 2b 0b 78 mr r11,r1
ffc0b240: 7c 08 02 a6 mflr r0
ffc0b244: 94 21 ff f0 stwu r1,-16(r1)
ISR_Level level;
Thread_Control *executing = _Thread_Executing;
ffc0b248: 3d 20 00 00 lis r9,0
*/
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
ffc0b24c: 90 01 00 14 stw r0,20(r1)
ffc0b250: 48 00 cc ed bl ffc17f3c <_savegpr_31>
ffc0b254: 7c 7f 1b 78 mr r31,r3
ISR_Level level;
Thread_Control *executing = _Thread_Executing;
ffc0b258: 81 69 30 f0 lwz r11,12528(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0b25c: 7c 00 00 a6 mfmsr r0
ffc0b260: 7d 30 42 a6 mfsprg r9,0
ffc0b264: 7c 09 48 78 andc r9,r0,r9
ffc0b268: 7d 20 01 24 mtmsr r9
* 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){
ffc0b26c: 81 23 00 44 lwz r9,68(r3)
ffc0b270: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b274: 40 be 00 14 bne+ cr7,ffc0b288 <_CORE_RWLock_Release+0x4c>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0b278: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE;
ffc0b27c: 38 00 00 02 li r0,2
ffc0b280: 90 0b 00 34 stw r0,52(r11)
return CORE_RWLOCK_SUCCESSFUL;
ffc0b284: 48 00 00 a8 b ffc0b32c <_CORE_RWLock_Release+0xf0>
}
if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) {
ffc0b288: 2f 89 00 01 cmpwi cr7,r9,1
ffc0b28c: 40 9e 00 20 bne- cr7,ffc0b2ac <_CORE_RWLock_Release+0x70>
the_rwlock->number_of_readers -= 1;
ffc0b290: 81 23 00 48 lwz r9,72(r3)
ffc0b294: 39 29 ff ff addi r9,r9,-1
if ( the_rwlock->number_of_readers != 0 ) {
ffc0b298: 2f 89 00 00 cmpwi cr7,r9,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;
ffc0b29c: 91 23 00 48 stw r9,72(r3)
if ( the_rwlock->number_of_readers != 0 ) {
ffc0b2a0: 41 be 00 0c beq+ cr7,ffc0b2ac <_CORE_RWLock_Release+0x70>
ffc0b2a4: 7c 00 01 24 mtmsr r0
/* must be unlocked again */
_ISR_Enable( level );
return CORE_RWLOCK_SUCCESSFUL;
ffc0b2a8: 48 00 00 84 b ffc0b32c <_CORE_RWLock_Release+0xf0>
}
}
/* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
ffc0b2ac: 39 20 00 00 li r9,0
ffc0b2b0: 91 2b 00 34 stw r9,52(r11)
/*
* Implicitly transition to "unlocked" and find another thread interested
* in obtaining this rwlock.
*/
the_rwlock->current_state = CORE_RWLOCK_UNLOCKED;
ffc0b2b4: 91 3f 00 44 stw r9,68(r31)
ffc0b2b8: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue );
ffc0b2bc: 7f e3 fb 78 mr r3,r31
ffc0b2c0: 48 00 1d 11 bl ffc0cfd0 <_Thread_queue_Dequeue>
if ( next ) {
ffc0b2c4: 2c 03 00 00 cmpwi r3,0
ffc0b2c8: 41 82 00 64 beq- ffc0b32c <_CORE_RWLock_Release+0xf0>
if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) {
ffc0b2cc: 80 03 00 30 lwz r0,48(r3)
ffc0b2d0: 2f 80 00 01 cmpwi cr7,r0,1
ffc0b2d4: 40 be 00 10 bne+ cr7,ffc0b2e4 <_CORE_RWLock_Release+0xa8>
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING;
ffc0b2d8: 38 00 00 02 li r0,2
ffc0b2dc: 90 1f 00 44 stw r0,68(r31)
return CORE_RWLOCK_SUCCESSFUL;
ffc0b2e0: 48 00 00 4c b ffc0b32c <_CORE_RWLock_Release+0xf0>
}
/*
* Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING
*/
the_rwlock->number_of_readers += 1;
ffc0b2e4: 81 3f 00 48 lwz r9,72(r31)
ffc0b2e8: 38 09 00 01 addi r0,r9,1
ffc0b2ec: 90 1f 00 48 stw r0,72(r31)
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING;
ffc0b2f0: 38 00 00 01 li r0,1
ffc0b2f4: 90 1f 00 44 stw r0,68(r31)
/*
* Now see if more readers can be let go.
*/
while ( 1 ) {
next = _Thread_queue_First( &the_rwlock->Wait_queue );
ffc0b2f8: 7f e3 fb 78 mr r3,r31
ffc0b2fc: 48 00 22 41 bl ffc0d53c <_Thread_queue_First>
if ( !next ||
ffc0b300: 7c 64 1b 79 mr. r4,r3
ffc0b304: 41 82 00 28 beq- ffc0b32c <_CORE_RWLock_Release+0xf0>
ffc0b308: 80 04 00 30 lwz r0,48(r4)
ffc0b30c: 2f 80 00 01 cmpwi cr7,r0,1
ffc0b310: 41 9e 00 1c beq- cr7,ffc0b32c <_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;
ffc0b314: 81 3f 00 48 lwz r9,72(r31)
_Thread_queue_Extract( &the_rwlock->Wait_queue, next );
ffc0b318: 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;
ffc0b31c: 38 09 00 01 addi r0,r9,1
ffc0b320: 90 1f 00 48 stw r0,72(r31)
_Thread_queue_Extract( &the_rwlock->Wait_queue, next );
ffc0b324: 48 00 20 a9 bl ffc0d3cc <_Thread_queue_Extract>
}
ffc0b328: 4b ff ff d0 b ffc0b2f8 <_CORE_RWLock_Release+0xbc>
}
/* indentation is to match _ISR_Disable at top */
return CORE_RWLOCK_SUCCESSFUL;
}
ffc0b32c: 39 61 00 10 addi r11,r1,16
ffc0b330: 38 60 00 00 li r3,0
ffc0b334: 4b ff 6b 08 b ffc01e3c <_restgpr_31_x>
ffc0b338 <_CORE_RWLock_Timeout>:
void _CORE_RWLock_Timeout(
Objects_Id id,
void *ignored
)
{
ffc0b338: 94 21 ff e8 stwu r1,-24(r1)
ffc0b33c: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b340: 38 81 00 08 addi r4,r1,8
void _CORE_RWLock_Timeout(
Objects_Id id,
void *ignored
)
{
ffc0b344: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b348: 48 00 18 ed bl ffc0cc34 <_Thread_Get>
switch ( location ) {
ffc0b34c: 80 01 00 08 lwz r0,8(r1)
ffc0b350: 2f 80 00 00 cmpwi cr7,r0,0
ffc0b354: 40 9e 00 18 bne- cr7,ffc0b36c <_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 );
ffc0b358: 48 00 23 05 bl ffc0d65c <_Thread_queue_Process_timeout>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc0b35c: 3d 20 00 00 lis r9,0
ffc0b360: 81 69 27 b8 lwz r11,10168(r9)
ffc0b364: 38 0b ff ff addi r0,r11,-1
ffc0b368: 90 09 27 b8 stw r0,10168(r9)
_Thread_Unnest_dispatch();
break;
}
}
ffc0b36c: 80 01 00 1c lwz r0,28(r1)
ffc0b370: 38 21 00 18 addi r1,r1,24
ffc0b374: 7c 08 03 a6 mtlr r0
ffc0b378: 4e 80 00 20 blr
ffc19cd0 <_CORE_message_queue_Broadcast>:
Objects_Id id __attribute__((unused)),
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)),
#endif
uint32_t *count
)
{
ffc19cd0: 94 21 ff e0 stwu r1,-32(r1)
ffc19cd4: 7c 08 02 a6 mflr r0
ffc19cd8: 90 01 00 24 stw r0,36(r1)
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
ffc19cdc: 80 03 00 4c lwz r0,76(r3)
Objects_Id id __attribute__((unused)),
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)),
#endif
uint32_t *count
)
{
ffc19ce0: bf 41 00 08 stmw r26,8(r1)
ffc19ce4: 7c 7f 1b 78 mr r31,r3
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
ffc19ce8: 7f 85 00 40 cmplw cr7,r5,r0
Objects_Id id __attribute__((unused)),
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)),
#endif
uint32_t *count
)
{
ffc19cec: 7c 9d 23 78 mr r29,r4
ffc19cf0: 7c be 2b 78 mr r30,r5
ffc19cf4: 7d 1b 43 78 mr r27,r8
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE;
ffc19cf8: 38 60 00 01 li r3,1
{
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
ffc19cfc: 41 9d 00 54 bgt- cr7,ffc19d50 <_CORE_message_queue_Broadcast+0x80><== NEVER TAKEN
* NOTE: This check is critical because threads can block on
* send and receive and this ensures that we are broadcasting
* the message to threads waiting to receive -- not to send.
*/
if ( the_message_queue->number_of_pending_messages != 0 ) {
ffc19d00: 80 1f 00 48 lwz r0,72(r31)
ffc19d04: 3b 80 00 00 li r28,0
ffc19d08: 2f 80 00 00 cmpwi cr7,r0,0
ffc19d0c: 41 be 00 30 beq+ cr7,ffc19d3c <_CORE_message_queue_Broadcast+0x6c>
*count = 0;
ffc19d10: 38 00 00 00 li r0,0
ffc19d14: 90 08 00 00 stw r0,0(r8)
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
ffc19d18: 38 60 00 00 li r3,0
ffc19d1c: 48 00 00 34 b ffc19d50 <_CORE_message_queue_Broadcast+0x80>
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
ffc19d20: 80 7a 00 2c lwz r3,44(r26)
ffc19d24: 7f a4 eb 78 mr r4,r29
ffc19d28: 7f c5 f3 78 mr r5,r30
ffc19d2c: 48 00 99 49 bl ffc23674 <memcpy>
buffer,
waitp->return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
ffc19d30: 81 3a 00 28 lwz r9,40(r26)
*/
number_broadcasted = 0;
while ((the_thread =
_Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
waitp = &the_thread->Wait;
number_broadcasted += 1;
ffc19d34: 3b 9c 00 01 addi r28,r28,1
buffer,
waitp->return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
ffc19d38: 93 c9 00 00 stw r30,0(r9)
/*
* There must be no pending messages if there is a thread waiting to
* receive a message.
*/
number_broadcasted = 0;
while ((the_thread =
ffc19d3c: 7f e3 fb 78 mr r3,r31
ffc19d40: 48 00 2e 7d bl ffc1cbbc <_Thread_queue_Dequeue>
ffc19d44: 7c 7a 1b 79 mr. r26,r3
ffc19d48: 40 82 ff d8 bne+ ffc19d20 <_CORE_message_queue_Broadcast+0x50>
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_message_queue_mp_support) ( the_thread, id );
#endif
}
*count = number_broadcasted;
ffc19d4c: 93 9b 00 00 stw r28,0(r27)
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
}
ffc19d50: 39 61 00 20 addi r11,r1,32
ffc19d54: 4b ff 45 54 b ffc0e2a8 <_restgpr_26_x>
ffc11ac0 <_CORE_message_queue_Initialize>:
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Attributes *the_message_queue_attributes,
uint32_t maximum_pending_messages,
size_t maximum_message_size
)
{
ffc11ac0: 94 21 ff e0 stwu r1,-32(r1)
ffc11ac4: 7c 08 02 a6 mflr r0
/*
* Round size up to multiple of a pointer for chain init and
* check for overflow on adding overhead to each message.
*/
allocated_message_size = maximum_message_size;
if (allocated_message_size & (sizeof(uint32_t) - 1)) {
ffc11ac8: 7c c9 33 78 mr r9,r6
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Attributes *the_message_queue_attributes,
uint32_t maximum_pending_messages,
size_t maximum_message_size
)
{
ffc11acc: 90 01 00 24 stw r0,36(r1)
size_t message_buffering_required;
size_t allocated_message_size;
the_message_queue->maximum_pending_messages = maximum_pending_messages;
the_message_queue->number_of_pending_messages = 0;
ffc11ad0: 38 00 00 00 li r0,0
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Attributes *the_message_queue_attributes,
uint32_t maximum_pending_messages,
size_t maximum_message_size
)
{
ffc11ad4: bf 81 00 10 stmw r28,16(r1)
ffc11ad8: 7c 7f 1b 78 mr r31,r3
ffc11adc: 7c 9d 23 78 mr r29,r4
size_t message_buffering_required;
size_t allocated_message_size;
the_message_queue->maximum_pending_messages = maximum_pending_messages;
the_message_queue->number_of_pending_messages = 0;
ffc11ae0: 90 03 00 48 stw r0,72(r3)
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Notify_Handler the_handler,
void *the_argument
)
{
the_message_queue->notify_handler = the_handler;
ffc11ae4: 90 03 00 60 stw r0,96(r3)
the_message_queue->notify_argument = the_argument;
ffc11ae8: 90 03 00 64 stw r0,100(r3)
/*
* Round size up to multiple of a pointer for chain init and
* check for overflow on adding overhead to each message.
*/
allocated_message_size = maximum_message_size;
if (allocated_message_size & (sizeof(uint32_t) - 1)) {
ffc11aec: 70 c0 00 03 andi. r0,r6,3
)
{
size_t message_buffering_required;
size_t allocated_message_size;
the_message_queue->maximum_pending_messages = maximum_pending_messages;
ffc11af0: 90 a3 00 44 stw r5,68(r3)
the_message_queue->number_of_pending_messages = 0;
the_message_queue->maximum_message_size = maximum_message_size;
ffc11af4: 90 c3 00 4c stw r6,76(r3)
/*
* Round size up to multiple of a pointer for chain init and
* check for overflow on adding overhead to each message.
*/
allocated_message_size = maximum_message_size;
if (allocated_message_size & (sizeof(uint32_t) - 1)) {
ffc11af8: 41 82 00 18 beq- ffc11b10 <_CORE_message_queue_Initialize+0x50>
allocated_message_size += sizeof(uint32_t);
ffc11afc: 39 26 00 04 addi r9,r6,4
allocated_message_size &= ~(sizeof(uint32_t) - 1);
ffc11b00: 55 29 00 3a rlwinm r9,r9,0,0,29
}
if (allocated_message_size < maximum_message_size)
ffc11b04: 7f 89 30 40 cmplw cr7,r9,r6
return false;
ffc11b08: 3b c0 00 00 li r30,0
if (allocated_message_size & (sizeof(uint32_t) - 1)) {
allocated_message_size += sizeof(uint32_t);
allocated_message_size &= ~(sizeof(uint32_t) - 1);
}
if (allocated_message_size < maximum_message_size)
ffc11b0c: 41 bc 00 78 blt+ cr7,ffc11b84 <_CORE_message_queue_Initialize+0xc4><== NEVER TAKEN
/*
* Calculate how much total memory is required for message buffering and
* check for overflow on the multiplication.
*/
message_buffering_required = (size_t) maximum_pending_messages *
(allocated_message_size + sizeof(CORE_message_queue_Buffer_control));
ffc11b10: 3b 89 00 14 addi r28,r9,20
/*
* Calculate how much total memory is required for message buffering and
* check for overflow on the multiplication.
*/
message_buffering_required = (size_t) maximum_pending_messages *
ffc11b14: 7c 7c 29 d6 mullw r3,r28,r5
(allocated_message_size + sizeof(CORE_message_queue_Buffer_control));
if (message_buffering_required < allocated_message_size)
return false;
ffc11b18: 3b c0 00 00 li r30,0
* check for overflow on the multiplication.
*/
message_buffering_required = (size_t) maximum_pending_messages *
(allocated_message_size + sizeof(CORE_message_queue_Buffer_control));
if (message_buffering_required < allocated_message_size)
ffc11b1c: 7f 83 48 40 cmplw cr7,r3,r9
ffc11b20: 41 bc 00 64 blt+ cr7,ffc11b84 <_CORE_message_queue_Initialize+0xc4><== NEVER TAKEN
/*
* Attempt to allocate the message memory
*/
the_message_queue->message_buffers = (CORE_message_queue_Buffer *)
_Workspace_Allocate( message_buffering_required );
ffc11b24: 90 a1 00 08 stw r5,8(r1)
ffc11b28: 48 00 33 7d bl ffc14ea4 <_Workspace_Allocate>
if (the_message_queue->message_buffers == 0)
ffc11b2c: 2f 83 00 00 cmpwi cr7,r3,0
/*
* Attempt to allocate the message memory
*/
the_message_queue->message_buffers = (CORE_message_queue_Buffer *)
_Workspace_Allocate( message_buffering_required );
ffc11b30: 7c 64 1b 78 mr r4,r3
return false;
/*
* Attempt to allocate the message memory
*/
the_message_queue->message_buffers = (CORE_message_queue_Buffer *)
ffc11b34: 90 7f 00 5c stw r3,92(r31)
_Workspace_Allocate( message_buffering_required );
if (the_message_queue->message_buffers == 0)
ffc11b38: 80 a1 00 08 lwz r5,8(r1)
ffc11b3c: 41 9e 00 48 beq- cr7,ffc11b84 <_CORE_message_queue_Initialize+0xc4>
/*
* Initialize the pool of inactive messages, pending messages,
* and set of waiting threads.
*/
_Chain_Initialize (
ffc11b40: 38 7f 00 68 addi r3,r31,104
ffc11b44: 7f 86 e3 78 mr r6,r28
ffc11b48: 48 00 5a 29 bl ffc17570 <_Chain_Initialize>
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 );
ffc11b4c: 38 1f 00 54 addi r0,r31,84
head->next = tail;
ffc11b50: 90 1f 00 50 stw r0,80(r31)
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
ffc11b54: 38 1f 00 50 addi r0,r31,80
allocated_message_size + sizeof( CORE_message_queue_Buffer_control )
);
_Chain_Initialize_empty( &the_message_queue->Pending_messages );
_Thread_queue_Initialize(
ffc11b58: 7f e3 fb 78 mr r3,r31
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
head->previous = NULL;
ffc11b5c: 93 df 00 54 stw r30,84(r31)
ffc11b60: 38 a0 00 80 li r5,128
ffc11b64: 38 c0 00 06 li r6,6
tail->previous = head;
ffc11b68: 90 1f 00 58 stw r0,88(r31)
THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO,
STATES_WAITING_FOR_MESSAGE,
CORE_MESSAGE_QUEUE_STATUS_TIMEOUT
);
return true;
ffc11b6c: 3b c0 00 01 li r30,1
allocated_message_size + sizeof( CORE_message_queue_Buffer_control )
);
_Chain_Initialize_empty( &the_message_queue->Pending_messages );
_Thread_queue_Initialize(
ffc11b70: 80 9d 00 00 lwz r4,0(r29)
ffc11b74: 68 84 00 01 xori r4,r4,1
ffc11b78: 7c 84 00 34 cntlzw r4,r4
ffc11b7c: 54 84 d9 7e rlwinm r4,r4,27,5,31
ffc11b80: 48 00 27 2d bl ffc142ac <_Thread_queue_Initialize>
STATES_WAITING_FOR_MESSAGE,
CORE_MESSAGE_QUEUE_STATUS_TIMEOUT
);
return true;
}
ffc11b84: 39 61 00 20 addi r11,r1,32
ffc11b88: 7f c3 f3 78 mr r3,r30
ffc11b8c: 4b ff 3e 44 b ffc059d0 <_restgpr_28_x>
ffc11b90 <_CORE_message_queue_Seize>:
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
ffc11b90: 94 21 ff e8 stwu r1,-24(r1)
ffc11b94: 7c 08 02 a6 mflr r0
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
ffc11b98: 3d 60 00 00 lis r11,0
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
ffc11b9c: 90 01 00 1c stw r0,28(r1)
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
ffc11ba0: 39 40 00 00 li r10,0
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
ffc11ba4: 7c 80 23 78 mr r0,r4
ffc11ba8: bf a1 00 0c stmw r29,12(r1)
ffc11bac: 7c a9 2b 78 mr r9,r5
ffc11bb0: 7c 7f 1b 78 mr r31,r3
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
ffc11bb4: 81 6b 32 90 lwz r11,12944(r11)
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
ffc11bb8: 91 4b 00 34 stw r10,52(r11)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc11bbc: 7d 40 00 a6 mfmsr r10
ffc11bc0: 7c b0 42 a6 mfsprg r5,0
ffc11bc4: 7d 45 28 78 andc r5,r10,r5
ffc11bc8: 7c a0 01 24 mtmsr r5
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
}
ffc11bcc: 83 c3 00 50 lwz r30,80(r3)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc11bd0: 38 a3 00 54 addi r5,r3,84
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
Chain_Control *the_chain
)
{
if ( !_Chain_Is_empty(the_chain))
ffc11bd4: 7f 9e 28 00 cmpw cr7,r30,r5
ffc11bd8: 41 9e 00 a4 beq- cr7,ffc11c7c <_CORE_message_queue_Seize+0xec>
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
the_message = _CORE_message_queue_Get_pending_message( the_message_queue );
if ( the_message != NULL ) {
ffc11bdc: 2f 9e 00 00 cmpwi cr7,r30,0
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *old_first = head->next;
Chain_Node *new_first = old_first->next;
ffc11be0: 80 9e 00 00 lwz r4,0(r30)
head->next = new_first;
ffc11be4: 7c 65 1b 78 mr r5,r3
ffc11be8: 94 85 00 50 stwu r4,80(r5)
new_first->previous = head;
ffc11bec: 90 a4 00 04 stw r5,4(r4)
ffc11bf0: 41 9e 00 8c beq- cr7,ffc11c7c <_CORE_message_queue_Seize+0xec><== NEVER TAKEN
the_message_queue->number_of_pending_messages -= 1;
ffc11bf4: 81 63 00 48 lwz r11,72(r3)
ffc11bf8: 38 0b ff ff addi r0,r11,-1
ffc11bfc: 90 03 00 48 stw r0,72(r3)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc11c00: 7d 40 01 24 mtmsr r10
_ISR_Enable( level );
*size_p = the_message->Contents.size;
ffc11c04: 80 be 00 0c lwz r5,12(r30)
_Thread_Executing->Wait.count =
ffc11c08: 3d 60 00 00 lis r11,0
ffc11c0c: 81 6b 32 90 lwz r11,12944(r11)
_CORE_message_queue_Get_message_priority( the_message );
_CORE_message_queue_Copy_buffer(
the_message->Contents.buffer,
ffc11c10: 3b be 00 10 addi r29,r30,16
the_message = _CORE_message_queue_Get_pending_message( the_message_queue );
if ( the_message != NULL ) {
the_message_queue->number_of_pending_messages -= 1;
_ISR_Enable( level );
*size_p = the_message->Contents.size;
ffc11c14: 90 a6 00 00 stw r5,0(r6)
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
ffc11c18: 7d 23 4b 78 mr r3,r9
ffc11c1c: 7f a4 eb 78 mr r4,r29
_Thread_Executing->Wait.count =
ffc11c20: 80 1e 00 08 lwz r0,8(r30)
ffc11c24: 90 0b 00 24 stw r0,36(r11)
ffc11c28: 48 00 8c d9 bl ffc1a900 <memcpy>
* is not, then we can go ahead and free the buffer.
*
* NOTE: If we note that the queue was not full before this receive,
* then we can avoid this dequeue.
*/
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
ffc11c2c: 7f e3 fb 78 mr r3,r31
ffc11c30: 48 00 22 05 bl ffc13e34 <_Thread_queue_Dequeue>
if ( !the_thread ) {
ffc11c34: 7c 69 1b 79 mr. r9,r3
ffc11c38: 40 a2 00 14 bne+ ffc11c4c <_CORE_message_queue_Seize+0xbc>
RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer (
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Buffer_control *the_message
)
{
_Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node );
ffc11c3c: 38 7f 00 68 addi r3,r31,104
ffc11c40: 7f c4 f3 78 mr r4,r30
ffc11c44: 4b ff fd b9 bl ffc119fc <_Chain_Append>
_CORE_message_queue_Free_message_buffer(
the_message_queue,
the_message
);
return;
ffc11c48: 48 00 00 7c b ffc11cc4 <_CORE_message_queue_Seize+0x134>
CORE_message_queue_Buffer_control *the_message,
int priority
)
{
#if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
the_message->priority = priority;
ffc11c4c: 80 09 00 24 lwz r0,36(r9)
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
ffc11c50: 7f a3 eb 78 mr r3,r29
*/
_CORE_message_queue_Set_message_priority(
the_message,
the_thread->Wait.count
);
the_message->Contents.size = (size_t) the_thread->Wait.option;
ffc11c54: 80 a9 00 30 lwz r5,48(r9)
ffc11c58: 80 89 00 2c lwz r4,44(r9)
ffc11c5c: 90 be 00 0c stw r5,12(r30)
CORE_message_queue_Buffer_control *the_message,
int priority
)
{
#if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
the_message->priority = priority;
ffc11c60: 90 1e 00 08 stw r0,8(r30)
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
ffc11c64: 48 00 8c 9d bl ffc1a900 <memcpy>
the_thread->Wait.return_argument_second.immutable_object,
the_message->Contents.buffer,
the_message->Contents.size
);
_CORE_message_queue_Insert_message(
ffc11c68: 80 be 00 08 lwz r5,8(r30)
ffc11c6c: 7f e3 fb 78 mr r3,r31
ffc11c70: 7f c4 f3 78 mr r4,r30
ffc11c74: 48 00 59 4d bl ffc175c0 <_CORE_message_queue_Insert_message>
the_message_queue,
the_message,
_CORE_message_queue_Get_message_priority( the_message )
);
return;
ffc11c78: 48 00 00 4c b ffc11cc4 <_CORE_message_queue_Seize+0x134>
}
#endif
}
if ( !wait ) {
ffc11c7c: 2f 87 00 00 cmpwi cr7,r7,0
ffc11c80: 40 9e 00 14 bne- cr7,ffc11c94 <_CORE_message_queue_Seize+0x104>
ffc11c84: 7d 40 01 24 mtmsr r10
_ISR_Enable( level );
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
ffc11c88: 38 00 00 04 li r0,4
ffc11c8c: 90 0b 00 34 stw r0,52(r11)
return;
ffc11c90: 48 00 00 34 b ffc11cc4 <_CORE_message_queue_Seize+0x134>
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;
ffc11c94: 38 e0 00 01 li r7,1
ffc11c98: 90 ff 00 30 stw r7,48(r31)
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
ffc11c9c: 93 eb 00 44 stw r31,68(r11)
executing->Wait.id = id;
ffc11ca0: 90 0b 00 20 stw r0,32(r11)
executing->Wait.return_argument_second.mutable_object = buffer;
ffc11ca4: 91 2b 00 2c stw r9,44(r11)
executing->Wait.return_argument = size_p;
ffc11ca8: 90 cb 00 28 stw r6,40(r11)
ffc11cac: 7d 40 01 24 mtmsr r10
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
ffc11cb0: 3c a0 ff c1 lis r5,-63
ffc11cb4: 7f e3 fb 78 mr r3,r31
ffc11cb8: 7d 04 43 78 mr r4,r8
ffc11cbc: 38 a5 43 88 addi r5,r5,17288
ffc11cc0: 48 00 23 0d bl ffc13fcc <_Thread_queue_Enqueue_with_handler>
}
ffc11cc4: 39 61 00 18 addi r11,r1,24
ffc11cc8: 4b ff 3d 0c b ffc059d4 <_restgpr_29_x>
ffc09a30 <_CORE_mutex_Seize>:
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
ffc09a30: 94 21 ff e0 stwu r1,-32(r1)
ffc09a34: 7c 08 02 a6 mflr r0
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
ffc09a38: 3d 20 00 00 lis r9,0
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
ffc09a3c: 90 01 00 24 stw r0,36(r1)
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
ffc09a40: 80 09 27 88 lwz r0,10120(r9)
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
ffc09a44: bf 81 00 10 stmw r28,16(r1)
ffc09a48: 7c 7f 1b 78 mr r31,r3
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
ffc09a4c: 2f 80 00 00 cmpwi cr7,r0,0
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
ffc09a50: 7c 9e 23 78 mr r30,r4
ffc09a54: 90 e1 00 08 stw r7,8(r1)
ffc09a58: 7c bd 2b 78 mr r29,r5
ffc09a5c: 7c dc 33 78 mr r28,r6
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
ffc09a60: 41 9e 00 2c beq- cr7,ffc09a8c <_CORE_mutex_Seize+0x5c>
ffc09a64: 2f 85 00 00 cmpwi cr7,r5,0
ffc09a68: 41 9e 00 24 beq- cr7,ffc09a8c <_CORE_mutex_Seize+0x5c> <== NEVER TAKEN
ffc09a6c: 3d 20 00 00 lis r9,0
ffc09a70: 80 09 27 cc lwz r0,10188(r9)
ffc09a74: 2b 80 00 01 cmplwi cr7,r0,1
ffc09a78: 40 bd 00 14 ble+ cr7,ffc09a8c <_CORE_mutex_Seize+0x5c>
ffc09a7c: 38 60 00 00 li r3,0
ffc09a80: 38 80 00 00 li r4,0
ffc09a84: 38 a0 00 12 li r5,18
ffc09a88: 48 00 07 25 bl ffc0a1ac <_Internal_error_Occurred>
ffc09a8c: 7f e3 fb 78 mr r3,r31
ffc09a90: 38 81 00 08 addi r4,r1,8
ffc09a94: 48 00 83 29 bl ffc11dbc <_CORE_mutex_Seize_interrupt_trylock>
ffc09a98: 2f 83 00 00 cmpwi cr7,r3,0
ffc09a9c: 41 9e 00 64 beq- cr7,ffc09b00 <_CORE_mutex_Seize+0xd0>
ffc09aa0: 2f 9d 00 00 cmpwi cr7,r29,0
ffc09aa4: 3d 20 00 00 lis r9,0
ffc09aa8: 39 29 31 84 addi r9,r9,12676
ffc09aac: 40 9e 00 1c bne- cr7,ffc09ac8 <_CORE_mutex_Seize+0x98>
ffc09ab0: 80 01 00 08 lwz r0,8(r1)
ffc09ab4: 7c 00 01 24 mtmsr r0
ffc09ab8: 81 29 00 0c lwz r9,12(r9)
ffc09abc: 38 00 00 01 li r0,1
ffc09ac0: 90 09 00 34 stw r0,52(r9)
ffc09ac4: 48 00 00 3c b ffc09b00 <_CORE_mutex_Seize+0xd0>
ffc09ac8: 81 29 00 0c lwz r9,12(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;
ffc09acc: 38 00 00 01 li r0,1
ffc09ad0: 90 1f 00 30 stw r0,48(r31)
ffc09ad4: 93 e9 00 44 stw r31,68(r9)
ffc09ad8: 93 c9 00 20 stw r30,32(r9)
ffc09adc: 3d 20 00 00 lis r9,0
ffc09ae0: 81 69 27 88 lwz r11,10120(r9)
ffc09ae4: 38 0b 00 01 addi r0,r11,1
ffc09ae8: 90 09 27 88 stw r0,10120(r9)
ffc09aec: 80 01 00 08 lwz r0,8(r1)
ffc09af0: 7c 00 01 24 mtmsr r0
ffc09af4: 7f e3 fb 78 mr r3,r31
ffc09af8: 7f 84 e3 78 mr r4,r28
ffc09afc: 4b ff fe c1 bl ffc099bc <_CORE_mutex_Seize_interrupt_blocking>
}
ffc09b00: 39 61 00 20 addi r11,r1,32
ffc09b04: 48 00 f7 58 b ffc1925c <_restgpr_28_x>
ffc09ca8 <_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
)
{
ffc09ca8: 7c 08 02 a6 mflr r0
ffc09cac: 7c 2b 0b 78 mr r11,r1
ffc09cb0: 94 21 ff f0 stwu r1,-16(r1)
ffc09cb4: 90 01 00 14 stw r0,20(r1)
ffc09cb8: 48 00 f5 65 bl ffc1921c <_savegpr_31>
ffc09cbc: 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)) ) {
ffc09cc0: 48 00 1b bd bl ffc0b87c <_Thread_queue_Dequeue>
ffc09cc4: 2f 83 00 00 cmpwi cr7,r3,0
{
Thread_Control *the_thread;
ISR_Level level;
CORE_semaphore_Status status;
status = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
ffc09cc8: 38 00 00 00 li r0,0
if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) {
ffc09ccc: 40 be 00 38 bne+ cr7,ffc09d04 <_CORE_semaphore_Surrender+0x5c>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc09cd0: 7d 60 00 a6 mfmsr r11
ffc09cd4: 7c 10 42 a6 mfsprg r0,0
ffc09cd8: 7d 60 00 78 andc r0,r11,r0
ffc09cdc: 7c 00 01 24 mtmsr r0
(*api_semaphore_mp_support) ( the_thread, id );
#endif
} else {
_ISR_Disable( level );
if ( the_semaphore->count < the_semaphore->Attributes.maximum_count )
ffc09ce0: 81 3f 00 48 lwz r9,72(r31)
the_semaphore->count += 1;
else
status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED;
ffc09ce4: 38 00 00 04 li r0,4
(*api_semaphore_mp_support) ( the_thread, id );
#endif
} else {
_ISR_Disable( level );
if ( the_semaphore->count < the_semaphore->Attributes.maximum_count )
ffc09ce8: 81 5f 00 40 lwz r10,64(r31)
ffc09cec: 7f 89 50 40 cmplw cr7,r9,r10
ffc09cf0: 40 9c 00 10 bge- cr7,ffc09d00 <_CORE_semaphore_Surrender+0x58><== NEVER TAKEN
the_semaphore->count += 1;
ffc09cf4: 39 29 00 01 addi r9,r9,1
ffc09cf8: 91 3f 00 48 stw r9,72(r31)
{
Thread_Control *the_thread;
ISR_Level level;
CORE_semaphore_Status status;
status = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
ffc09cfc: 38 00 00 00 li r0,0
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc09d00: 7d 60 01 24 mtmsr r11
status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED;
_ISR_Enable( level );
}
return status;
}
ffc09d04: 39 61 00 10 addi r11,r1,16
ffc09d08: 7c 03 03 78 mr r3,r0
ffc09d0c: 48 00 f5 5c b ffc19268 <_restgpr_31_x>
ffc086b0 <_Event_Surrender>:
*/
void _Event_Surrender(
Thread_Control *the_thread
)
{
ffc086b0: 7c 2b 0b 78 mr r11,r1
ffc086b4: 7c 08 02 a6 mflr r0
ffc086b8: 94 21 ff f0 stwu r1,-16(r1)
ffc086bc: 90 01 00 14 stw r0,20(r1)
ffc086c0: 48 01 0b 5d bl ffc1921c <_savegpr_31>
ffc086c4: 7c 7f 1b 78 mr r31,r3
rtems_event_set event_condition;
rtems_event_set seized_events;
rtems_option option_set;
RTEMS_API_Control *api;
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
ffc086c8: 81 03 01 30 lwz r8,304(r3)
option_set = (rtems_option) the_thread->Wait.option;
ffc086cc: 80 e3 00 30 lwz r7,48(r3)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc086d0: 7c 00 00 a6 mfmsr r0
ffc086d4: 7d 30 42 a6 mfsprg r9,0
ffc086d8: 7c 09 48 78 andc r9,r0,r9
ffc086dc: 7d 20 01 24 mtmsr r9
_ISR_Disable( level );
pending_events = api->pending_events;
ffc086e0: 81 68 00 00 lwz r11,0(r8)
event_condition = (rtems_event_set) the_thread->Wait.count;
ffc086e4: 81 43 00 24 lwz r10,36(r3)
seized_events = _Event_sets_Get( pending_events, event_condition );
/*
* No events were seized in this operation
*/
if ( _Event_sets_Is_empty( seized_events ) ) {
ffc086e8: 7d 49 58 39 and. r9,r10,r11
ffc086ec: 40 a2 00 08 bne+ ffc086f4 <_Event_Surrender+0x44>
_ISR_Enable( level );
ffc086f0: 48 00 00 f4 b ffc087e4 <_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() &&
ffc086f4: 3c c0 00 00 lis r6,0
ffc086f8: 38 c6 31 84 addi r6,r6,12676
ffc086fc: 80 a6 00 08 lwz r5,8(r6)
ffc08700: 2f 85 00 00 cmpwi cr7,r5,0
ffc08704: 41 9e 00 64 beq- cr7,ffc08768 <_Event_Surrender+0xb8>
ffc08708: 80 c6 00 0c lwz r6,12(r6)
ffc0870c: 7f 83 30 00 cmpw cr7,r3,r6
ffc08710: 40 be 00 58 bne+ cr7,ffc08768 <_Event_Surrender+0xb8>
_Thread_Is_executing( the_thread ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
ffc08714: 3c c0 00 00 lis r6,0
ffc08718: 80 a6 27 dc lwz r5,10204(r6)
/*
* 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 ) &&
ffc0871c: 2f 85 00 02 cmpwi cr7,r5,2
ffc08720: 41 9e 00 10 beq- cr7,ffc08730 <_Event_Surrender+0x80> <== NEVER TAKEN
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) {
ffc08724: 80 c6 27 dc lwz r6,10204(r6)
* 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 ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
ffc08728: 2f 86 00 01 cmpwi cr7,r6,1
ffc0872c: 40 be 00 3c bne+ cr7,ffc08768 <_Event_Surrender+0xb8>
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
ffc08730: 7f 89 50 00 cmpw cr7,r9,r10
ffc08734: 41 9e 00 0c beq- cr7,ffc08740 <_Event_Surrender+0x90>
ffc08738: 70 e5 00 02 andi. r5,r7,2
ffc0873c: 41 82 00 28 beq- ffc08764 <_Event_Surrender+0xb4> <== 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) );
ffc08740: 7d 6b 48 78 andc r11,r11,r9
api->pending_events = _Event_sets_Clear( pending_events,seized_events );
ffc08744: 91 68 00 00 stw r11,0(r8)
the_thread->Wait.count = 0;
ffc08748: 39 60 00 00 li r11,0
ffc0874c: 91 7f 00 24 stw r11,36(r31)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
ffc08750: 81 7f 00 28 lwz r11,40(r31)
ffc08754: 91 2b 00 00 stw r9,0(r11)
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
ffc08758: 39 60 00 03 li r11,3
ffc0875c: 3d 20 00 00 lis r9,0
ffc08760: 91 69 27 dc stw r11,10204(r9)
}
_ISR_Enable( level );
ffc08764: 48 00 00 80 b ffc087e4 <_Event_Surrender+0x134>
*/
RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event (
States_Control the_states
)
{
return (the_states & STATES_WAITING_FOR_EVENT);
ffc08768: 80 df 00 10 lwz r6,16(r31)
}
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Is_waiting_for_event( the_thread->current_state ) ) {
ffc0876c: 70 c5 01 00 andi. r5,r6,256
ffc08770: 41 82 00 74 beq- ffc087e4 <_Event_Surrender+0x134>
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
ffc08774: 7f 89 50 00 cmpw cr7,r9,r10
ffc08778: 41 9e 00 0c beq- cr7,ffc08784 <_Event_Surrender+0xd4>
ffc0877c: 70 ea 00 02 andi. r10,r7,2
ffc08780: 41 82 00 64 beq- ffc087e4 <_Event_Surrender+0x134> <== NEVER TAKEN
ffc08784: 7d 6b 48 78 andc r11,r11,r9
api->pending_events = _Event_sets_Clear( pending_events, seized_events );
ffc08788: 91 68 00 00 stw r11,0(r8)
the_thread->Wait.count = 0;
ffc0878c: 39 60 00 00 li r11,0
ffc08790: 91 7f 00 24 stw r11,36(r31)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
ffc08794: 81 7f 00 28 lwz r11,40(r31)
ffc08798: 91 2b 00 00 stw r9,0(r11)
static inline void ppc_interrupt_flash( uint32_t level )
{
uint32_t current_level;
asm volatile (
ffc0879c: 7d 20 00 a6 mfmsr r9
ffc087a0: 7c 00 01 24 mtmsr r0
ffc087a4: 7d 20 01 24 mtmsr r9
_ISR_Flash( level );
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
ffc087a8: 81 3f 00 50 lwz r9,80(r31)
ffc087ac: 2f 89 00 02 cmpwi cr7,r9,2
ffc087b0: 41 9e 00 0c beq- cr7,ffc087bc <_Event_Surrender+0x10c>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc087b4: 7c 00 01 24 mtmsr r0
ffc087b8: 48 00 00 18 b ffc087d0 <_Event_Surrender+0x120>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
ffc087bc: 39 20 00 03 li r9,3
ffc087c0: 91 3f 00 50 stw r9,80(r31)
ffc087c4: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
(void) _Watchdog_Remove( &the_thread->Timer );
ffc087c8: 38 7f 00 48 addi r3,r31,72
ffc087cc: 48 00 3e a9 bl ffc0c674 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc087d0: 3c 80 10 03 lis r4,4099
ffc087d4: 7f e3 fb 78 mr r3,r31
ffc087d8: 60 84 ff f8 ori r4,r4,65528
ffc087dc: 48 00 29 09 bl ffc0b0e4 <_Thread_Clear_state>
ffc087e0: 48 00 00 08 b ffc087e8 <_Event_Surrender+0x138>
ffc087e4: 7c 00 01 24 mtmsr r0
}
return;
}
}
_ISR_Enable( level );
}
ffc087e8: 39 61 00 10 addi r11,r1,16
ffc087ec: 48 01 0a 7c b ffc19268 <_restgpr_31_x>
ffc087f0 <_Event_Timeout>:
void _Event_Timeout(
Objects_Id id,
void *ignored
)
{
ffc087f0: 94 21 ff e8 stwu r1,-24(r1)
ffc087f4: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
ISR_Level level;
the_thread = _Thread_Get( id, &location );
ffc087f8: 38 81 00 08 addi r4,r1,8
void _Event_Timeout(
Objects_Id id,
void *ignored
)
{
ffc087fc: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
ISR_Level level;
the_thread = _Thread_Get( id, &location );
ffc08800: 48 00 2c e1 bl ffc0b4e0 <_Thread_Get>
switch ( location ) {
ffc08804: 80 01 00 08 lwz r0,8(r1)
ffc08808: 2f 80 00 00 cmpwi cr7,r0,0
ffc0880c: 40 9e 00 68 bne- cr7,ffc08874 <_Event_Timeout+0x84> <== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc08810: 7d 60 00 a6 mfmsr r11
ffc08814: 7d 30 42 a6 mfsprg r9,0
ffc08818: 7d 69 48 78 andc r9,r11,r9
ffc0881c: 7d 20 01 24 mtmsr r9
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc08820: 3d 20 00 00 lis r9,0
_ISR_Enable( level );
return;
}
#endif
the_thread->Wait.count = 0;
ffc08824: 90 03 00 24 stw r0,36(r3)
if ( _Thread_Is_executing( the_thread ) ) {
ffc08828: 80 09 31 90 lwz r0,12688(r9)
ffc0882c: 7f 83 00 00 cmpw cr7,r3,r0
ffc08830: 40 be 00 1c bne+ cr7,ffc0884c <_Event_Timeout+0x5c>
if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
ffc08834: 3d 20 00 00 lis r9,0
ffc08838: 80 09 27 dc lwz r0,10204(r9)
ffc0883c: 2f 80 00 01 cmpwi cr7,r0,1
ffc08840: 40 be 00 0c bne+ cr7,ffc0884c <_Event_Timeout+0x5c>
_Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
ffc08844: 38 00 00 02 li r0,2
ffc08848: 90 09 27 dc stw r0,10204(r9)
}
the_thread->Wait.return_code = RTEMS_TIMEOUT;
ffc0884c: 38 00 00 06 li r0,6
ffc08850: 90 03 00 34 stw r0,52(r3)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc08854: 7d 60 01 24 mtmsr r11
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc08858: 3c 80 10 03 lis r4,4099
ffc0885c: 60 84 ff f8 ori r4,r4,65528
ffc08860: 48 00 28 85 bl ffc0b0e4 <_Thread_Clear_state>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc08864: 3d 20 00 00 lis r9,0
ffc08868: 81 69 27 88 lwz r11,10120(r9)
ffc0886c: 38 0b ff ff addi r0,r11,-1
ffc08870: 90 09 27 88 stw r0,10120(r9)
case OBJECTS_REMOTE: /* impossible */
#endif
case OBJECTS_ERROR:
break;
}
}
ffc08874: 80 01 00 1c lwz r0,28(r1)
ffc08878: 38 21 00 18 addi r1,r1,24
ffc0887c: 7c 08 03 a6 mtlr r0
ffc08880: 4e 80 00 20 blr
ffc0e4a4 <_Heap_Extend>:
Heap_Control *heap,
void *extend_area_begin_ptr,
uintptr_t extend_area_size,
uintptr_t *extended_size_ptr
)
{
ffc0e4a4: 94 21 ff c0 stwu r1,-64(r1)
ffc0e4a8: 7c 08 02 a6 mflr r0
ffc0e4ac: be c1 00 18 stmw r22,24(r1)
Heap_Block *extend_first_block = NULL;
Heap_Block *extend_last_block = NULL;
uintptr_t const page_size = heap->page_size;
uintptr_t const min_block_size = heap->min_block_size;
uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr;
uintptr_t const extend_area_end = extend_area_begin + extend_area_size;
ffc0e4b0: 7f c4 2a 14 add r30,r4,r5
uintptr_t const free_size = stats->free_size;
uintptr_t extend_first_block_size = 0;
uintptr_t extended_size = 0;
bool extend_area_ok = false;
if ( extend_area_end < extend_area_begin ) {
ffc0e4b4: 7f 9e 20 40 cmplw cr7,r30,r4
Heap_Control *heap,
void *extend_area_begin_ptr,
uintptr_t extend_area_size,
uintptr_t *extended_size_ptr
)
{
ffc0e4b8: 90 01 00 44 stw r0,68(r1)
Heap_Block *start_block = first_block;
Heap_Block *merge_below_block = NULL;
Heap_Block *merge_above_block = NULL;
Heap_Block *link_below_block = NULL;
Heap_Block *link_above_block = NULL;
Heap_Block *extend_first_block = NULL;
ffc0e4bc: 3b 40 00 00 li r26,0
Heap_Control *heap,
void *extend_area_begin_ptr,
uintptr_t extend_area_size,
uintptr_t *extended_size_ptr
)
{
ffc0e4c0: 7c d9 33 78 mr r25,r6
ffc0e4c4: 7c 7f 1b 78 mr r31,r3
Heap_Statistics *const stats = &heap->stats;
Heap_Block *const first_block = heap->first_block;
ffc0e4c8: 83 83 00 20 lwz r28,32(r3)
Heap_Control *heap,
void *extend_area_begin_ptr,
uintptr_t extend_area_size,
uintptr_t *extended_size_ptr
)
{
ffc0e4cc: 7c 9d 23 78 mr r29,r4
Heap_Block *start_block = first_block;
Heap_Block *merge_below_block = NULL;
Heap_Block *merge_above_block = NULL;
Heap_Block *link_below_block = NULL;
Heap_Block *link_above_block = NULL;
Heap_Block *extend_first_block = NULL;
ffc0e4d0: 93 41 00 08 stw r26,8(r1)
uintptr_t extend_first_block_size = 0;
uintptr_t extended_size = 0;
bool extend_area_ok = false;
if ( extend_area_end < extend_area_begin ) {
return false;
ffc0e4d4: 38 00 00 00 li r0,0
Heap_Block *merge_below_block = NULL;
Heap_Block *merge_above_block = NULL;
Heap_Block *link_below_block = NULL;
Heap_Block *link_above_block = NULL;
Heap_Block *extend_first_block = NULL;
Heap_Block *extend_last_block = NULL;
ffc0e4d8: 93 41 00 0c stw r26,12(r1)
uintptr_t const page_size = heap->page_size;
ffc0e4dc: 83 63 00 10 lwz r27,16(r3)
uintptr_t const min_block_size = heap->min_block_size;
ffc0e4e0: 80 c3 00 14 lwz r6,20(r3)
uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr;
uintptr_t const extend_area_end = extend_area_begin + extend_area_size;
uintptr_t const free_size = stats->free_size;
ffc0e4e4: 83 03 00 30 lwz r24,48(r3)
uintptr_t extend_first_block_size = 0;
uintptr_t extended_size = 0;
bool extend_area_ok = false;
if ( extend_area_end < extend_area_begin ) {
ffc0e4e8: 41 bc 02 70 blt+ cr7,ffc0e758 <_Heap_Extend+0x2b4>
return false;
}
extend_area_ok = _Heap_Get_first_and_last_block(
ffc0e4ec: 7c 83 23 78 mr r3,r4
ffc0e4f0: 38 e1 00 08 addi r7,r1,8
ffc0e4f4: 7c a4 2b 78 mr r4,r5
ffc0e4f8: 39 01 00 0c addi r8,r1,12
ffc0e4fc: 7f 65 db 78 mr r5,r27
ffc0e500: 4b ff ab 75 bl ffc09074 <_Heap_Get_first_and_last_block>
&extend_first_block,
&extend_last_block
);
if (!extend_area_ok ) {
/* For simplicity we reject extend areas that are too small */
return false;
ffc0e504: 7f 40 d3 78 mr r0,r26
page_size,
min_block_size,
&extend_first_block,
&extend_last_block
);
if (!extend_area_ok ) {
ffc0e508: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e50c: 41 9e 02 4c beq- cr7,ffc0e758 <_Heap_Extend+0x2b4>
ffc0e510: 7f 89 e3 78 mr r9,r28
ffc0e514: 3a c0 00 00 li r22,0
ffc0e518: 39 40 00 00 li r10,0
ffc0e51c: 3a e0 00 00 li r23,0
return false;
}
do {
uintptr_t const sub_area_begin = (start_block != first_block) ?
(uintptr_t) start_block : heap->area_begin;
ffc0e520: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0e524: 7d 2b 4b 78 mr r11,r9
ffc0e528: 40 be 00 08 bne+ cr7,ffc0e530 <_Heap_Extend+0x8c>
ffc0e52c: 81 7f 00 18 lwz r11,24(r31)
uintptr_t const sub_area_end = start_block->prev_size;
ffc0e530: 80 09 00 00 lwz r0,0(r9)
Heap_Block *const end_block =
_Heap_Block_of_alloc_area( sub_area_end, page_size );
if (
ffc0e534: 7f 80 e8 40 cmplw cr7,r0,r29
ffc0e538: 40 9d 00 0c ble- cr7,ffc0e544 <_Heap_Extend+0xa0>
sub_area_end > extend_area_begin && extend_area_end > sub_area_begin
ffc0e53c: 7f 9e 58 40 cmplw cr7,r30,r11
ffc0e540: 41 9d 02 14 bgt- cr7,ffc0e754 <_Heap_Extend+0x2b0>
) {
return false;
}
if ( extend_area_end == sub_area_begin ) {
ffc0e544: 7f 9e 58 00 cmpw cr7,r30,r11
ffc0e548: 41 9e 00 10 beq- cr7,ffc0e558 <_Heap_Extend+0xb4>
merge_below_block = start_block;
} else if ( extend_area_end < sub_area_end ) {
ffc0e54c: 7f 9e 00 40 cmplw cr7,r30,r0
ffc0e550: 41 9c 00 10 blt- cr7,ffc0e560 <_Heap_Extend+0xbc>
ffc0e554: 48 00 00 10 b ffc0e564 <_Heap_Extend+0xc0>
sub_area_end > extend_area_begin && extend_area_end > sub_area_begin
) {
return false;
}
if ( extend_area_end == sub_area_begin ) {
ffc0e558: 7d 37 4b 78 mr r23,r9
ffc0e55c: 48 00 00 08 b ffc0e564 <_Heap_Extend+0xc0>
merge_below_block = start_block;
} else if ( extend_area_end < sub_area_end ) {
ffc0e560: 7d 2a 4b 78 mr r10,r9
ffc0e564: 7d 60 db 96 divwu r11,r0,r27
link_below_block = start_block;
}
if ( sub_area_end == extend_area_begin ) {
ffc0e568: 7f 80 e8 00 cmpw cr7,r0,r29
ffc0e56c: 7d 6b d9 d6 mullw r11,r11,r27
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc0e570: 39 6b ff f8 addi r11,r11,-8
ffc0e574: 40 be 00 10 bne+ cr7,ffc0e584 <_Heap_Extend+0xe0>
start_block->prev_size = extend_area_end;
ffc0e578: 93 c9 00 00 stw r30,0(r9)
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area(
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
ffc0e57c: 7d 7a 5b 78 mr r26,r11
ffc0e580: 48 00 00 10 b ffc0e590 <_Heap_Extend+0xec>
merge_above_block = end_block;
} else if ( sub_area_end < extend_area_begin ) {
ffc0e584: 7f 80 e8 40 cmplw cr7,r0,r29
ffc0e588: 40 9c 00 08 bge- cr7,ffc0e590 <_Heap_Extend+0xec>
ffc0e58c: 7d 76 5b 78 mr r22,r11
- 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;
ffc0e590: 81 2b 00 04 lwz r9,4(r11)
ffc0e594: 55 29 00 3c rlwinm r9,r9,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);
ffc0e598: 7d 2b 4a 14 add r9,r11,r9
link_above_block = end_block;
}
start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) );
} while ( start_block != first_block );
ffc0e59c: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0e5a0: 40 9e ff 80 bne+ cr7,ffc0e520 <_Heap_Extend+0x7c>
if ( extend_area_begin < heap->area_begin ) {
ffc0e5a4: 80 1f 00 18 lwz r0,24(r31)
ffc0e5a8: 7f 9d 00 40 cmplw cr7,r29,r0
ffc0e5ac: 40 9c 00 0c bge- cr7,ffc0e5b8 <_Heap_Extend+0x114>
heap->area_begin = extend_area_begin;
ffc0e5b0: 93 bf 00 18 stw r29,24(r31)
ffc0e5b4: 48 00 00 14 b ffc0e5c8 <_Heap_Extend+0x124>
} else if ( heap->area_end < extend_area_end ) {
ffc0e5b8: 80 1f 00 1c lwz r0,28(r31)
ffc0e5bc: 7f 80 f0 40 cmplw cr7,r0,r30
ffc0e5c0: 40 9c 00 08 bge- cr7,ffc0e5c8 <_Heap_Extend+0x124>
heap->area_end = extend_area_end;
ffc0e5c4: 93 df 00 1c stw r30,28(r31)
}
extend_first_block_size =
(uintptr_t) extend_last_block - (uintptr_t) extend_first_block;
ffc0e5c8: 81 61 00 08 lwz r11,8(r1)
ffc0e5cc: 81 21 00 0c lwz r9,12(r1)
extend_first_block->prev_size = extend_area_end;
ffc0e5d0: 93 cb 00 00 stw r30,0(r11)
heap->area_begin = extend_area_begin;
} else if ( heap->area_end < extend_area_end ) {
heap->area_end = extend_area_end;
}
extend_first_block_size =
ffc0e5d4: 7c 0b 48 50 subf r0,r11,r9
(uintptr_t) extend_last_block - (uintptr_t) extend_first_block;
extend_first_block->prev_size = extend_area_end;
extend_first_block->size_and_flag =
extend_first_block_size | HEAP_PREV_BLOCK_USED;
ffc0e5d8: 60 08 00 01 ori r8,r0,1
_Heap_Protection_block_initialize( heap, extend_first_block );
extend_last_block->prev_size = extend_first_block_size;
ffc0e5dc: 90 09 00 00 stw r0,0(r9)
extend_last_block->size_and_flag = 0;
ffc0e5e0: 38 00 00 00 li r0,0
extend_first_block_size =
(uintptr_t) extend_last_block - (uintptr_t) extend_first_block;
extend_first_block->prev_size = extend_area_end;
extend_first_block->size_and_flag =
ffc0e5e4: 91 0b 00 04 stw r8,4(r11)
extend_first_block_size | HEAP_PREV_BLOCK_USED;
_Heap_Protection_block_initialize( heap, extend_first_block );
extend_last_block->prev_size = extend_first_block_size;
extend_last_block->size_and_flag = 0;
ffc0e5e8: 90 09 00 04 stw r0,4(r9)
_Heap_Protection_block_initialize( heap, extend_last_block );
if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) {
ffc0e5ec: 80 1f 00 20 lwz r0,32(r31)
ffc0e5f0: 7f 80 58 40 cmplw cr7,r0,r11
ffc0e5f4: 40 9d 00 0c ble- cr7,ffc0e600 <_Heap_Extend+0x15c>
heap->first_block = extend_first_block;
ffc0e5f8: 91 7f 00 20 stw r11,32(r31)
ffc0e5fc: 48 00 00 14 b ffc0e610 <_Heap_Extend+0x16c>
} else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) {
ffc0e600: 80 1f 00 24 lwz r0,36(r31)
ffc0e604: 7f 80 48 40 cmplw cr7,r0,r9
ffc0e608: 40 9c 00 08 bge- cr7,ffc0e610 <_Heap_Extend+0x16c>
heap->last_block = extend_last_block;
ffc0e60c: 91 3f 00 24 stw r9,36(r31)
}
if ( merge_below_block != NULL ) {
ffc0e610: 2f 97 00 00 cmpwi cr7,r23,0
ffc0e614: 41 9e 00 48 beq- cr7,ffc0e65c <_Heap_Extend+0x1b8>
Heap_Control *heap,
uintptr_t extend_area_begin,
Heap_Block *first_block
)
{
uintptr_t const page_size = heap->page_size;
ffc0e618: 80 1f 00 10 lwz r0,16(r31)
uintptr_t const new_first_block_alloc_begin =
_Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size );
ffc0e61c: 3b bd 00 08 addi r29,r29,8
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up(
uintptr_t value,
uintptr_t alignment
)
{
uintptr_t remainder = value % alignment;
ffc0e620: 7d 3d 03 96 divwu r9,r29,r0
ffc0e624: 7d 29 01 d6 mullw r9,r9,r0
if ( remainder != 0 ) {
ffc0e628: 7d 29 e8 51 subf. r9,r9,r29
ffc0e62c: 41 82 00 0c beq- ffc0e638 <_Heap_Extend+0x194> <== ALWAYS TAKEN
return value - remainder + alignment;
ffc0e630: 7f bd 02 14 add r29,r29,r0 <== NOT EXECUTED
ffc0e634: 7f a9 e8 50 subf r29,r9,r29 <== NOT EXECUTED
uintptr_t const first_block_begin = (uintptr_t) first_block;
uintptr_t const new_first_block_size =
first_block_begin - new_first_block_begin;
Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin;
new_first_block->prev_size = first_block->prev_size;
ffc0e638: 80 17 00 00 lwz r0,0(r23)
)
{
uintptr_t const page_size = heap->page_size;
uintptr_t const new_first_block_alloc_begin =
_Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size );
uintptr_t const new_first_block_begin =
ffc0e63c: 38 9d ff f8 addi r4,r29,-8
Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin;
new_first_block->prev_size = first_block->prev_size;
new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED;
_Heap_Free_block( heap, new_first_block );
ffc0e640: 7f e3 fb 78 mr r3,r31
uintptr_t const first_block_begin = (uintptr_t) first_block;
uintptr_t const new_first_block_size =
first_block_begin - new_first_block_begin;
Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin;
new_first_block->prev_size = first_block->prev_size;
ffc0e644: 90 1d ff f8 stw r0,-8(r29)
uintptr_t const new_first_block_alloc_begin =
_Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size );
uintptr_t const new_first_block_begin =
new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE;
uintptr_t const first_block_begin = (uintptr_t) first_block;
uintptr_t const new_first_block_size =
ffc0e648: 7c 04 b8 50 subf r0,r4,r23
first_block_begin - new_first_block_begin;
Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin;
new_first_block->prev_size = first_block->prev_size;
new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED;
ffc0e64c: 60 00 00 01 ori r0,r0,1
ffc0e650: 90 04 00 04 stw r0,4(r4)
_Heap_Free_block( heap, new_first_block );
ffc0e654: 4b ff fe 15 bl ffc0e468 <_Heap_Free_block>
ffc0e658: 48 00 00 1c b ffc0e674 <_Heap_Extend+0x1d0>
heap->last_block = extend_last_block;
}
if ( merge_below_block != NULL ) {
_Heap_Merge_below( heap, extend_area_begin, merge_below_block );
} else if ( link_below_block != NULL ) {
ffc0e65c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0e660: 41 9e 00 14 beq- cr7,ffc0e674 <_Heap_Extend+0x1d0>
_Heap_Link_below(
ffc0e664: 81 21 00 0c lwz r9,12(r1)
{
uintptr_t const last_block_begin = (uintptr_t) last_block;
uintptr_t const link_begin = (uintptr_t) link;
last_block->size_and_flag =
(link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED;
ffc0e668: 7d 49 50 50 subf r10,r9,r10
ffc0e66c: 61 4a 00 01 ori r10,r10,1
)
{
uintptr_t const last_block_begin = (uintptr_t) last_block;
uintptr_t const link_begin = (uintptr_t) link;
last_block->size_and_flag =
ffc0e670: 91 49 00 04 stw r10,4(r9)
link_below_block,
extend_last_block
);
}
if ( merge_above_block != NULL ) {
ffc0e674: 2f 9a 00 00 cmpwi cr7,r26,0
ffc0e678: 41 9e 00 4c beq- cr7,ffc0e6c4 <_Heap_Extend+0x220>
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc0e67c: 80 1f 00 10 lwz r0,16(r31)
)
{
uintptr_t const page_size = heap->page_size;
uintptr_t const last_block_begin = (uintptr_t) last_block;
uintptr_t const last_block_new_size = _Heap_Align_down(
extend_area_end - last_block_begin - HEAP_BLOCK_HEADER_SIZE,
ffc0e680: 3b de ff f8 addi r30,r30,-8
uintptr_t extend_area_end
)
{
uintptr_t const page_size = heap->page_size;
uintptr_t const last_block_begin = (uintptr_t) last_block;
uintptr_t const last_block_new_size = _Heap_Align_down(
ffc0e684: 7f da f0 50 subf r30,r26,r30
ffc0e688: 7f de 03 96 divwu r30,r30,r0
ffc0e68c: 7f de 01 d6 mullw r30,r30,r0
);
Heap_Block *const new_last_block =
_Heap_Block_at( last_block, last_block_new_size );
new_last_block->size_and_flag =
(last_block->size_and_flag - last_block_new_size)
ffc0e690: 80 1a 00 04 lwz r0,4(r26)
| HEAP_PREV_BLOCK_USED;
_Heap_Block_set_size( last_block, last_block_new_size );
_Heap_Free_block( heap, last_block );
ffc0e694: 7f e3 fb 78 mr r3,r31
);
Heap_Block *const new_last_block =
_Heap_Block_at( last_block, last_block_new_size );
new_last_block->size_and_flag =
(last_block->size_and_flag - last_block_new_size)
ffc0e698: 7c 1e 00 50 subf r0,r30,r0
page_size
);
Heap_Block *const new_last_block =
_Heap_Block_at( last_block, last_block_new_size );
new_last_block->size_and_flag =
ffc0e69c: 7d 3e d2 14 add r9,r30,r26
(last_block->size_and_flag - last_block_new_size)
| HEAP_PREV_BLOCK_USED;
ffc0e6a0: 60 00 00 01 ori r0,r0,1
page_size
);
Heap_Block *const new_last_block =
_Heap_Block_at( last_block, last_block_new_size );
new_last_block->size_and_flag =
ffc0e6a4: 90 09 00 04 stw r0,4(r9)
(last_block->size_and_flag - last_block_new_size)
| HEAP_PREV_BLOCK_USED;
_Heap_Block_set_size( last_block, last_block_new_size );
_Heap_Free_block( heap, last_block );
ffc0e6a8: 7f 44 d3 78 mr r4,r26
RTEMS_INLINE_ROUTINE void _Heap_Block_set_size(
Heap_Block *block,
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0e6ac: 80 1a 00 04 lwz r0,4(r26)
ffc0e6b0: 54 00 07 fe clrlwi r0,r0,31
block->size_and_flag = size | flag;
ffc0e6b4: 7f de 03 78 or r30,r30,r0
ffc0e6b8: 93 da 00 04 stw r30,4(r26)
ffc0e6bc: 4b ff fd ad bl ffc0e468 <_Heap_Free_block>
ffc0e6c0: 48 00 00 34 b ffc0e6f4 <_Heap_Extend+0x250>
);
}
if ( merge_above_block != NULL ) {
_Heap_Merge_above( heap, merge_above_block, extend_area_end );
} else if ( link_above_block != NULL ) {
ffc0e6c4: 2f 96 00 00 cmpwi cr7,r22,0
ffc0e6c8: 41 9e 00 2c beq- cr7,ffc0e6f4 <_Heap_Extend+0x250>
RTEMS_INLINE_ROUTINE void _Heap_Block_set_size(
Heap_Block *block,
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0e6cc: 80 16 00 04 lwz r0,4(r22)
)
{
uintptr_t const link_begin = (uintptr_t) link;
uintptr_t const first_block_begin = (uintptr_t) first_block;
_Heap_Block_set_size( link, first_block_begin - link_begin );
ffc0e6d0: 81 61 00 08 lwz r11,8(r1)
ffc0e6d4: 54 00 07 fe clrlwi r0,r0,31
}
if ( merge_above_block != NULL ) {
_Heap_Merge_above( heap, merge_above_block, extend_area_end );
} else if ( link_above_block != NULL ) {
_Heap_Link_above(
ffc0e6d8: 81 21 00 0c lwz r9,12(r1)
)
{
uintptr_t const link_begin = (uintptr_t) link;
uintptr_t const first_block_begin = (uintptr_t) first_block;
_Heap_Block_set_size( link, first_block_begin - link_begin );
ffc0e6dc: 7d 76 58 50 subf r11,r22,r11
block->size_and_flag = size | flag;
ffc0e6e0: 7d 60 03 78 or r0,r11,r0
ffc0e6e4: 90 16 00 04 stw r0,4(r22)
last_block->size_and_flag |= HEAP_PREV_BLOCK_USED;
ffc0e6e8: 80 09 00 04 lwz r0,4(r9)
ffc0e6ec: 60 00 00 01 ori r0,r0,1
ffc0e6f0: 90 09 00 04 stw r0,4(r9)
extend_first_block,
extend_last_block
);
}
if ( merge_below_block == NULL && merge_above_block == NULL ) {
ffc0e6f4: 2f 97 00 00 cmpwi cr7,r23,0
ffc0e6f8: 40 be 00 18 bne+ cr7,ffc0e710 <_Heap_Extend+0x26c>
ffc0e6fc: 2f 9a 00 00 cmpwi cr7,r26,0
ffc0e700: 40 be 00 10 bne+ cr7,ffc0e710 <_Heap_Extend+0x26c>
_Heap_Free_block( heap, extend_first_block );
ffc0e704: 80 81 00 08 lwz r4,8(r1)
ffc0e708: 7f e3 fb 78 mr r3,r31
ffc0e70c: 4b ff fd 5d bl ffc0e468 <_Heap_Free_block>
*/
RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap )
{
_Heap_Block_set_size(
heap->last_block,
(uintptr_t) heap->first_block - (uintptr_t) heap->last_block
ffc0e710: 81 3f 00 24 lwz r9,36(r31)
extended_size = stats->free_size - free_size;
/* Statistics */
stats->size += extended_size;
if ( extended_size_ptr != NULL )
ffc0e714: 2f 99 00 00 cmpwi cr7,r25,0
* This feature will be used to terminate the scattered heap area list. See
* also _Heap_Extend().
*/
RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap )
{
_Heap_Block_set_size(
ffc0e718: 81 7f 00 20 lwz r11,32(r31)
RTEMS_INLINE_ROUTINE void _Heap_Block_set_size(
Heap_Block *block,
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0e71c: 80 09 00 04 lwz r0,4(r9)
* This feature will be used to terminate the scattered heap area list. See
* also _Heap_Extend().
*/
RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap )
{
_Heap_Block_set_size(
ffc0e720: 7d 69 58 50 subf r11,r9,r11
RTEMS_INLINE_ROUTINE void _Heap_Block_set_size(
Heap_Block *block,
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
ffc0e724: 54 00 07 fe clrlwi r0,r0,31
block->size_and_flag = size | flag;
ffc0e728: 7d 60 03 78 or r0,r11,r0
ffc0e72c: 90 09 00 04 stw r0,4(r9)
_Heap_Free_block( heap, extend_first_block );
}
_Heap_Set_last_block_size( heap );
extended_size = stats->free_size - free_size;
ffc0e730: 80 1f 00 30 lwz r0,48(r31)
ffc0e734: 7f 18 00 50 subf r24,r24,r0
/* Statistics */
stats->size += extended_size;
ffc0e738: 80 1f 00 2c lwz r0,44(r31)
ffc0e73c: 7c 00 c2 14 add r0,r0,r24
ffc0e740: 90 1f 00 2c stw r0,44(r31)
if ( extended_size_ptr != NULL )
*extended_size_ptr = extended_size;
return true;
ffc0e744: 38 00 00 01 li r0,1
extended_size = stats->free_size - free_size;
/* Statistics */
stats->size += extended_size;
if ( extended_size_ptr != NULL )
ffc0e748: 41 9e 00 10 beq- cr7,ffc0e758 <_Heap_Extend+0x2b4> <== NEVER TAKEN
*extended_size_ptr = extended_size;
ffc0e74c: 93 19 00 00 stw r24,0(r25)
ffc0e750: 48 00 00 08 b ffc0e758 <_Heap_Extend+0x2b4>
_Heap_Block_of_alloc_area( sub_area_end, page_size );
if (
sub_area_end > extend_area_begin && extend_area_end > sub_area_begin
) {
return false;
ffc0e754: 38 00 00 00 li r0,0
if ( extended_size_ptr != NULL )
*extended_size_ptr = extended_size;
return true;
}
ffc0e758: 39 61 00 40 addi r11,r1,64
ffc0e75c: 7c 03 03 78 mr r3,r0
ffc0e760: 4b ff 1e 40 b ffc005a0 <_restgpr_22_x>
ffc1210c <_Heap_Free>:
ffc1210c: 80 03 00 10 lwz r0,16(r3)
return do_free;
}
#endif
bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr )
{
ffc12110: 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
ffc12114: 80 a3 00 20 lwz r5,32(r3)
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc12118: 7d 64 03 96 divwu r11,r4,r0
ffc1211c: 94 21 ff f0 stwu r1,-16(r1)
ffc12120: 93 e1 00 0c stw r31,12(r1)
ffc12124: 7d 6b 01 d6 mullw r11,r11,r0
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;
ffc12128: 38 00 00 00 li r0,0
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc1212c: 39 6b ff f8 addi r11,r11,-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;
ffc12130: 7f 8b 28 40 cmplw cr7,r11,r5
ffc12134: 41 9c 00 14 blt- cr7,ffc12148 <_Heap_Free+0x3c>
ffc12138: 80 03 00 24 lwz r0,36(r3)
ffc1213c: 7c 0b 00 10 subfc r0,r11,r0
ffc12140: 38 00 00 00 li r0,0
ffc12144: 7c 00 01 14 adde r0,r0,r0
uintptr_t next_block_size = 0;
bool next_is_free = false;
_Heap_Protection_block_check( heap, block );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc12148: 2f 80 00 00 cmpwi cr7,r0,0
return false;
ffc1214c: 38 60 00 00 li r3,0
uintptr_t next_block_size = 0;
bool next_is_free = false;
_Heap_Protection_block_check( heap, block );
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
ffc12150: 41 9e 01 b0 beq- cr7,ffc12300 <_Heap_Free+0x1f4>
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc12154: 80 cb 00 04 lwz r6,4(r11)
ffc12158: 38 00 00 00 li r0,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;
ffc1215c: 54 c8 00 3c rlwinm r8,r6,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);
ffc12160: 7d 4b 42 14 add r10,r11,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;
ffc12164: 7f 8a 28 40 cmplw cr7,r10,r5
ffc12168: 41 9c 00 14 blt- cr7,ffc1217c <_Heap_Free+0x70> <== NEVER TAKEN
ffc1216c: 80 09 00 24 lwz r0,36(r9)
ffc12170: 7c 0a 00 10 subfc r0,r10,r0
ffc12174: 38 00 00 00 li r0,0
ffc12178: 7c 00 01 14 adde r0,r0,r0
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
_Heap_Protection_block_check( heap, next_block );
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc1217c: 2f 80 00 00 cmpwi cr7,r0,0
_HAssert( false );
return false;
ffc12180: 38 60 00 00 li r3,0
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
_Heap_Protection_block_check( heap, next_block );
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc12184: 41 9e 01 7c beq- cr7,ffc12300 <_Heap_Free+0x1f4> <== NEVER TAKEN
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc12188: 80 0a 00 04 lwz r0,4(r10)
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
_HAssert( false );
return false;
}
if ( !_Heap_Is_prev_used( next_block ) ) {
ffc1218c: 70 04 00 01 andi. r4,r0,1
ffc12190: 41 82 01 70 beq- ffc12300 <_Heap_Free+0x1f4>
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
ffc12194: 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;
ffc12198: 54 00 00 3c rlwinm r0,r0,0,0,30
&& !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size ));
ffc1219c: 38 80 00 00 li r4,0
ffc121a0: 7f 8a 18 00 cmpw cr7,r10,r3
ffc121a4: 41 9e 00 18 beq- cr7,ffc121bc <_Heap_Free+0xb0>
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
return( true );
}
ffc121a8: 7c ea 02 14 add r7,r10,r0
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;
ffc121ac: 80 e7 00 04 lwz r7,4(r7)
return do_free;
}
#endif
bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr )
ffc121b0: 70 ff 00 01 andi. r31,r7,1
ffc121b4: 7c 80 00 26 mfcr r4
ffc121b8: 54 84 1f fe rlwinm r4,r4,3,31,31
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 ));
if ( !_Heap_Is_prev_used( block ) ) {
ffc121bc: 70 c7 00 01 andi. r7,r6,1
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
ffc121c0: 54 84 06 3e clrlwi r4,r4,24
&& !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size ));
if ( !_Heap_Is_prev_used( block ) ) {
ffc121c4: 40 82 00 98 bne- ffc1225c <_Heap_Free+0x150>
uintptr_t const prev_size = block->prev_size;
ffc121c8: 80 cb 00 00 lwz r6,0(r11)
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;
ffc121cc: 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);
ffc121d0: 7c e6 58 50 subf r7,r6,r11
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;
ffc121d4: 7f 87 28 40 cmplw cr7,r7,r5
ffc121d8: 41 9c 00 10 blt- cr7,ffc121e8 <_Heap_Free+0xdc> <== NEVER TAKEN
ffc121dc: 7d 87 18 10 subfc r12,r7,r3
ffc121e0: 39 80 00 00 li r12,0
ffc121e4: 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 ) ) {
ffc121e8: 2f 8c 00 00 cmpwi cr7,r12,0
_HAssert( false );
return( false );
ffc121ec: 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 ) ) {
ffc121f0: 41 9e 01 10 beq- cr7,ffc12300 <_Heap_Free+0x1f4> <== 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;
ffc121f4: 80 a7 00 04 lwz r5,4(r7)
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) ) {
ffc121f8: 70 bf 00 01 andi. r31,r5,1
ffc121fc: 41 82 01 04 beq- ffc12300 <_Heap_Free+0x1f4> <== NEVER TAKEN
_HAssert( false );
return( false );
}
if ( next_is_free ) { /* coalesce both */
ffc12200: 2f 84 00 00 cmpwi cr7,r4,0
ffc12204: 41 9e 00 38 beq- cr7,ffc1223c <_Heap_Free+0x130>
return _Heap_Free_list_tail(heap)->prev;
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
ffc12208: 81 6a 00 08 lwz r11,8(r10)
uintptr_t const size = block_size + prev_size + next_block_size;
ffc1220c: 7c 08 02 14 add r0,r8,r0
Heap_Block *prev = block->prev;
ffc12210: 81 4a 00 0c lwz r10,12(r10)
ffc12214: 7c c0 32 14 add r6,r0,r6
prev->next = next;
ffc12218: 91 6a 00 08 stw r11,8(r10)
next->prev = prev;
ffc1221c: 91 4b 00 0c stw r10,12(r11)
_Heap_Free_list_remove( next_block );
stats->free_blocks -= 1;
ffc12220: 81 69 00 38 lwz r11,56(r9)
ffc12224: 38 0b ff ff addi r0,r11,-1
ffc12228: 90 09 00 38 stw r0,56(r9)
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc1222c: 60 c0 00 01 ori r0,r6,1
ffc12230: 90 07 00 04 stw r0,4(r7)
next_block = _Heap_Block_at( prev_block, size );
_HAssert(!_Heap_Is_prev_used( next_block));
next_block->prev_size = size;
ffc12234: 7c c7 31 2e stwx r6,r7,r6
ffc12238: 48 00 00 a0 b ffc122d8 <_Heap_Free+0x1cc>
} else { /* coalesce prev */
uintptr_t const size = block_size + prev_size;
ffc1223c: 7c c8 32 14 add r6,r8,r6
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc12240: 60 c0 00 01 ori r0,r6,1
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
next_block->prev_size = size;
ffc12244: 7c cb 41 2e stwx r6,r11,r8
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;
ffc12248: 90 07 00 04 stw r0,4(r7)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc1224c: 80 0a 00 04 lwz r0,4(r10)
ffc12250: 54 00 00 3c rlwinm r0,r0,0,0,30
ffc12254: 90 0a 00 04 stw r0,4(r10)
ffc12258: 48 00 00 80 b ffc122d8 <_Heap_Free+0x1cc>
next_block->prev_size = size;
}
} else if ( next_is_free ) { /* coalesce next */
ffc1225c: 2f 84 00 00 cmpwi cr7,r4,0
ffc12260: 41 9e 00 30 beq- cr7,ffc12290 <_Heap_Free+0x184>
RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace(
Heap_Block *old_block,
Heap_Block *new_block
)
{
Heap_Block *next = old_block->next;
ffc12264: 80 ca 00 08 lwz r6,8(r10)
uintptr_t const size = block_size + next_block_size;
ffc12268: 7c e0 42 14 add r7,r0,r8
Heap_Block *prev = old_block->prev;
ffc1226c: 81 4a 00 0c lwz r10,12(r10)
_Heap_Free_list_replace( next_block, block );
block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
ffc12270: 60 e0 00 01 ori r0,r7,1
new_block->next = next;
ffc12274: 90 cb 00 08 stw r6,8(r11)
new_block->prev = prev;
ffc12278: 91 4b 00 0c stw r10,12(r11)
next->prev = new_block;
prev->next = new_block;
ffc1227c: 91 6a 00 08 stw r11,8(r10)
Heap_Block *prev = old_block->prev;
new_block->next = next;
new_block->prev = prev;
next->prev = new_block;
ffc12280: 91 66 00 0c stw r11,12(r6)
ffc12284: 90 0b 00 04 stw r0,4(r11)
next_block = _Heap_Block_at( block, size );
next_block->prev_size = size;
ffc12288: 7c eb 39 2e stwx r7,r11,r7
ffc1228c: 48 00 00 4c b ffc122d8 <_Heap_Free+0x1cc>
} 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;
ffc12290: 61 00 00 01 ori r0,r8,1
RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after(
Heap_Block *block_before,
Heap_Block *new_block
)
{
Heap_Block *next = block_before->next;
ffc12294: 80 e9 00 08 lwz r7,8(r9)
ffc12298: 90 0b 00 04 stw r0,4(r11)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
ffc1229c: 80 0a 00 04 lwz r0,4(r10)
new_block->next = next;
ffc122a0: 90 eb 00 08 stw r7,8(r11)
ffc122a4: 54 00 00 3c rlwinm r0,r0,0,0,30
new_block->prev = block_before;
ffc122a8: 91 2b 00 0c stw r9,12(r11)
next_block->prev_size = block_size;
ffc122ac: 7d 0b 41 2e stwx r8,r11,r8
block_before->next = new_block;
next->prev = new_block;
ffc122b0: 91 67 00 0c stw r11,12(r7)
{
Heap_Block *next = block_before->next;
new_block->next = next;
new_block->prev = block_before;
block_before->next = new_block;
ffc122b4: 91 69 00 08 stw r11,8(r9)
/* Statistics */
++stats->free_blocks;
ffc122b8: 81 69 00 38 lwz r11,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;
ffc122bc: 90 0a 00 04 stw r0,4(r10)
next_block->prev_size = block_size;
/* Statistics */
++stats->free_blocks;
ffc122c0: 38 0b 00 01 addi r0,r11,1
if ( stats->max_free_blocks < stats->free_blocks ) {
ffc122c4: 81 69 00 3c lwz r11,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;
ffc122c8: 90 09 00 38 stw r0,56(r9)
if ( stats->max_free_blocks < stats->free_blocks ) {
ffc122cc: 7f 8b 00 40 cmplw cr7,r11,r0
ffc122d0: 40 9c 00 08 bge- cr7,ffc122d8 <_Heap_Free+0x1cc>
stats->max_free_blocks = stats->free_blocks;
ffc122d4: 90 09 00 3c stw r0,60(r9)
}
}
/* Statistics */
--stats->used_blocks;
ffc122d8: 81 69 00 40 lwz r11,64(r9)
++stats->frees;
stats->free_size += block_size;
return( true );
ffc122dc: 38 60 00 01 li r3,1
stats->max_free_blocks = stats->free_blocks;
}
}
/* Statistics */
--stats->used_blocks;
ffc122e0: 38 0b ff ff addi r0,r11,-1
++stats->frees;
ffc122e4: 81 69 00 50 lwz r11,80(r9)
stats->max_free_blocks = stats->free_blocks;
}
}
/* Statistics */
--stats->used_blocks;
ffc122e8: 90 09 00 40 stw r0,64(r9)
++stats->frees;
ffc122ec: 38 0b 00 01 addi r0,r11,1
ffc122f0: 90 09 00 50 stw r0,80(r9)
stats->free_size += block_size;
ffc122f4: 80 09 00 30 lwz r0,48(r9)
ffc122f8: 7d 00 42 14 add r8,r0,r8
ffc122fc: 91 09 00 30 stw r8,48(r9)
return( true );
}
ffc12300: 83 e1 00 0c lwz r31,12(r1)
ffc12304: 38 21 00 10 addi r1,r1,16
ffc12308: 4e 80 00 20 blr
ffc12440 <_Heap_Size_of_alloc_area>:
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc12440: 80 03 00 10 lwz r0,16(r3)
bool _Heap_Size_of_alloc_area(
Heap_Control *heap,
void *alloc_begin_ptr,
uintptr_t *alloc_size
)
{
ffc12444: 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
ffc12448: 81 03 00 20 lwz r8,32(r3)
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
uintptr_t value,
uintptr_t alignment
)
{
return value - (value % alignment);
ffc1244c: 7d 44 03 96 divwu r10,r4,r0
ffc12450: 7d 4a 01 d6 mullw r10,r10,r0
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;
ffc12454: 38 00 00 00 li r0,0
uintptr_t alloc_begin,
uintptr_t page_size
)
{
return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size )
- HEAP_BLOCK_HEADER_SIZE);
ffc12458: 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;
ffc1245c: 7f 8a 40 40 cmplw cr7,r10,r8
ffc12460: 41 9c 00 14 blt- cr7,ffc12474 <_Heap_Size_of_alloc_area+0x34>
ffc12464: 80 03 00 24 lwz r0,36(r3)
ffc12468: 7c 0a 00 10 subfc r0,r10,r0
ffc1246c: 38 00 00 00 li r0,0
ffc12470: 7c 00 01 14 adde r0,r0,r0
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 ) ) {
ffc12474: 2f 80 00 00 cmpwi cr7,r0,0
return false;
ffc12478: 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 ) ) {
ffc1247c: 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;
ffc12480: 81 6a 00 04 lwz r11,4(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;
ffc12484: 38 00 00 00 li r0,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;
ffc12488: 55 6b 00 3c rlwinm r11,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);
ffc1248c: 7d 6a 5a 14 add r11,r10,r11
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;
ffc12490: 7f 8b 40 40 cmplw cr7,r11,r8
ffc12494: 41 9c 00 14 blt- cr7,ffc124a8 <_Heap_Size_of_alloc_area+0x68><== NEVER TAKEN
ffc12498: 80 09 00 24 lwz r0,36(r9)
ffc1249c: 7c 0b 00 10 subfc r0,r11,r0
ffc124a0: 38 00 00 00 li r0,0
ffc124a4: 7c 00 01 14 adde r0,r0,r0
}
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if (
ffc124a8: 2f 80 00 00 cmpwi cr7,r0,0
!_Heap_Is_block_in_heap( heap, next_block )
|| !_Heap_Is_prev_used( next_block )
) {
return false;
ffc124ac: 38 60 00 00 li r3,0
}
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if (
ffc124b0: 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;
ffc124b4: 80 0b 00 04 lwz r0,4(r11)
!_Heap_Is_block_in_heap( heap, next_block )
|| !_Heap_Is_prev_used( next_block )
ffc124b8: 70 09 00 01 andi. r9,r0,1
ffc124bc: 4d 82 00 20 beqlr
) {
return false;
}
*alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin;
ffc124c0: 20 84 00 04 subfic r4,r4,4
ffc124c4: 7d 64 5a 14 add r11,r4,r11
ffc124c8: 91 65 00 00 stw r11,0(r5)
return true;
ffc124cc: 38 60 00 01 li r3,1
}
ffc124d0: 4e 80 00 20 blr
ffc09bb8 <_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;
ffc09bb8: 2f 85 00 00 cmpwi cr7,r5,0
bool _Heap_Walk(
Heap_Control *heap,
int source,
bool dump
)
{
ffc09bbc: 94 21 ff 98 stwu r1,-104(r1)
ffc09bc0: 7c 08 02 a6 mflr r0
ffc09bc4: bd c1 00 20 stmw r14,32(r1)
ffc09bc8: 7c 7e 1b 78 mr r30,r3
ffc09bcc: 7c 9f 23 78 mr r31,r4
ffc09bd0: 90 01 00 6c stw r0,108(r1)
uintptr_t const page_size = heap->page_size;
ffc09bd4: 83 43 00 10 lwz r26,16(r3)
uintptr_t const min_block_size = heap->min_block_size;
ffc09bd8: 83 23 00 14 lwz r25,20(r3)
Heap_Block *const first_block = heap->first_block;
ffc09bdc: 83 03 00 20 lwz r24,32(r3)
Heap_Block *const last_block = heap->last_block;
ffc09be0: 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;
ffc09be4: 41 9e 00 10 beq- cr7,ffc09bf4 <_Heap_Walk+0x3c>
ffc09be8: 3d 20 ff c1 lis r9,-63
ffc09bec: 39 29 9b 08 addi r9,r9,-25848
ffc09bf0: 48 00 00 0c b ffc09bfc <_Heap_Walk+0x44>
ffc09bf4: 3d 20 ff c1 lis r9,-63
ffc09bf8: 39 29 9b 04 addi r9,r9,-25852
ffc09bfc: 91 21 00 18 stw r9,24(r1)
if ( !_System_state_Is_up( _System_state_Get() ) ) {
ffc09c00: 3d 20 00 00 lis r9,0
return true;
ffc09c04: 38 60 00 01 li r3,1
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;
if ( !_System_state_Is_up( _System_state_Get() ) ) {
ffc09c08: 80 09 27 d0 lwz r0,10192(r9)
ffc09c0c: 2f 80 00 03 cmpwi cr7,r0,3
ffc09c10: 40 be 04 c4 bne+ cr7,ffc0a0d4 <_Heap_Walk+0x51c>
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)(
ffc09c14: 80 1e 00 08 lwz r0,8(r30)
ffc09c18: 3c a0 ff c2 lis r5,-62
ffc09c1c: 81 1e 00 18 lwz r8,24(r30)
ffc09c20: 7f e3 fb 78 mr r3,r31
ffc09c24: 90 01 00 0c stw r0,12(r1)
ffc09c28: 38 80 00 00 li r4,0
ffc09c2c: 38 a5 81 c1 addi r5,r5,-32319
ffc09c30: 80 1e 00 0c lwz r0,12(r30)
ffc09c34: 7f 46 d3 78 mr r6,r26
ffc09c38: 81 3e 00 1c lwz r9,28(r30)
ffc09c3c: 7f 27 cb 78 mr r7,r25
ffc09c40: 90 01 00 10 stw r0,16(r1)
ffc09c44: 7f 0a c3 78 mr r10,r24
ffc09c48: 80 01 00 18 lwz r0,24(r1)
ffc09c4c: 92 e1 00 08 stw r23,8(r1)
ffc09c50: 7c 09 03 a6 mtctr r0
ffc09c54: 4c c6 31 82 crclr 4*cr1+eq
ffc09c58: 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 ) {
ffc09c5c: 2f 9a 00 00 cmpwi cr7,r26,0
ffc09c60: 40 be 00 18 bne+ cr7,ffc09c78 <_Heap_Walk+0xc0>
(*printer)( source, true, "page size is zero\n" );
ffc09c64: 3c a0 ff c2 lis r5,-62
ffc09c68: 7f e3 fb 78 mr r3,r31
ffc09c6c: 38 80 00 01 li r4,1
ffc09c70: 38 a5 82 52 addi r5,r5,-32174
ffc09c74: 48 00 00 94 b ffc09d08 <_Heap_Walk+0x150>
return false;
}
if ( !_Addresses_Is_aligned( (void *) page_size ) ) {
ffc09c78: 73 49 00 07 andi. r9,r26,7
ffc09c7c: 41 a2 00 1c beq+ ffc09c98 <_Heap_Walk+0xe0>
(*printer)(
ffc09c80: 3c a0 ff c2 lis r5,-62
ffc09c84: 7f e3 fb 78 mr r3,r31
ffc09c88: 38 80 00 01 li r4,1
ffc09c8c: 38 a5 82 65 addi r5,r5,-32155
ffc09c90: 7f 46 d3 78 mr r6,r26
ffc09c94: 48 00 04 5c b ffc0a0f0 <_Heap_Walk+0x538>
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc09c98: 7c 19 d3 96 divwu r0,r25,r26
ffc09c9c: 7c 00 d1 d6 mullw r0,r0,r26
);
return false;
}
if ( !_Heap_Is_aligned( min_block_size, page_size ) ) {
ffc09ca0: 7f 99 00 00 cmpw cr7,r25,r0
ffc09ca4: 41 be 00 1c beq+ cr7,ffc09cc0 <_Heap_Walk+0x108>
(*printer)(
ffc09ca8: 3c a0 ff c2 lis r5,-62
ffc09cac: 7f e3 fb 78 mr r3,r31
ffc09cb0: 38 80 00 01 li r4,1
ffc09cb4: 38 a5 82 83 addi r5,r5,-32125
ffc09cb8: 7f 26 cb 78 mr r6,r25
ffc09cbc: 48 00 04 34 b ffc0a0f0 <_Heap_Walk+0x538>
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block(
const Heap_Block *block
)
{
return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE;
ffc09cc0: 38 18 00 08 addi r0,r24,8
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc09cc4: 7d 20 d3 96 divwu r9,r0,r26
ffc09cc8: 7d 29 d1 d6 mullw r9,r9,r26
);
return false;
}
if (
ffc09ccc: 7f 80 48 00 cmpw cr7,r0,r9
ffc09cd0: 41 be 00 1c beq+ cr7,ffc09cec <_Heap_Walk+0x134>
!_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size )
) {
(*printer)(
ffc09cd4: 3c a0 ff c2 lis r5,-62
ffc09cd8: 7f e3 fb 78 mr r3,r31
ffc09cdc: 38 80 00 01 li r4,1
ffc09ce0: 38 a5 82 a7 addi r5,r5,-32089
ffc09ce4: 7f 06 c3 78 mr r6,r24
ffc09ce8: 48 00 04 08 b ffc0a0f0 <_Heap_Walk+0x538>
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;
ffc09cec: 80 18 00 04 lwz r0,4(r24)
);
return false;
}
if ( !_Heap_Is_prev_used( first_block ) ) {
ffc09cf0: 70 09 00 01 andi. r9,r0,1
ffc09cf4: 40 a2 00 28 bne+ ffc09d1c <_Heap_Walk+0x164>
(*printer)(
ffc09cf8: 3c a0 ff c2 lis r5,-62
ffc09cfc: 7f e3 fb 78 mr r3,r31
ffc09d00: 38 80 00 01 li r4,1
ffc09d04: 38 a5 82 d8 addi r5,r5,-32040
ffc09d08: 80 01 00 18 lwz r0,24(r1)
ffc09d0c: 7c 09 03 a6 mtctr r0
ffc09d10: 4c c6 31 82 crclr 4*cr1+eq
ffc09d14: 4e 80 04 21 bctrl
ffc09d18: 48 00 01 18 b ffc09e30 <_Heap_Walk+0x278>
- 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;
ffc09d1c: 83 b7 00 04 lwz r29,4(r23)
ffc09d20: 57 bd 00 3c rlwinm r29,r29,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);
ffc09d24: 7f b7 ea 14 add r29,r23,r29
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;
ffc09d28: 80 1d 00 04 lwz r0,4(r29)
);
return false;
}
if ( _Heap_Is_free( last_block ) ) {
ffc09d2c: 70 09 00 01 andi. r9,r0,1
ffc09d30: 40 a2 00 18 bne+ ffc09d48 <_Heap_Walk+0x190>
(*printer)(
ffc09d34: 3c a0 ff c2 lis r5,-62
ffc09d38: 7f e3 fb 78 mr r3,r31
ffc09d3c: 38 80 00 01 li r4,1
ffc09d40: 38 a5 83 06 addi r5,r5,-31994
ffc09d44: 4b ff ff c4 b ffc09d08 <_Heap_Walk+0x150>
);
return false;
}
if (
ffc09d48: 7f 9d c0 00 cmpw cr7,r29,r24
ffc09d4c: 41 9e 00 18 beq- cr7,ffc09d64 <_Heap_Walk+0x1ac> <== ALWAYS TAKEN
_Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block
) {
(*printer)(
ffc09d50: 3c a0 ff c2 lis r5,-62 <== NOT EXECUTED
ffc09d54: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc09d58: 38 80 00 01 li r4,1 <== NOT EXECUTED
ffc09d5c: 38 a5 83 1b addi r5,r5,-31973 <== NOT EXECUTED
ffc09d60: 4b ff ff a8 b ffc09d08 <_Heap_Walk+0x150> <== NOT EXECUTED
int source,
Heap_Walk_printer printer,
Heap_Control *heap
)
{
uintptr_t const page_size = heap->page_size;
ffc09d64: 81 3e 00 10 lwz r9,16(r30)
const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap );
ffc09d68: 7f c0 f3 78 mr r0,r30
block = next_block;
} while ( block != first_block );
return true;
}
ffc09d6c: 80 de 00 08 lwz r6,8(r30)
ffc09d70: 48 00 00 d0 b ffc09e40 <_Heap_Walk+0x288>
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;
ffc09d74: 81 5e 00 20 lwz r10,32(r30)
ffc09d78: 39 60 00 00 li r11,0
ffc09d7c: 7f 8a 30 40 cmplw cr7,r10,r6
ffc09d80: 41 9d 00 14 bgt- cr7,ffc09d94 <_Heap_Walk+0x1dc>
ffc09d84: 81 7e 00 24 lwz r11,36(r30)
ffc09d88: 7d 66 58 10 subfc r11,r6,r11
ffc09d8c: 39 60 00 00 li r11,0
ffc09d90: 7d 6b 59 14 adde r11,r11,r11
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 ) ) {
ffc09d94: 2f 8b 00 00 cmpwi cr7,r11,0
ffc09d98: 40 be 00 18 bne+ cr7,ffc09db0 <_Heap_Walk+0x1f8>
(*printer)(
ffc09d9c: 3c a0 ff c2 lis r5,-62
ffc09da0: 7f e3 fb 78 mr r3,r31
ffc09da4: 38 80 00 01 li r4,1
ffc09da8: 38 a5 83 4a addi r5,r5,-31926
ffc09dac: 48 00 03 44 b ffc0a0f0 <_Heap_Walk+0x538>
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block(
const Heap_Block *block
)
{
return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE;
ffc09db0: 39 66 00 08 addi r11,r6,8
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc09db4: 7d 4b 4b 96 divwu r10,r11,r9
ffc09db8: 7d 4a 49 d6 mullw r10,r10,r9
);
return false;
}
if (
ffc09dbc: 7f 8b 50 00 cmpw cr7,r11,r10
ffc09dc0: 41 be 00 18 beq+ cr7,ffc09dd8 <_Heap_Walk+0x220>
!_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size )
) {
(*printer)(
ffc09dc4: 3c a0 ff c2 lis r5,-62
ffc09dc8: 7f e3 fb 78 mr r3,r31
ffc09dcc: 38 80 00 01 li r4,1
ffc09dd0: 38 a5 83 6a addi r5,r5,-31894
ffc09dd4: 48 00 03 1c b ffc0a0f0 <_Heap_Walk+0x538>
- 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;
ffc09dd8: 81 66 00 04 lwz r11,4(r6)
ffc09ddc: 55 6b 00 3c rlwinm r11,r11,0,0,30
block = next_block;
} while ( block != first_block );
return true;
}
ffc09de0: 7d 66 5a 14 add r11,r6,r11
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;
ffc09de4: 81 6b 00 04 lwz r11,4(r11)
);
return false;
}
if ( _Heap_Is_used( free_block ) ) {
ffc09de8: 71 6a 00 01 andi. r10,r11,1
ffc09dec: 41 a2 00 18 beq+ ffc09e04 <_Heap_Walk+0x24c>
(*printer)(
ffc09df0: 3c a0 ff c2 lis r5,-62
ffc09df4: 7f e3 fb 78 mr r3,r31
ffc09df8: 38 80 00 01 li r4,1
ffc09dfc: 38 a5 83 9a addi r5,r5,-31846
ffc09e00: 48 00 02 f0 b ffc0a0f0 <_Heap_Walk+0x538>
);
return false;
}
if ( free_block->prev != prev_block ) {
ffc09e04: 80 e6 00 0c lwz r7,12(r6)
ffc09e08: 7f 87 00 00 cmpw cr7,r7,r0
ffc09e0c: 41 be 00 2c beq+ cr7,ffc09e38 <_Heap_Walk+0x280>
(*printer)(
ffc09e10: 3c a0 ff c2 lis r5,-62
ffc09e14: 7f e3 fb 78 mr r3,r31
ffc09e18: 38 80 00 01 li r4,1
ffc09e1c: 38 a5 83 b6 addi r5,r5,-31818
ffc09e20: 80 01 00 18 lwz r0,24(r1)
ffc09e24: 7c 09 03 a6 mtctr r0
ffc09e28: 4c c6 31 82 crclr 4*cr1+eq
ffc09e2c: 4e 80 04 21 bctrl
if ( !_System_state_Is_up( _System_state_Get() ) ) {
return true;
}
if ( !_Heap_Walk_check_control( source, printer, heap ) ) {
return false;
ffc09e30: 38 60 00 00 li r3,0
ffc09e34: 48 00 02 a0 b ffc0a0d4 <_Heap_Walk+0x51c>
return false;
}
prev_block = free_block;
free_block = free_block->next;
ffc09e38: 7c c0 33 78 mr r0,r6
ffc09e3c: 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 ) {
ffc09e40: 7f 86 f0 00 cmpw cr7,r6,r30
ffc09e44: 40 9e ff 30 bne+ cr7,ffc09d74 <_Heap_Walk+0x1bc>
ffc09e48: 48 00 00 0c b ffc09e54 <_Heap_Walk+0x29c>
block->prev_size
);
}
block = next_block;
} while ( block != first_block );
ffc09e4c: 7f 7d db 78 mr r29,r27
ffc09e50: 48 00 00 30 b ffc09e80 <_Heap_Walk+0x2c8>
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc09e54: 3e 60 ff c2 lis r19,-62
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
(*printer)(
ffc09e58: 3e 80 ff c2 lis r20,-62
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)(
ffc09e5c: 3e 40 ff c2 lis r18,-62
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc09e60: 3a 73 85 56 addi r19,r19,-31402
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
(*printer)(
ffc09e64: 3a 94 85 3f addi r20,r20,-31425
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)(
ffc09e68: 3a 52 84 a2 addi r18,r18,-31582
ffc09e6c: 3e 20 ff c2 lis r17,-62
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
block->next,
block->next == last_free_block ?
" (= last free)"
: (block->next == free_list_tail ? " (= tail)" : "")
ffc09e70: 3e c0 ff c2 lis r22,-62
ffc09e74: 3e 00 ff c2 lis r16,-62
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)(
ffc09e78: 3d e0 ff c2 lis r15,-62
block,
block_size,
block->prev,
block->prev == first_free_block ?
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
ffc09e7c: 3d c0 ff c2 lis r14,-62
block = next_block;
} while ( block != first_block );
return true;
}
ffc09e80: 82 bd 00 04 lwz r21,4(r29)
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;
ffc09e84: 38 00 00 00 li r0,0
ffc09e88: 81 3e 00 20 lwz r9,32(r30)
- 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;
ffc09e8c: 56 bc 00 3c rlwinm r28,r21,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);
ffc09e90: 7f 7d e2 14 add r27,r29,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;
ffc09e94: 7f 89 d8 40 cmplw cr7,r9,r27
ffc09e98: 41 9d 00 14 bgt- cr7,ffc09eac <_Heap_Walk+0x2f4> <== NEVER TAKEN
ffc09e9c: 80 1e 00 24 lwz r0,36(r30)
ffc09ea0: 7c 1b 00 10 subfc r0,r27,r0
ffc09ea4: 38 00 00 00 li r0,0
ffc09ea8: 7c 00 01 14 adde r0,r0,r0
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;
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
ffc09eac: 2f 80 00 00 cmpwi cr7,r0,0
ffc09eb0: 40 be 00 18 bne+ cr7,ffc09ec8 <_Heap_Walk+0x310>
(*printer)(
ffc09eb4: 3c a0 ff c2 lis r5,-62
ffc09eb8: 7f e3 fb 78 mr r3,r31
ffc09ebc: 38 80 00 01 li r4,1
ffc09ec0: 38 a5 83 e8 addi r5,r5,-31768
ffc09ec4: 48 00 00 a8 b ffc09f6c <_Heap_Walk+0x3b4>
RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned(
uintptr_t value,
uintptr_t alignment
)
{
return (value % alignment) == 0;
ffc09ec8: 7d 3c d3 96 divwu r9,r28,r26
ffc09ecc: 7d 29 d1 d6 mullw r9,r9,r26
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;
ffc09ed0: 7f a0 ba 78 xor r0,r29,r23
);
return false;
}
if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) {
ffc09ed4: 7f 9c 48 00 cmpw cr7,r28,r9
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;
ffc09ed8: 7c 00 00 34 cntlzw r0,r0
ffc09edc: 54 00 d9 7e rlwinm r0,r0,27,5,31
ffc09ee0: 68 00 00 01 xori r0,r0,1
);
return false;
}
if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) {
ffc09ee4: 41 9e 00 28 beq- cr7,ffc09f0c <_Heap_Walk+0x354>
ffc09ee8: 2f 80 00 00 cmpwi cr7,r0,0
ffc09eec: 41 be 00 20 beq+ cr7,ffc09f0c <_Heap_Walk+0x354>
(*printer)(
ffc09ef0: 3c a0 ff c2 lis r5,-62
ffc09ef4: 7f e3 fb 78 mr r3,r31
ffc09ef8: 38 80 00 01 li r4,1
ffc09efc: 38 a5 84 15 addi r5,r5,-31723
ffc09f00: 7f a6 eb 78 mr r6,r29
ffc09f04: 7f 87 e3 78 mr r7,r28
ffc09f08: 4b ff ff 18 b ffc09e20 <_Heap_Walk+0x268>
);
return false;
}
if ( block_size < min_block_size && is_not_last_block ) {
ffc09f0c: 7f 9c c8 40 cmplw cr7,r28,r25
ffc09f10: 40 9c 00 3c bge- cr7,ffc09f4c <_Heap_Walk+0x394>
ffc09f14: 2f 80 00 00 cmpwi cr7,r0,0
ffc09f18: 41 be 00 34 beq+ cr7,ffc09f4c <_Heap_Walk+0x394> <== NEVER TAKEN
(*printer)(
ffc09f1c: 80 01 00 18 lwz r0,24(r1)
ffc09f20: 3c a0 ff c2 lis r5,-62
ffc09f24: 7f e3 fb 78 mr r3,r31
ffc09f28: 38 80 00 01 li r4,1
ffc09f2c: 7c 09 03 a6 mtctr r0
ffc09f30: 38 a5 84 43 addi r5,r5,-31677
ffc09f34: 7f a6 eb 78 mr r6,r29
ffc09f38: 7f 87 e3 78 mr r7,r28
ffc09f3c: 7f 28 cb 78 mr r8,r25
ffc09f40: 4c c6 31 82 crclr 4*cr1+eq
ffc09f44: 4e 80 04 21 bctrl
ffc09f48: 4b ff fe e8 b ffc09e30 <_Heap_Walk+0x278>
);
return false;
}
if ( next_block_begin <= block_begin && is_not_last_block ) {
ffc09f4c: 7f 9b e8 40 cmplw cr7,r27,r29
ffc09f50: 41 9d 00 28 bgt- cr7,ffc09f78 <_Heap_Walk+0x3c0>
ffc09f54: 2f 80 00 00 cmpwi cr7,r0,0
ffc09f58: 41 be 00 20 beq+ cr7,ffc09f78 <_Heap_Walk+0x3c0>
(*printer)(
ffc09f5c: 3c a0 ff c2 lis r5,-62
ffc09f60: 7f e3 fb 78 mr r3,r31
ffc09f64: 38 80 00 01 li r4,1
ffc09f68: 38 a5 84 6e addi r5,r5,-31634
ffc09f6c: 7f a6 eb 78 mr r6,r29
ffc09f70: 7f 67 db 78 mr r7,r27
ffc09f74: 4b ff fe ac b ffc09e20 <_Heap_Walk+0x268>
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;
ffc09f78: 80 1b 00 04 lwz r0,4(r27)
ffc09f7c: 56 b5 07 fe clrlwi r21,r21,31
);
return false;
}
if ( !_Heap_Is_prev_used( next_block ) ) {
ffc09f80: 70 09 00 01 andi. r9,r0,1
ffc09f84: 40 a2 00 ec bne+ ffc0a070 <_Heap_Walk+0x4b8>
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 ?
ffc09f88: 81 1d 00 0c lwz r8,12(r29)
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)(
ffc09f8c: 39 2f 81 8e addi r9,r15,-32370
ffc09f90: 80 1e 00 08 lwz r0,8(r30)
block = next_block;
} while ( block != first_block );
return true;
}
ffc09f94: 81 7e 00 0c lwz r11,12(r30)
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)(
ffc09f98: 7f 88 00 00 cmpw cr7,r8,r0
ffc09f9c: 41 9e 00 14 beq- cr7,ffc09fb0 <_Heap_Walk+0x3f8>
block,
block_size,
block->prev,
block->prev == first_free_block ?
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
ffc09fa0: 7f 88 f0 00 cmpw cr7,r8,r30
ffc09fa4: 39 36 80 c3 addi r9,r22,-32573
ffc09fa8: 40 be 00 08 bne+ cr7,ffc09fb0 <_Heap_Walk+0x3f8>
ffc09fac: 39 2e 81 9e addi r9,r14,-32354
block->next,
block->next == last_free_block ?
ffc09fb0: 81 5d 00 08 lwz r10,8(r29)
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)(
ffc09fb4: 38 11 81 a8 addi r0,r17,-32344
ffc09fb8: 7f 8a 58 00 cmpw cr7,r10,r11
ffc09fbc: 41 9e 00 14 beq- cr7,ffc09fd0 <_Heap_Walk+0x418>
" (= first free)"
: (block->prev == free_list_head ? " (= head)" : ""),
block->next,
block->next == last_free_block ?
" (= last free)"
: (block->next == free_list_tail ? " (= tail)" : "")
ffc09fc0: 7f 8a f0 00 cmpw cr7,r10,r30
ffc09fc4: 38 16 80 c3 addi r0,r22,-32573
ffc09fc8: 40 be 00 08 bne+ cr7,ffc09fd0 <_Heap_Walk+0x418>
ffc09fcc: 38 10 81 b7 addi r0,r16,-32329
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)(
ffc09fd0: 90 01 00 08 stw r0,8(r1)
ffc09fd4: 7f e3 fb 78 mr r3,r31
ffc09fd8: 38 80 00 00 li r4,0
ffc09fdc: 80 01 00 18 lwz r0,24(r1)
ffc09fe0: 7e 45 93 78 mr r5,r18
ffc09fe4: 7f a6 eb 78 mr r6,r29
ffc09fe8: 7f 87 e3 78 mr r7,r28
ffc09fec: 7c 09 03 a6 mtctr r0
ffc09ff0: 4c c6 31 82 crclr 4*cr1+eq
ffc09ff4: 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 ) {
ffc09ff8: 81 1b 00 00 lwz r8,0(r27)
ffc09ffc: 7f 9c 40 00 cmpw cr7,r28,r8
ffc0a000: 41 be 00 34 beq+ cr7,ffc0a034 <_Heap_Walk+0x47c>
(*printer)(
ffc0a004: 80 01 00 18 lwz r0,24(r1)
ffc0a008: 3c a0 ff c2 lis r5,-62
ffc0a00c: 7f e3 fb 78 mr r3,r31
ffc0a010: 38 80 00 01 li r4,1
ffc0a014: 7c 09 03 a6 mtctr r0
ffc0a018: 38 a5 84 d7 addi r5,r5,-31529
ffc0a01c: 7f a6 eb 78 mr r6,r29
ffc0a020: 7f 87 e3 78 mr r7,r28
ffc0a024: 7f 69 db 78 mr r9,r27
ffc0a028: 4c c6 31 82 crclr 4*cr1+eq
ffc0a02c: 4e 80 04 21 bctrl
ffc0a030: 4b ff fe 00 b ffc09e30 <_Heap_Walk+0x278>
);
return false;
}
if ( !prev_used ) {
ffc0a034: 2f 95 00 00 cmpwi cr7,r21,0
ffc0a038: 40 be 00 18 bne+ cr7,ffc0a050 <_Heap_Walk+0x498>
(*printer)(
ffc0a03c: 3c a0 ff c2 lis r5,-62
ffc0a040: 7f e3 fb 78 mr r3,r31
ffc0a044: 38 80 00 01 li r4,1
ffc0a048: 38 a5 85 10 addi r5,r5,-31472
ffc0a04c: 48 00 00 a0 b ffc0a0ec <_Heap_Walk+0x534>
block = next_block;
} while ( block != first_block );
return true;
}
ffc0a050: 81 3e 00 08 lwz r9,8(r30)
ffc0a054: 48 00 00 10 b ffc0a064 <_Heap_Walk+0x4ac>
{
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 ) {
ffc0a058: 7f 89 e8 00 cmpw cr7,r9,r29
ffc0a05c: 41 9e 00 6c beq- cr7,ffc0a0c8 <_Heap_Walk+0x510>
return true;
}
free_block = free_block->next;
ffc0a060: 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 ) {
ffc0a064: 7f 89 f0 00 cmpw cr7,r9,r30
ffc0a068: 40 9e ff f0 bne+ cr7,ffc0a058 <_Heap_Walk+0x4a0>
ffc0a06c: 48 00 00 70 b ffc0a0dc <_Heap_Walk+0x524>
if ( !_Heap_Is_prev_used( next_block ) ) {
if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) {
return false;
}
} else if (prev_used) {
ffc0a070: 2f 95 00 00 cmpwi cr7,r21,0
ffc0a074: 41 9e 00 2c beq- cr7,ffc0a0a0 <_Heap_Walk+0x4e8>
(*printer)(
ffc0a078: 80 01 00 18 lwz r0,24(r1)
ffc0a07c: 7f e3 fb 78 mr r3,r31
ffc0a080: 38 80 00 00 li r4,0
ffc0a084: 7e 85 a3 78 mr r5,r20
ffc0a088: 7c 09 03 a6 mtctr r0
ffc0a08c: 7f a6 eb 78 mr r6,r29
ffc0a090: 7f 87 e3 78 mr r7,r28
ffc0a094: 4c c6 31 82 crclr 4*cr1+eq
ffc0a098: 4e 80 04 21 bctrl
ffc0a09c: 48 00 00 2c b ffc0a0c8 <_Heap_Walk+0x510>
"block 0x%08x: size %u\n",
block,
block_size
);
} else {
(*printer)(
ffc0a0a0: 80 01 00 18 lwz r0,24(r1)
ffc0a0a4: 7f e3 fb 78 mr r3,r31
ffc0a0a8: 38 80 00 00 li r4,0
ffc0a0ac: 81 1d 00 00 lwz r8,0(r29)
ffc0a0b0: 7e 65 9b 78 mr r5,r19
ffc0a0b4: 7c 09 03 a6 mtctr r0
ffc0a0b8: 7f a6 eb 78 mr r6,r29
ffc0a0bc: 7f 87 e3 78 mr r7,r28
ffc0a0c0: 4c c6 31 82 crclr 4*cr1+eq
ffc0a0c4: 4e 80 04 21 bctrl
block->prev_size
);
}
block = next_block;
} while ( block != first_block );
ffc0a0c8: 7f 9b c0 00 cmpw cr7,r27,r24
ffc0a0cc: 40 9e fd 80 bne+ cr7,ffc09e4c <_Heap_Walk+0x294>
return true;
ffc0a0d0: 38 60 00 01 li r3,1
}
ffc0a0d4: 39 61 00 68 addi r11,r1,104
ffc0a0d8: 4b ff 69 e8 b ffc00ac0 <_restgpr_14_x>
return false;
}
if ( !_Heap_Walk_is_in_free_list( heap, block ) ) {
(*printer)(
ffc0a0dc: 3c a0 ff c2 lis r5,-62
ffc0a0e0: 7f e3 fb 78 mr r3,r31
ffc0a0e4: 38 80 00 01 li r4,1
ffc0a0e8: 38 a5 85 7b addi r5,r5,-31365
ffc0a0ec: 7f a6 eb 78 mr r6,r29
ffc0a0f0: 80 01 00 18 lwz r0,24(r1)
ffc0a0f4: 7c 09 03 a6 mtctr r0
ffc0a0f8: 4c c6 31 82 crclr 4*cr1+eq
ffc0a0fc: 4e 80 04 21 bctrl
ffc0a100: 4b ff fd 30 b ffc09e30 <_Heap_Walk+0x278>
ffc09b08 <_Heap_Walk_print>:
static void _Heap_Walk_print( int source, bool error, const char *fmt, ... )
{
ffc09b08: 7c 08 02 a6 mflr r0
ffc09b0c: 7c 2b 0b 78 mr r11,r1
ffc09b10: 94 21 ff 88 stwu r1,-120(r1)
ffc09b14: 90 01 00 7c stw r0,124(r1)
ffc09b18: 4b ff 6f a1 bl ffc00ab8 <_savegpr_31>
ffc09b1c: 7c 60 1b 78 mr r0,r3
ffc09b20: 90 c1 00 1c stw r6,28(r1)
ffc09b24: 90 e1 00 20 stw r7,32(r1)
ffc09b28: 91 01 00 24 stw r8,36(r1)
ffc09b2c: 91 21 00 28 stw r9,40(r1)
ffc09b30: 91 41 00 2c stw r10,44(r1)
ffc09b34: 40 86 00 24 bne- cr1,ffc09b58 <_Heap_Walk_print+0x50> <== ALWAYS TAKEN
ffc09b38: d8 21 00 30 stfd f1,48(r1)
ffc09b3c: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED
ffc09b40: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED
ffc09b44: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED
ffc09b48: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED
ffc09b4c: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED
ffc09b50: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED
ffc09b54: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED
va_list ap;
if ( error ) {
ffc09b58: 2f 84 00 00 cmpwi cr7,r4,0
{
/* Do nothing */
}
static void _Heap_Walk_print( int source, bool error, const char *fmt, ... )
{
ffc09b5c: 7c bf 2b 78 mr r31,r5
va_list ap;
if ( error ) {
ffc09b60: 41 be 00 10 beq+ cr7,ffc09b70 <_Heap_Walk_print+0x68>
printk( "FAIL[%d]: ", source );
ffc09b64: 3c 60 ff c2 lis r3,-62
ffc09b68: 38 63 81 78 addi r3,r3,-32392
ffc09b6c: 48 00 00 0c b ffc09b78 <_Heap_Walk_print+0x70>
} else {
printk( "PASS[%d]: ", source );
ffc09b70: 3c 60 ff c2 lis r3,-62
ffc09b74: 38 63 81 83 addi r3,r3,-32381
ffc09b78: 7c 04 03 78 mr r4,r0
ffc09b7c: 4c c6 31 82 crclr 4*cr1+eq
ffc09b80: 4b ff be a1 bl ffc05a20 <printk>
}
va_start( ap, fmt );
ffc09b84: 38 00 00 03 li r0,3
ffc09b88: 98 01 00 08 stb r0,8(r1)
ffc09b8c: 38 00 00 00 li r0,0
vprintk( fmt, ap );
ffc09b90: 7f e3 fb 78 mr r3,r31
printk( "FAIL[%d]: ", source );
} else {
printk( "PASS[%d]: ", source );
}
va_start( ap, fmt );
ffc09b94: 98 01 00 09 stb r0,9(r1)
ffc09b98: 38 01 00 80 addi r0,r1,128
vprintk( fmt, ap );
ffc09b9c: 38 81 00 08 addi r4,r1,8
printk( "FAIL[%d]: ", source );
} else {
printk( "PASS[%d]: ", source );
}
va_start( ap, fmt );
ffc09ba0: 90 01 00 0c stw r0,12(r1)
ffc09ba4: 38 01 00 10 addi r0,r1,16
ffc09ba8: 90 01 00 10 stw r0,16(r1)
vprintk( fmt, ap );
ffc09bac: 4b ff dc 39 bl ffc077e4 <vprintk>
va_end( ap );
}
ffc09bb0: 39 61 00 78 addi r11,r1,120
ffc09bb4: 4b ff 6f 50 b ffc00b04 <_restgpr_31_x>
ffc092a0 <_IO_Manager_initialization>:
* workspace.
*
*/
void _IO_Manager_initialization(void)
{
ffc092a0: 94 21 ff e0 stwu r1,-32(r1)
ffc092a4: 7c 08 02 a6 mflr r0
uint32_t index;
rtems_driver_address_table *driver_table;
uint32_t drivers_in_table;
uint32_t number_of_drivers;
driver_table = Configuration.Device_driver_table;
ffc092a8: 3d 20 00 00 lis r9,0
* workspace.
*
*/
void _IO_Manager_initialization(void)
{
ffc092ac: 90 01 00 24 stw r0,36(r1)
uint32_t index;
rtems_driver_address_table *driver_table;
uint32_t drivers_in_table;
uint32_t number_of_drivers;
driver_table = Configuration.Device_driver_table;
ffc092b0: 39 29 20 88 addi r9,r9,8328
* workspace.
*
*/
void _IO_Manager_initialization(void)
{
ffc092b4: bf 41 00 08 stmw r26,8(r1)
ffc092b8: 3f a0 00 00 lis r29,0
ffc092bc: 3f 40 00 00 lis r26,0
rtems_driver_address_table *driver_table;
uint32_t drivers_in_table;
uint32_t number_of_drivers;
driver_table = Configuration.Device_driver_table;
drivers_in_table = Configuration.number_of_device_drivers;
ffc092c0: 83 c9 00 34 lwz r30,52(r9)
number_of_drivers = Configuration.maximum_drivers;
ffc092c4: 83 69 00 30 lwz r27,48(r9)
uint32_t index;
rtems_driver_address_table *driver_table;
uint32_t drivers_in_table;
uint32_t number_of_drivers;
driver_table = Configuration.Device_driver_table;
ffc092c8: 83 e9 00 38 lwz r31,56(r9)
/*
* If the user claims there are less drivers than are actually in
* the table, then let's just go with the table's count.
*/
if ( number_of_drivers <= drivers_in_table )
ffc092cc: 7f 9b f0 40 cmplw cr7,r27,r30
ffc092d0: 40 9d 00 40 ble- cr7,ffc09310 <_IO_Manager_initialization+0x70>
* have to allocate a new driver table and copy theirs to it.
*/
_IO_Driver_address_table = (rtems_driver_address_table *)
_Workspace_Allocate_or_fatal_error(
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
ffc092d4: 1f 9b 00 18 mulli r28,r27,24
* The application requested extra slots in the driver table, so we
* have to allocate a new driver table and copy theirs to it.
*/
_IO_Driver_address_table = (rtems_driver_address_table *)
_Workspace_Allocate_or_fatal_error(
ffc092d8: 7f 83 e3 78 mr r3,r28
ffc092dc: 48 00 35 11 bl ffc0c7ec <_Workspace_Allocate_or_fatal_error>
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
);
_IO_Number_of_drivers = number_of_drivers;
memset(
ffc092e0: 38 80 00 00 li r4,0
ffc092e4: 7f 85 e3 78 mr r5,r28
/*
* The application requested extra slots in the driver table, so we
* have to allocate a new driver table and copy theirs to it.
*/
_IO_Driver_address_table = (rtems_driver_address_table *)
ffc092e8: 90 7d 27 e4 stw r3,10212(r29)
_Workspace_Allocate_or_fatal_error(
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
);
_IO_Number_of_drivers = number_of_drivers;
ffc092ec: 93 7a 27 e0 stw r27,10208(r26)
memset(
ffc092f0: 48 00 be e1 bl ffc151d0 <memset>
ffc092f4: 2f 9e 00 00 cmpwi cr7,r30,0
_IO_Driver_address_table, 0,
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
);
for ( index = 0 ; index < drivers_in_table ; index++ )
ffc092f8: 39 60 00 00 li r11,0
_IO_Driver_address_table[index] = driver_table[index];
ffc092fc: 7f a4 eb 78 mr r4,r29
ffc09300: 38 1e 00 01 addi r0,r30,1
ffc09304: 40 be 00 30 bne+ cr7,ffc09334 <_IO_Manager_initialization+0x94><== ALWAYS TAKEN
ffc09308: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc0930c: 48 00 00 28 b ffc09334 <_IO_Manager_initialization+0x94><== NOT EXECUTED
* If the maximum number of driver is the same as the number in the
* table, then we do not have to copy the driver table. They can't
* register any dynamically.
*/
if ( number_of_drivers == drivers_in_table ) {
_IO_Driver_address_table = driver_table;
ffc09310: 93 fd 27 e4 stw r31,10212(r29)
_IO_Number_of_drivers = number_of_drivers;
ffc09314: 93 da 27 e0 stw r30,10208(r26)
return;
ffc09318: 48 00 00 24 b ffc0933c <_IO_Manager_initialization+0x9c>
_IO_Driver_address_table, 0,
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
);
for ( index = 0 ; index < drivers_in_table ; index++ )
_IO_Driver_address_table[index] = driver_table[index];
ffc0931c: 80 64 27 e4 lwz r3,10212(r4)
ffc09320: 7d 9f 5a 14 add r12,r31,r11
ffc09324: 7c 63 5a 14 add r3,r3,r11
ffc09328: 7c ac c4 aa lswi r5,r12,24
ffc0932c: 7c a3 c5 aa stswi r5,r3,24
memset(
_IO_Driver_address_table, 0,
sizeof( rtems_driver_address_table ) * ( number_of_drivers )
);
for ( index = 0 ; index < drivers_in_table ; index++ )
ffc09330: 39 6b 00 18 addi r11,r11,24
ffc09334: 34 00 ff ff addic. r0,r0,-1
ffc09338: 40 82 ff e4 bne+ ffc0931c <_IO_Manager_initialization+0x7c>
_IO_Driver_address_table[index] = driver_table[index];
}
ffc0933c: 39 61 00 20 addi r11,r1,32
ffc09340: 48 00 ff 14 b ffc19254 <_restgpr_26_x>
ffc0a1ac <_Internal_error_Occurred>:
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
ffc0a1ac: 7c 2b 0b 78 mr r11,r1
ffc0a1b0: 94 21 ff f0 stwu r1,-16(r1)
ffc0a1b4: 7c 08 02 a6 mflr r0
ffc0a1b8: 48 00 f0 65 bl ffc1921c <_savegpr_31>
_Internal_errors_What_happened.the_source = the_source;
ffc0a1bc: 3d 60 00 00 lis r11,0
ffc0a1c0: 39 2b 2d 90 addi r9,r11,11664
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
ffc0a1c4: 90 01 00 14 stw r0,20(r1)
ffc0a1c8: 7c bf 2b 78 mr r31,r5
_Internal_errors_What_happened.the_source = the_source;
_Internal_errors_What_happened.is_internal = is_internal;
ffc0a1cc: 98 89 00 04 stb r4,4(r9)
_Internal_errors_What_happened.the_error = the_error;
ffc0a1d0: 90 a9 00 08 stw r5,8(r9)
bool is_internal,
Internal_errors_t the_error
)
{
_Internal_errors_What_happened.the_source = the_source;
ffc0a1d4: 90 6b 2d 90 stw r3,11664(r11)
_Internal_errors_What_happened.is_internal = is_internal;
_Internal_errors_What_happened.the_error = the_error;
_User_extensions_Fatal( the_source, is_internal, the_error );
ffc0a1d8: 48 00 21 65 bl ffc0c33c <_User_extensions_Fatal>
RTEMS_INLINE_ROUTINE void _System_state_Set (
System_state_Codes state
)
{
_System_state_Current = state;
ffc0a1dc: 38 00 00 05 li r0,5
ffc0a1e0: 3d 20 00 00 lis r9,0
_System_state_Set( SYSTEM_STATE_FAILED );
_CPU_Fatal_halt( the_error );
ffc0a1e4: 7f e3 fb 78 mr r3,r31
ffc0a1e8: 90 09 27 cc stw r0,10188(r9)
ffc0a1ec: 4b ff 97 d9 bl ffc039c4 <_BSP_Fatal_error>
ffc0a1f0: 48 00 00 00 b ffc0a1f0 <_Internal_error_Occurred+0x44><== NOT EXECUTED
ffc0a208 <_Objects_Allocate>:
*/
Objects_Control *_Objects_Allocate(
Objects_Information *information
)
{
ffc0a208: 94 21 ff f0 stwu r1,-16(r1)
ffc0a20c: 7c 08 02 a6 mflr r0
ffc0a210: 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 )
ffc0a214: 80 03 00 18 lwz r0,24(r3)
*/
Objects_Control *_Objects_Allocate(
Objects_Information *information
)
{
ffc0a218: bf c1 00 08 stmw r30,8(r1)
ffc0a21c: 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 )
ffc0a220: 2f 80 00 00 cmpwi cr7,r0,0
return NULL;
ffc0a224: 38 60 00 00 li r3,0
* 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 )
ffc0a228: 41 be 00 70 beq+ cr7,ffc0a298 <_Objects_Allocate+0x90> <== NEVER TAKEN
/*
* 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 );
ffc0a22c: 3b df 00 20 addi r30,r31,32
ffc0a230: 7f c3 f3 78 mr r3,r30
ffc0a234: 4b ff f6 65 bl ffc09898 <_Chain_Get>
if ( information->auto_extend ) {
ffc0a238: 88 1f 00 12 lbz r0,18(r31)
ffc0a23c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0a240: 41 9e 00 58 beq- cr7,ffc0a298 <_Objects_Allocate+0x90>
/*
* If the list is empty then we are out of objects and need to
* extend information base.
*/
if ( !the_object ) {
ffc0a244: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a248: 40 be 00 1c bne+ cr7,ffc0a264 <_Objects_Allocate+0x5c>
_Objects_Extend_information( information );
ffc0a24c: 7f e3 fb 78 mr r3,r31
ffc0a250: 48 00 00 85 bl ffc0a2d4 <_Objects_Extend_information>
the_object = (Objects_Control *) _Chain_Get( &information->Inactive );
ffc0a254: 7f c3 f3 78 mr r3,r30
ffc0a258: 4b ff f6 41 bl ffc09898 <_Chain_Get>
}
if ( the_object ) {
ffc0a25c: 2c 03 00 00 cmpwi r3,0
ffc0a260: 41 a2 00 38 beq+ ffc0a298 <_Objects_Allocate+0x90>
uint32_t block;
block = (uint32_t) _Objects_Get_index( the_object->id ) -
ffc0a264: a1 23 00 0a lhz r9,10(r3)
ffc0a268: a0 1f 00 0a lhz r0,10(r31)
ffc0a26c: 7c 00 48 50 subf r0,r0,r9
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
ffc0a270: a1 3f 00 14 lhz r9,20(r31)
ffc0a274: 7c 00 4b 96 divwu r0,r0,r9
information->inactive_per_block[ block ]--;
ffc0a278: 81 3f 00 30 lwz r9,48(r31)
ffc0a27c: 54 00 10 3a rlwinm r0,r0,2,0,29
ffc0a280: 7d 69 00 2e lwzx r11,r9,r0
ffc0a284: 39 6b ff ff addi r11,r11,-1
ffc0a288: 7d 69 01 2e stwx r11,r9,r0
information->inactive--;
ffc0a28c: a1 3f 00 2c lhz r9,44(r31)
ffc0a290: 38 09 ff ff addi r0,r9,-1
ffc0a294: b0 1f 00 2c sth r0,44(r31)
);
}
#endif
return the_object;
}
ffc0a298: 39 61 00 10 addi r11,r1,16
ffc0a29c: 48 00 ef c8 b ffc19264 <_restgpr_30_x>
ffc0a2d4 <_Objects_Extend_information>:
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
ffc0a2d4: 94 21 ff b8 stwu r1,-72(r1)
ffc0a2d8: 7c 08 02 a6 mflr r0
ffc0a2dc: 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 )
ffc0a2e0: 81 63 00 34 lwz r11,52(r3)
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
ffc0a2e4: be a1 00 1c stmw r21,28(r1)
ffc0a2e8: 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 )
ffc0a2ec: 2f 8b 00 00 cmpwi cr7,r11,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 );
ffc0a2f0: a3 83 00 0a lhz r28,10(r3)
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
ffc0a2f4: 41 9e 00 54 beq- cr7,ffc0a348 <_Objects_Extend_information+0x74>
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc0a2f8: a1 23 00 14 lhz r9,20(r3)
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc0a2fc: 39 6b ff fc addi r11,r11,-4
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc0a300: a3 63 00 10 lhz r27,16(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 );
ffc0a304: 7f 9e e3 78 mr r30,r28
index_base = minimum_index;
block = 0;
ffc0a308: 3b a0 00 00 li r29,0
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
ffc0a30c: 7f 7b 4b 96 divwu r27,r27,r9
ffc0a310: 2f 9b 00 00 cmpwi cr7,r27,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;
ffc0a314: 38 1b 00 01 addi r0,r27,1
ffc0a318: 40 be 00 20 bne+ cr7,ffc0a338 <_Objects_Extend_information+0x64><== ALWAYS TAKEN
ffc0a31c: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc0a320: 48 00 00 18 b ffc0a338 <_Objects_Extend_information+0x64><== NOT EXECUTED
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
if ( information->object_blocks[ block ] == NULL ) {
ffc0a324: 85 4b 00 04 lwzu r10,4(r11)
ffc0a328: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0a32c: 41 9e 00 30 beq- cr7,ffc0a35c <_Objects_Extend_information+0x88>
ffc0a330: 7f de 4a 14 add r30,r30,r9
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
ffc0a334: 3b bd 00 01 addi r29,r29,1
ffc0a338: 34 00 ff ff addic. r0,r0,-1
ffc0a33c: 40 82 ff e8 bne+ ffc0a324 <_Objects_Extend_information+0x50>
/*
* 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;
ffc0a340: 3b 20 00 01 li r25,1
ffc0a344: 48 00 00 1c b ffc0a360 <_Objects_Extend_information+0x8c>
minimum_index = _Objects_Get_index( information->minimum_id );
ffc0a348: 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;
ffc0a34c: 3b 20 00 01 li r25,1
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
ffc0a350: 3b a0 00 00 li r29,0
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
block_count = 0;
ffc0a354: 3b 60 00 00 li r27,0
ffc0a358: 48 00 00 08 b ffc0a360 <_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;
ffc0a35c: 3b 20 00 00 li r25,0
} else
index_base += information->allocation_size;
}
}
maximum = (uint32_t) information->maximum + information->allocation_size;
ffc0a360: a0 1f 00 14 lhz r0,20(r31)
ffc0a364: a2 ff 00 10 lhz r23,16(r31)
ffc0a368: 7e e0 ba 14 add r23,r0,r23
/*
* 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 ) {
ffc0a36c: 2b 97 ff ff cmplwi cr7,r23,65535
ffc0a370: 41 9d 02 08 bgt- cr7,ffc0a578 <_Objects_Extend_information+0x2a4>
/*
* 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;
ffc0a374: 80 7f 00 18 lwz r3,24(r31)
ffc0a378: 7c 60 19 d6 mullw r3,r0,r3
if ( information->auto_extend ) {
ffc0a37c: 88 1f 00 12 lbz r0,18(r31)
ffc0a380: 2f 80 00 00 cmpwi cr7,r0,0
ffc0a384: 41 9e 00 14 beq- cr7,ffc0a398 <_Objects_Extend_information+0xc4>
new_object_block = _Workspace_Allocate( block_size );
ffc0a388: 48 00 24 05 bl ffc0c78c <_Workspace_Allocate>
if ( !new_object_block )
ffc0a38c: 7c 7a 1b 79 mr. r26,r3
ffc0a390: 40 a2 00 10 bne+ ffc0a3a0 <_Objects_Extend_information+0xcc>
ffc0a394: 48 00 01 e4 b ffc0a578 <_Objects_Extend_information+0x2a4>
return;
} else {
new_object_block = _Workspace_Allocate_or_fatal_error( block_size );
ffc0a398: 48 00 24 55 bl ffc0c7ec <_Workspace_Allocate_or_fatal_error>
ffc0a39c: 7c 7a 1b 78 mr r26,r3
}
/*
* Do we need to grow the tables?
*/
if ( do_extend ) {
ffc0a3a0: 2f 99 00 00 cmpwi cr7,r25,0
ffc0a3a4: 41 9e 01 54 beq- cr7,ffc0a4f8 <_Objects_Extend_information+0x224>
*/
/*
* Up the block count and maximum
*/
block_count++;
ffc0a3a8: 3b 3b 00 01 addi r25,r27,1
/*
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
ffc0a3ac: 1c 19 00 03 mulli r0,r25,3
((maximum + minimum_index) * sizeof(Objects_Control *));
ffc0a3b0: 7c 77 e2 14 add r3,r23,r28
/*
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
ffc0a3b4: 7c 63 02 14 add r3,r3,r0
((maximum + minimum_index) * sizeof(Objects_Control *));
object_blocks = (void**) _Workspace_Allocate( block_size );
ffc0a3b8: 54 63 10 3a rlwinm r3,r3,2,0,29
ffc0a3bc: 48 00 23 d1 bl ffc0c78c <_Workspace_Allocate>
if ( !object_blocks ) {
ffc0a3c0: 7c 76 1b 79 mr. r22,r3
ffc0a3c4: 40 a2 00 10 bne+ ffc0a3d4 <_Objects_Extend_information+0x100>
_Workspace_Free( new_object_block );
ffc0a3c8: 7f 43 d3 78 mr r3,r26
ffc0a3cc: 48 00 23 f5 bl ffc0c7c0 <_Workspace_Free>
return;
ffc0a3d0: 48 00 01 a8 b ffc0a578 <_Objects_Extend_information+0x2a4>
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a3d4: a0 1f 00 10 lhz r0,16(r31)
}
/*
* Break the block into the various sections.
*/
inactive_per_block = (uint32_t *) _Addresses_Add_offset(
ffc0a3d8: 57 39 10 3a rlwinm r25,r25,2,0,29
RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset (
const void *base,
uintptr_t offset
)
{
return (void *)((uintptr_t)base + offset);
ffc0a3dc: 7f 16 ca 14 add r24,r22,r25
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
ffc0a3e0: 7f 80 e0 40 cmplw cr7,r0,r28
ffc0a3e4: 7f 38 ca 14 add r25,r24,r25
ffc0a3e8: 41 9d 00 20 bgt- cr7,ffc0a408 <_Objects_Extend_information+0x134>
ffc0a3ec: 2f 9c 00 00 cmpwi cr7,r28,0
ffc0a3f0: 39 39 ff fc addi r9,r25,-4
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
ffc0a3f4: 39 60 00 00 li r11,0
ffc0a3f8: 38 1c 00 01 addi r0,r28,1
ffc0a3fc: 40 be 00 4c bne+ cr7,ffc0a448 <_Objects_Extend_information+0x174><== ALWAYS TAKEN
ffc0a400: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc0a404: 48 00 00 44 b ffc0a448 <_Objects_Extend_information+0x174><== NOT EXECUTED
* separate parts as size of each block has changed.
*/
memcpy( object_blocks,
information->object_blocks,
block_count * sizeof(void*) );
ffc0a408: 57 75 10 3a rlwinm r21,r27,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,
ffc0a40c: 80 9f 00 34 lwz r4,52(r31)
ffc0a410: 7e a5 ab 78 mr r5,r21
ffc0a414: 48 00 ac dd bl ffc150f0 <memcpy>
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
ffc0a418: 80 9f 00 30 lwz r4,48(r31)
ffc0a41c: 7e a5 ab 78 mr r5,r21
ffc0a420: 7f 03 c3 78 mr r3,r24
ffc0a424: 48 00 ac cd bl ffc150f0 <memcpy>
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
information->local_table,
(information->maximum + minimum_index) * sizeof(Objects_Control *) );
ffc0a428: a0 1f 00 10 lhz r0,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,
ffc0a42c: 80 9f 00 1c lwz r4,28(r31)
ffc0a430: 7f 23 cb 78 mr r3,r25
information->local_table,
(information->maximum + minimum_index) * sizeof(Objects_Control *) );
ffc0a434: 7f 9c 02 14 add r28,r28,r0
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
ffc0a438: 57 85 10 3a rlwinm r5,r28,2,0,29
ffc0a43c: 48 00 ac b5 bl ffc150f0 <memcpy>
ffc0a440: 48 00 00 10 b ffc0a450 <_Objects_Extend_information+0x17c>
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
ffc0a444: 95 69 00 04 stwu r11,4(r9)
} else {
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
ffc0a448: 34 00 ff ff addic. r0,r0,-1
ffc0a44c: 40 82 ff f8 bne+ ffc0a444 <_Objects_Extend_information+0x170>
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
ffc0a450: a1 5f 00 14 lhz r10,20(r31)
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc0a454: 57 c9 10 3a rlwinm r9,r30,2,0,29
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
ffc0a458: 38 00 00 00 li r0,0
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
ffc0a45c: 7d 7e 52 14 add r11,r30,r10
ffc0a460: 7f 9e 58 40 cmplw cr7,r30,r11
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
ffc0a464: 57 7b 10 3a rlwinm r27,r27,2,0,29
* information - object information table
*
* Output parameters: NONE
*/
void _Objects_Extend_information(
ffc0a468: 39 29 ff fc addi r9,r9,-4
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
ffc0a46c: 7c 16 d9 2e stwx r0,r22,r27
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
ffc0a470: 7d 29 ca 14 add r9,r9,r25
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
ffc0a474: 7c 18 d9 2e stwx r0,r24,r27
for ( index=index_base ;
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
ffc0a478: 39 00 00 00 li r8,0
ffc0a47c: 38 0a 00 01 addi r0,r10,1
ffc0a480: 41 9d 00 0c bgt- cr7,ffc0a48c <_Objects_Extend_information+0x1b8><== NEVER TAKEN
ffc0a484: 2f 8b 00 00 cmpwi cr7,r11,0
ffc0a488: 40 be 00 10 bne+ cr7,ffc0a498 <_Objects_Extend_information+0x1c4><== ALWAYS TAKEN
ffc0a48c: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc0a490: 48 00 00 08 b ffc0a498 <_Objects_Extend_information+0x1c4><== NOT EXECUTED
ffc0a494: 95 09 00 04 stwu r8,4(r9)
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
ffc0a498: 34 00 ff ff addic. r0,r0,-1
ffc0a49c: 40 82 ff f8 bne+ ffc0a494 <_Objects_Extend_information+0x1c0>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0a4a0: 7c 00 00 a6 mfmsr r0
ffc0a4a4: 7d 30 42 a6 mfsprg r9,0
ffc0a4a8: 7c 09 48 78 andc r9,r0,r9
ffc0a4ac: 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) |
ffc0a4b0: 81 3f 00 00 lwz r9,0(r31)
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;
ffc0a4b4: 56 f7 04 3e clrlwi r23,r23,16
information->maximum_id = _Objects_Build_id(
ffc0a4b8: a1 7f 00 04 lhz r11,4(r31)
ffc0a4bc: 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;
ffc0a4c0: b2 ff 00 10 sth r23,16(r31)
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a4c4: 55 6b d8 08 rlwinm r11,r11,27,0,4
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a4c8: 65 29 00 01 oris r9,r9,1
local_table[ index ] = NULL;
}
_ISR_Disable( level );
old_tables = information->object_blocks;
ffc0a4cc: 80 7f 00 34 lwz r3,52(r31)
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a4d0: 7d 29 5b 78 or r9,r9,r11
information->object_blocks = object_blocks;
ffc0a4d4: 92 df 00 34 stw r22,52(r31)
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a4d8: 7d 37 bb 78 or r23,r9,r23
information->inactive_per_block = inactive_per_block;
ffc0a4dc: 93 1f 00 30 stw r24,48(r31)
information->local_table = local_table;
ffc0a4e0: 93 3f 00 1c stw r25,28(r31)
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
ffc0a4e4: 92 ff 00 0c stw r23,12(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0a4e8: 7c 00 01 24 mtmsr r0
information->maximum
);
_ISR_Enable( level );
if ( old_tables )
ffc0a4ec: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a4f0: 41 9e 00 08 beq- cr7,ffc0a4f8 <_Objects_Extend_information+0x224>
_Workspace_Free( old_tables );
ffc0a4f4: 48 00 22 cd bl ffc0c7c0 <_Workspace_Free>
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
ffc0a4f8: 81 3f 00 34 lwz r9,52(r31)
ffc0a4fc: 57 bd 10 3a rlwinm r29,r29,2,0,29
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a500: 3b 81 00 08 addi r28,r1,8
ffc0a504: 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;
ffc0a508: 7f 49 e9 2e stwx r26,r9,r29
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a50c: 7f 83 e3 78 mr r3,r28
ffc0a510: 7f 44 d3 78 mr r4,r26
ffc0a514: 80 df 00 18 lwz r6,24(r31)
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a518: 3b 7f 00 20 addi r27,r31,32
information->object_blocks[ block ] = new_object_block;
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
ffc0a51c: 48 00 78 65 bl ffc11d80 <_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 ) {
ffc0a520: 48 00 00 30 b ffc0a550 <_Objects_Extend_information+0x27c>
ffc0a524: 81 3f 00 00 lwz r9,0(r31)
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a528: 7f 63 db 78 mr r3,r27
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
the_object->id = _Objects_Build_id(
ffc0a52c: a0 1f 00 04 lhz r0,4(r31)
ffc0a530: 55 29 c0 0e rlwinm r9,r9,24,0,7
ffc0a534: 65 29 00 01 oris r9,r9,1
(( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) |
ffc0a538: 54 00 d8 08 rlwinm r0,r0,27,0,4
ffc0a53c: 7d 20 03 78 or r0,r9,r0
uint32_t the_class,
uint32_t node,
uint32_t index
)
{
return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) |
ffc0a540: 7c 00 f3 78 or r0,r0,r30
ffc0a544: 90 04 00 08 stw r0,8(r4)
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
ffc0a548: 3b de 00 01 addi r30,r30,1
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
ffc0a54c: 4b ff f2 f5 bl ffc09840 <_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 ) {
ffc0a550: 7f 83 e3 78 mr r3,r28
ffc0a554: 4b ff f3 45 bl ffc09898 <_Chain_Get>
ffc0a558: 7c 64 1b 79 mr. r4,r3
ffc0a55c: 40 82 ff c8 bne+ ffc0a524 <_Objects_Extend_information+0x250>
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
ffc0a560: a0 1f 00 14 lhz r0,20(r31)
ffc0a564: 81 3f 00 30 lwz r9,48(r31)
ffc0a568: 7c 09 e9 2e stwx r0,r9,r29
information->inactive =
(Objects_Maximum)(information->inactive + information->allocation_size);
ffc0a56c: a1 3f 00 2c lhz r9,44(r31)
ffc0a570: 7c 00 4a 14 add r0,r0,r9
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
information->inactive =
ffc0a574: b0 1f 00 2c sth r0,44(r31)
(Objects_Maximum)(information->inactive + information->allocation_size);
}
ffc0a578: 39 61 00 48 addi r11,r1,72
ffc0a57c: 48 00 ec c4 b ffc19240 <_restgpr_21_x>
ffc0a634 <_Objects_Get_information>:
Objects_Information *_Objects_Get_information(
Objects_APIs the_api,
uint16_t the_class
)
{
ffc0a634: 94 21 ff e8 stwu r1,-24(r1)
ffc0a638: 7c 08 02 a6 mflr r0
ffc0a63c: bf a1 00 0c stmw r29,12(r1)
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
ffc0a640: 7c 9d 23 79 mr. r29,r4
Objects_Information *_Objects_Get_information(
Objects_APIs the_api,
uint16_t the_class
)
{
ffc0a644: 7c 7e 1b 78 mr r30,r3
ffc0a648: 90 01 00 1c stw r0,28(r1)
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
return NULL;
ffc0a64c: 3b e0 00 00 li r31,0
)
{
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
ffc0a650: 41 a2 00 50 beq+ ffc0a6a0 <_Objects_Get_information+0x6c>
/*
* 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 );
ffc0a654: 48 00 7e 81 bl ffc124d4 <_Objects_API_maximum_class>
if ( the_class_api_maximum == 0 )
ffc0a658: 2c 03 00 00 cmpwi r3,0
ffc0a65c: 41 a2 00 44 beq+ ffc0a6a0 <_Objects_Get_information+0x6c>
return NULL;
if ( the_class > (uint32_t) the_class_api_maximum )
ffc0a660: 7f 9d 18 40 cmplw cr7,r29,r3
ffc0a664: 41 bd 00 3c bgt+ cr7,ffc0a6a0 <_Objects_Get_information+0x6c>
return NULL;
if ( !_Objects_Information_table[ the_api ] )
ffc0a668: 3d 20 00 00 lis r9,0
ffc0a66c: 57 de 10 3a rlwinm r30,r30,2,0,29
ffc0a670: 39 29 2c 80 addi r9,r9,11392
ffc0a674: 7d 29 f0 2e lwzx r9,r9,r30
ffc0a678: 2f 89 00 00 cmpwi cr7,r9,0
ffc0a67c: 41 be 00 24 beq+ cr7,ffc0a6a0 <_Objects_Get_information+0x6c><== NEVER TAKEN
return NULL;
info = _Objects_Information_table[ the_api ][ the_class ];
ffc0a680: 57 bd 10 3a rlwinm r29,r29,2,0,29
ffc0a684: 7f e9 e8 2e lwzx r31,r9,r29
if ( !info )
ffc0a688: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0a68c: 41 be 00 14 beq+ cr7,ffc0a6a0 <_Objects_Get_information+0x6c><== 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 )
ffc0a690: a0 1f 00 10 lhz r0,16(r31)
ffc0a694: 2f 80 00 00 cmpwi cr7,r0,0
ffc0a698: 40 be 00 08 bne+ cr7,ffc0a6a0 <_Objects_Get_information+0x6c>
return NULL;
ffc0a69c: 3b e0 00 00 li r31,0
#endif
return info;
}
ffc0a6a0: 39 61 00 18 addi r11,r1,24
ffc0a6a4: 7f e3 fb 78 mr r3,r31
ffc0a6a8: 48 00 eb b8 b ffc19260 <_restgpr_29_x>
ffc1bac0 <_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;
ffc1bac0: 80 03 00 08 lwz r0,8(r3)
if ( information->maximum >= index ) {
ffc1bac4: a1 23 00 10 lhz r9,16(r3)
/*
* 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;
ffc1bac8: 20 00 00 01 subfic r0,r0,1
ffc1bacc: 7c 00 22 14 add r0,r0,r4
if ( information->maximum >= index ) {
ffc1bad0: 7f 89 00 40 cmplw cr7,r9,r0
ffc1bad4: 41 9c 00 24 blt- cr7,ffc1baf8 <_Objects_Get_no_protection+0x38>
if ( (the_object = information->local_table[ index ]) != NULL ) {
ffc1bad8: 81 23 00 1c lwz r9,28(r3)
ffc1badc: 54 00 10 3a rlwinm r0,r0,2,0,29
ffc1bae0: 7c 69 00 2e lwzx r3,r9,r0
ffc1bae4: 2f 83 00 00 cmpwi cr7,r3,0
ffc1bae8: 41 9e 00 10 beq- cr7,ffc1baf8 <_Objects_Get_no_protection+0x38><== NEVER TAKEN
*location = OBJECTS_LOCAL;
ffc1baec: 38 00 00 00 li r0,0
ffc1baf0: 90 05 00 00 stw r0,0(r5)
return the_object;
ffc1baf4: 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;
ffc1baf8: 38 00 00 01 li r0,1
ffc1bafc: 90 05 00 00 stw r0,0(r5)
return NULL;
ffc1bb00: 38 60 00 00 li r3,0
}
ffc1bb04: 4e 80 00 20 blr
ffc0add4 <_Objects_Id_to_name>:
*/
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
ffc0add4: 94 21 ff e0 stwu r1,-32(r1)
ffc0add8: 7c 08 02 a6 mflr r0
ffc0addc: bf c1 00 18 stmw r30,24(r1)
ffc0ade0: 7c 9e 23 78 mr r30,r4
/*
* Caller is trusted for name != NULL.
*/
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
ffc0ade4: 7c 64 1b 79 mr. r4,r3
*/
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
ffc0ade8: 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;
ffc0adec: 40 82 00 10 bne- ffc0adfc <_Objects_Id_to_name+0x28>
ffc0adf0: 3d 20 00 00 lis r9,0
ffc0adf4: 81 29 31 50 lwz r9,12624(r9)
ffc0adf8: 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);
ffc0adfc: 54 89 47 7e rlwinm r9,r4,8,29,31
*/
RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid(
uint32_t the_api
)
{
if ( !the_api || the_api > OBJECTS_APIS_LAST )
ffc0ae00: 38 09 ff ff addi r0,r9,-1
ffc0ae04: 2b 80 00 02 cmplwi cr7,r0,2
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
ffc0ae08: 3b e0 00 03 li r31,3
ffc0ae0c: 41 9d 00 44 bgt- cr7,ffc0ae50 <_Objects_Id_to_name+0x7c>
ffc0ae10: 48 00 00 4c b ffc0ae5c <_Objects_Id_to_name+0x88>
if ( !_Objects_Information_table[ the_api ] )
return OBJECTS_INVALID_ID;
the_class = _Objects_Get_class( tmpId );
information = _Objects_Information_table[ the_api ][ the_class ];
ffc0ae14: 54 80 3e 7a rlwinm r0,r4,7,25,29
ffc0ae18: 7c 69 00 2e lwzx r3,r9,r0
if ( !information )
ffc0ae1c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0ae20: 41 9e 00 30 beq- cr7,ffc0ae50 <_Objects_Id_to_name+0x7c><== NEVER TAKEN
return OBJECTS_INVALID_ID;
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string )
ffc0ae24: 88 03 00 38 lbz r0,56(r3)
ffc0ae28: 2f 80 00 00 cmpwi cr7,r0,0
ffc0ae2c: 40 9e 00 24 bne- cr7,ffc0ae50 <_Objects_Id_to_name+0x7c><== NEVER TAKEN
return OBJECTS_INVALID_ID;
#endif
the_object = _Objects_Get( information, tmpId, &ignored_location );
ffc0ae30: 38 a1 00 08 addi r5,r1,8
ffc0ae34: 4b ff ff 25 bl ffc0ad58 <_Objects_Get>
if ( !the_object )
ffc0ae38: 2c 03 00 00 cmpwi r3,0
ffc0ae3c: 41 82 00 14 beq- ffc0ae50 <_Objects_Id_to_name+0x7c>
return OBJECTS_INVALID_ID;
*name = the_object->name;
ffc0ae40: 80 03 00 0c lwz r0,12(r3)
_Thread_Enable_dispatch();
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
ffc0ae44: 3b e0 00 00 li r31,0
the_object = _Objects_Get( information, tmpId, &ignored_location );
if ( !the_object )
return OBJECTS_INVALID_ID;
*name = the_object->name;
ffc0ae48: 90 1e 00 00 stw r0,0(r30)
_Thread_Enable_dispatch();
ffc0ae4c: 48 00 0c a9 bl ffc0baf4 <_Thread_Enable_dispatch>
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
}
ffc0ae50: 39 61 00 20 addi r11,r1,32
ffc0ae54: 7f e3 fb 78 mr r3,r31
ffc0ae58: 4b ff 68 40 b ffc01698 <_restgpr_30_x>
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
if ( !_Objects_Information_table[ the_api ] )
ffc0ae5c: 3d 60 00 00 lis r11,0
ffc0ae60: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc0ae64: 39 6b 2c 40 addi r11,r11,11328
ffc0ae68: 7d 2b 48 2e lwzx r9,r11,r9
ffc0ae6c: 2f 89 00 00 cmpwi cr7,r9,0
ffc0ae70: 40 9e ff a4 bne+ cr7,ffc0ae14 <_Objects_Id_to_name+0x40>
ffc0ae74: 4b ff ff dc b ffc0ae50 <_Objects_Id_to_name+0x7c>
ffc0a960 <_Objects_Shrink_information>:
*/
void _Objects_Shrink_information(
Objects_Information *information
)
{
ffc0a960: 94 21 ff e8 stwu r1,-24(r1)
ffc0a964: 7c 08 02 a6 mflr r0
index_base = _Objects_Get_index( information->minimum_id );
block_count = (information->maximum - index_base) /
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
ffc0a968: 39 20 00 00 li r9,0
*/
void _Objects_Shrink_information(
Objects_Information *information
)
{
ffc0a96c: 90 01 00 1c stw r0,28(r1)
ffc0a970: bf 81 00 08 stmw r28,8(r1)
ffc0a974: 7c 7f 1b 78 mr r31,r3
/*
* Search the list to find block or chunk with all objects inactive.
*/
index_base = _Objects_Get_index( information->minimum_id );
ffc0a978: a3 c3 00 0a lhz r30,10(r3)
block_count = (information->maximum - index_base) /
ffc0a97c: a1 43 00 10 lhz r10,16(r3)
ffc0a980: a1 63 00 14 lhz r11,20(r3)
ffc0a984: 7d 5e 50 50 subf r10,r30,r10
ffc0a988: 7d 4a 5b 96 divwu r10,r10,r11
ffc0a98c: 2f 8a 00 00 cmpwi cr7,r10,0
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
ffc0a990: 38 0a 00 01 addi r0,r10,1
ffc0a994: 40 be 00 90 bne+ cr7,ffc0aa24 <_Objects_Shrink_information+0xc4><== ALWAYS TAKEN
ffc0a998: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc0a99c: 48 00 00 88 b ffc0aa24 <_Objects_Shrink_information+0xc4><== NOT EXECUTED
if ( information->inactive_per_block[ block ] ==
ffc0a9a0: 81 5f 00 30 lwz r10,48(r31)
index_base = _Objects_Get_index( information->minimum_id );
block_count = (information->maximum - index_base) /
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
ffc0a9a4: 55 3d 10 3a rlwinm r29,r9,2,0,29
if ( information->inactive_per_block[ block ] ==
ffc0a9a8: 7d 4a e8 2e lwzx r10,r10,r29
ffc0a9ac: 7f 8a 58 00 cmpw cr7,r10,r11
ffc0a9b0: 40 be 00 6c bne+ cr7,ffc0aa1c <_Objects_Shrink_information+0xbc>
information->allocation_size ) {
/*
* Assume the Inactive chain is never empty at this point
*/
the_object = (Objects_Control *) _Chain_First( &information->Inactive );
ffc0a9b4: 80 7f 00 20 lwz r3,32(r31)
ffc0a9b8: 48 00 00 08 b ffc0a9c0 <_Objects_Shrink_information+0x60>
index = _Objects_Get_index( the_object->id );
/*
* Get the next node before the node is extracted
*/
extract_me = the_object;
the_object = (Objects_Control *) the_object->Node.next;
ffc0a9bc: 7f 83 e3 78 mr r3,r28
* Assume the Inactive chain is never empty at this point
*/
the_object = (Objects_Control *) _Chain_First( &information->Inactive );
do {
index = _Objects_Get_index( the_object->id );
ffc0a9c0: a0 03 00 0a lhz r0,10(r3)
/*
* Get the next node before the node is extracted
*/
extract_me = the_object;
the_object = (Objects_Control *) the_object->Node.next;
ffc0a9c4: 83 83 00 00 lwz r28,0(r3)
if ((index >= index_base) &&
ffc0a9c8: 7f 80 f0 40 cmplw cr7,r0,r30
ffc0a9cc: 41 9c 00 18 blt- cr7,ffc0a9e4 <_Objects_Shrink_information+0x84>
(index < (index_base + information->allocation_size))) {
ffc0a9d0: a1 3f 00 14 lhz r9,20(r31)
ffc0a9d4: 7d 3e 4a 14 add r9,r30,r9
/*
* Get the next node before the node is extracted
*/
extract_me = the_object;
the_object = (Objects_Control *) the_object->Node.next;
if ((index >= index_base) &&
ffc0a9d8: 7f 80 48 40 cmplw cr7,r0,r9
ffc0a9dc: 40 bc 00 08 bge+ cr7,ffc0a9e4 <_Objects_Shrink_information+0x84>
(index < (index_base + information->allocation_size))) {
_Chain_Extract( &extract_me->Node );
ffc0a9e0: 4b ff ee 91 bl ffc09870 <_Chain_Extract>
}
}
while ( the_object );
ffc0a9e4: 2f 9c 00 00 cmpwi cr7,r28,0
ffc0a9e8: 40 9e ff d4 bne+ cr7,ffc0a9bc <_Objects_Shrink_information+0x5c>
/*
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
ffc0a9ec: 81 3f 00 34 lwz r9,52(r31)
ffc0a9f0: 7c 69 e8 2e lwzx r3,r9,r29
ffc0a9f4: 48 00 1d cd bl ffc0c7c0 <_Workspace_Free>
information->object_blocks[ block ] = NULL;
ffc0a9f8: 81 3f 00 34 lwz r9,52(r31)
information->inactive_per_block[ block ] = 0;
information->inactive -= information->allocation_size;
ffc0a9fc: a0 1f 00 14 lhz r0,20(r31)
/*
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
information->object_blocks[ block ] = NULL;
ffc0aa00: 7f 89 e9 2e stwx r28,r9,r29
information->inactive_per_block[ block ] = 0;
ffc0aa04: 81 3f 00 30 lwz r9,48(r31)
ffc0aa08: 7f 89 e9 2e stwx r28,r9,r29
information->inactive -= information->allocation_size;
ffc0aa0c: a1 3f 00 2c lhz r9,44(r31)
ffc0aa10: 7c 00 48 50 subf r0,r0,r9
ffc0aa14: b0 1f 00 2c sth r0,44(r31)
return;
ffc0aa18: 48 00 00 14 b ffc0aa2c <_Objects_Shrink_information+0xcc>
}
index_base += information->allocation_size;
ffc0aa1c: 7f de 5a 14 add r30,r30,r11
index_base = _Objects_Get_index( information->minimum_id );
block_count = (information->maximum - index_base) /
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
ffc0aa20: 39 29 00 01 addi r9,r9,1
ffc0aa24: 34 00 ff ff addic. r0,r0,-1
ffc0aa28: 40 82 ff 78 bne+ ffc0a9a0 <_Objects_Shrink_information+0x40>
return;
}
index_base += information->allocation_size;
}
}
ffc0aa2c: 39 61 00 18 addi r11,r1,24
ffc0aa30: 48 00 e8 2c b ffc1925c <_restgpr_28_x>
ffc0a358 <_POSIX_Absolute_timeout_to_ticks>:
*/
POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks(
const struct timespec *abstime,
Watchdog_Interval *ticks_out
)
{
ffc0a358: 94 21 ff d8 stwu r1,-40(r1)
ffc0a35c: 7c 08 02 a6 mflr r0
ffc0a360: 90 01 00 2c stw r0,44(r1)
/*
* Make sure there is always a value returned.
*/
*ticks_out = 0;
ffc0a364: 38 00 00 00 li r0,0
*/
POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks(
const struct timespec *abstime,
Watchdog_Interval *ticks_out
)
{
ffc0a368: bf 81 00 18 stmw r28,24(r1)
ffc0a36c: 7c 7c 1b 78 mr r28,r3
ffc0a370: 7c 9f 23 78 mr r31,r4
/*
* Make sure there is always a value returned.
*/
*ticks_out = 0;
ffc0a374: 90 04 00 00 stw r0,0(r4)
/*
* Is the absolute time even valid?
*/
if ( !_Timespec_Is_valid(abstime) )
ffc0a378: 48 00 45 65 bl ffc0e8dc <_Timespec_Is_valid>
return POSIX_ABSOLUTE_TIMEOUT_INVALID;
ffc0a37c: 38 00 00 00 li r0,0
*ticks_out = 0;
/*
* Is the absolute time even valid?
*/
if ( !_Timespec_Is_valid(abstime) )
ffc0a380: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a384: 41 be 00 58 beq+ cr7,ffc0a3dc <_POSIX_Absolute_timeout_to_ticks+0x84>
return POSIX_ABSOLUTE_TIMEOUT_INVALID;
/*
* Is the absolute time in the past?
*/
_TOD_Get( ¤t_time );
ffc0a388: 3b a1 00 08 addi r29,r1,8
ffc0a38c: 7f a3 eb 78 mr r3,r29
ffc0a390: 48 00 1f 9d bl ffc0c32c <_TOD_Get>
if ( _Timespec_Less_than( abstime, ¤t_time ) )
ffc0a394: 7f 83 e3 78 mr r3,r28
ffc0a398: 7f a4 eb 78 mr r4,r29
ffc0a39c: 48 00 45 81 bl ffc0e91c <_Timespec_Less_than>
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST;
ffc0a3a0: 38 00 00 01 li r0,1
/*
* Is the absolute time in the past?
*/
_TOD_Get( ¤t_time );
if ( _Timespec_Less_than( abstime, ¤t_time ) )
ffc0a3a4: 2f 83 00 00 cmpwi cr7,r3,0
ffc0a3a8: 40 9e 00 34 bne- cr7,ffc0a3dc <_POSIX_Absolute_timeout_to_ticks+0x84>
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST;
/*
* How long until the requested absolute time?
*/
_Timespec_Subtract( ¤t_time, abstime, &difference );
ffc0a3ac: 3b c1 00 10 addi r30,r1,16
ffc0a3b0: 7f a3 eb 78 mr r3,r29
ffc0a3b4: 7f 84 e3 78 mr r4,r28
ffc0a3b8: 7f c5 f3 78 mr r5,r30
ffc0a3bc: 48 00 45 9d bl ffc0e958 <_Timespec_Subtract>
/*
* Internally the SuperCore uses ticks, so convert to them.
*/
*ticks_out = _Timespec_To_ticks( &difference );
ffc0a3c0: 7f c3 f3 78 mr r3,r30
ffc0a3c4: 48 00 45 d9 bl ffc0e99c <_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;
ffc0a3c8: 38 00 00 03 li r0,3
/*
* If the difference was 0, then the future is now. It is so bright
* we better wear shades.
*/
if ( !*ticks_out )
ffc0a3cc: 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 );
ffc0a3d0: 90 7f 00 00 stw r3,0(r31)
/*
* If the difference was 0, then the future is now. It is so bright
* we better wear shades.
*/
if ( !*ticks_out )
ffc0a3d4: 40 be 00 08 bne+ cr7,ffc0a3dc <_POSIX_Absolute_timeout_to_ticks+0x84><== ALWAYS TAKEN
return POSIX_ABSOLUTE_TIMEOUT_IS_NOW;
ffc0a3d8: 38 00 00 02 li r0,2 <== NOT EXECUTED
/*
* This is the case we were expecting and it took this long to
* get here.
*/
return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE;
}
ffc0a3dc: 39 61 00 28 addi r11,r1,40
ffc0a3e0: 7c 03 03 78 mr r3,r0
ffc0a3e4: 4b ff 87 9c b ffc02b80 <_restgpr_28_x>
ffc0ce08 <_POSIX_Message_queue_Receive_support>:
size_t msg_len,
unsigned int *msg_prio,
bool wait,
Watchdog_Interval timeout
)
{
ffc0ce08: 94 21 ff c8 stwu r1,-56(r1)
ffc0ce0c: 7c 08 02 a6 mflr r0
ffc0ce10: bf 61 00 24 stmw r27,36(r1)
ffc0ce14: 7c 7f 1b 78 mr r31,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(
ffc0ce18: 3c 60 00 00 lis r3,0
ffc0ce1c: 7c 9d 23 78 mr r29,r4
ffc0ce20: 90 01 00 3c stw r0,60(r1)
ffc0ce24: 7c bc 2b 78 mr r28,r5
ffc0ce28: 38 63 35 f8 addi r3,r3,13816
ffc0ce2c: 91 01 00 18 stw r8,24(r1)
ffc0ce30: 7f e4 fb 78 mr r4,r31
ffc0ce34: 38 a1 00 08 addi r5,r1,8
ffc0ce38: 7c de 33 78 mr r30,r6
ffc0ce3c: 7c fb 3b 78 mr r27,r7
ffc0ce40: 48 00 35 2d bl ffc1036c <_Objects_Get>
Objects_Locations location;
size_t length_out;
bool do_wait;
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
ffc0ce44: 80 01 00 08 lwz r0,8(r1)
ffc0ce48: 81 01 00 18 lwz r8,24(r1)
ffc0ce4c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0ce50: 40 9e 00 c8 bne- cr7,ffc0cf18 <_POSIX_Message_queue_Receive_support+0x110>
case OBJECTS_LOCAL:
if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) {
ffc0ce54: 81 23 00 14 lwz r9,20(r3)
ffc0ce58: 55 20 07 be clrlwi r0,r9,30
ffc0ce5c: 2f 80 00 01 cmpwi cr7,r0,1
ffc0ce60: 40 be 00 0c bne+ cr7,ffc0ce6c <_POSIX_Message_queue_Receive_support+0x64>
_Thread_Enable_dispatch();
ffc0ce64: 48 00 42 9d bl ffc11100 <_Thread_Enable_dispatch>
ffc0ce68: 48 00 00 b0 b ffc0cf18 <_POSIX_Message_queue_Receive_support+0x110>
rtems_set_errno_and_return_minus_one( EBADF );
}
the_mq = the_mq_fd->Queue;
ffc0ce6c: 80 63 00 10 lwz r3,16(r3)
if ( msg_len < the_mq->Message_queue.maximum_message_size ) {
ffc0ce70: 80 03 00 68 lwz r0,104(r3)
ffc0ce74: 7f 9c 00 40 cmplw cr7,r28,r0
ffc0ce78: 40 bc 00 14 bge+ cr7,ffc0ce8c <_POSIX_Message_queue_Receive_support+0x84>
_Thread_Enable_dispatch();
ffc0ce7c: 48 00 42 85 bl ffc11100 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EMSGSIZE );
ffc0ce80: 48 00 ad 39 bl ffc17bb8 <__errno>
ffc0ce84: 38 00 00 7a li r0,122
ffc0ce88: 48 00 00 98 b ffc0cf20 <_POSIX_Message_queue_Receive_support+0x118>
length_out = -1;
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
ffc0ce8c: 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;
ffc0ce90: 38 00 ff ff li r0,-1
ffc0ce94: 90 01 00 0c stw r0,12(r1)
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
ffc0ce98: 38 00 00 00 li r0,0
ffc0ce9c: 41 9e 00 10 beq- cr7,ffc0ceac <_POSIX_Message_queue_Receive_support+0xa4><== NEVER TAKEN
do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true;
ffc0cea0: 71 20 40 00 andi. r0,r9,16384
ffc0cea4: 7c 00 00 26 mfcr r0
ffc0cea8: 54 00 1f fe rlwinm r0,r0,3,31,31
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
ffc0ceac: 7f e4 fb 78 mr r4,r31
timeout
);
_Thread_Enable_dispatch();
*msg_prio =
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
ffc0ceb0: 3f e0 00 00 lis r31,0
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
ffc0ceb4: 7c 07 03 78 mr r7,r0
ffc0ceb8: 38 63 00 1c addi r3,r3,28
ffc0cebc: 7f a5 eb 78 mr r5,r29
ffc0cec0: 38 c1 00 0c addi r6,r1,12
timeout
);
_Thread_Enable_dispatch();
*msg_prio =
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
ffc0cec4: 3b ff 36 64 addi r31,r31,13924
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
ffc0cec8: 48 00 23 29 bl ffc0f1f0 <_CORE_message_queue_Seize>
&length_out,
do_wait,
timeout
);
_Thread_Enable_dispatch();
ffc0cecc: 48 00 42 35 bl ffc11100 <_Thread_Enable_dispatch>
*msg_prio =
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
ffc0ced0: 81 3f 00 0c lwz r9,12(r31)
RTEMS_INLINE_ROUTINE unsigned int _POSIX_Message_queue_Priority_from_core(
CORE_message_queue_Submit_types priority
)
{
/* absolute value without a library dependency */
return ((priority >= 0) ? priority : -priority);
ffc0ced4: 80 09 00 24 lwz r0,36(r9)
ffc0ced8: 7c 0b fe 70 srawi r11,r0,31
ffc0cedc: 7d 60 02 78 xor r0,r11,r0
ffc0cee0: 7c 0b 00 50 subf r0,r11,r0
do_wait,
timeout
);
_Thread_Enable_dispatch();
*msg_prio =
ffc0cee4: 90 1e 00 00 stw r0,0(r30)
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
if ( !_Thread_Executing->Wait.return_code )
ffc0cee8: 80 09 00 34 lwz r0,52(r9)
ffc0ceec: 2f 80 00 00 cmpwi cr7,r0,0
ffc0cef0: 40 9e 00 0c bne- cr7,ffc0cefc <_POSIX_Message_queue_Receive_support+0xf4>
return length_out;
ffc0cef4: 80 61 00 0c lwz r3,12(r1)
ffc0cef8: 48 00 00 30 b ffc0cf28 <_POSIX_Message_queue_Receive_support+0x120>
rtems_set_errno_and_return_minus_one(
ffc0cefc: 48 00 ac bd bl ffc17bb8 <__errno>
ffc0cf00: 81 3f 00 0c lwz r9,12(r31)
ffc0cf04: 7c 7e 1b 78 mr r30,r3
ffc0cf08: 80 69 00 34 lwz r3,52(r9)
ffc0cf0c: 48 00 02 a5 bl ffc0d1b0 <_POSIX_Message_queue_Translate_core_message_queue_return_code>
ffc0cf10: 90 7e 00 00 stw r3,0(r30)
ffc0cf14: 48 00 00 10 b ffc0cf24 <_POSIX_Message_queue_Receive_support+0x11c>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EBADF );
ffc0cf18: 48 00 ac a1 bl ffc17bb8 <__errno>
ffc0cf1c: 38 00 00 09 li r0,9
ffc0cf20: 90 03 00 00 stw r0,0(r3)
ffc0cf24: 38 60 ff ff li r3,-1
}
ffc0cf28: 39 61 00 38 addi r11,r1,56
ffc0cf2c: 4b ff 89 b4 b ffc058e0 <_restgpr_27_x>
ffc0d258 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>:
#include <rtems/posix/pthread.h>
void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(
Thread_Control *the_thread
)
{
ffc0d258: 7c 08 02 a6 mflr r0
ffc0d25c: 94 21 ff f8 stwu r1,-8(r1)
ffc0d260: 90 01 00 0c stw r0,12(r1)
POSIX_API_Control *thread_support;
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0d264: 81 23 01 34 lwz r9,308(r3)
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
ffc0d268: 80 09 00 d8 lwz r0,216(r9)
ffc0d26c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0d270: 40 9e 00 38 bne- cr7,ffc0d2a8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x50><== NEVER TAKEN
ffc0d274: 80 09 00 dc lwz r0,220(r9)
ffc0d278: 2f 80 00 01 cmpwi cr7,r0,1
ffc0d27c: 40 be 00 2c bne+ cr7,ffc0d2a8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x50>
thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS &&
ffc0d280: 80 09 00 e0 lwz r0,224(r9)
ffc0d284: 2f 80 00 00 cmpwi cr7,r0,0
ffc0d288: 41 be 00 20 beq+ cr7,ffc0d2a8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x50>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc0d28c: 3d 20 00 00 lis r9,0
ffc0d290: 81 69 27 b8 lwz r11,10168(r9)
thread_support->cancelation_requested ) {
_Thread_Unnest_dispatch();
_POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED );
ffc0d294: 38 80 ff ff li r4,-1
ffc0d298: 38 0b ff ff addi r0,r11,-1
ffc0d29c: 90 09 27 b8 stw r0,10168(r9)
ffc0d2a0: 48 00 08 45 bl ffc0dae4 <_POSIX_Thread_Exit>
ffc0d2a4: 48 00 00 08 b ffc0d2ac <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54>
} else
_Thread_Enable_dispatch();
ffc0d2a8: 4b ff d3 ed bl ffc0a694 <_Thread_Enable_dispatch>
}
ffc0d2ac: 80 01 00 0c lwz r0,12(r1)
ffc0d2b0: 38 21 00 08 addi r1,r1,8
ffc0d2b4: 7c 08 03 a6 mtlr r0
ffc0d2b8: 4e 80 00 20 blr
ffc0e850 <_POSIX_Thread_Translate_sched_param>:
int policy,
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
ffc0e850: 94 21 ff e0 stwu r1,-32(r1)
ffc0e854: 7c 08 02 a6 mflr r0
ffc0e858: bf 61 00 0c stmw r27,12(r1)
ffc0e85c: 7c 7f 1b 78 mr r31,r3
ffc0e860: 7c 9e 23 78 mr r30,r4
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
ffc0e864: 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
)
{
ffc0e868: 7c bd 2b 78 mr r29,r5
ffc0e86c: 90 01 00 24 stw r0,36(r1)
ffc0e870: 7c db 33 78 mr r27,r6
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
ffc0e874: 4b ff ff b5 bl ffc0e828 <_POSIX_Priority_Is_valid>
return EINVAL;
ffc0e878: 3b 80 00 16 li r28,22
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
ffc0e87c: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e880: 41 9e 00 c8 beq- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8><== NEVER TAKEN
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
*budget_callout = NULL;
if ( policy == SCHED_OTHER ) {
ffc0e884: 2f 9f 00 00 cmpwi cr7,r31,0
)
{
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
ffc0e888: 38 00 00 00 li r0,0
ffc0e88c: 90 1d 00 00 stw r0,0(r29)
*budget_callout = NULL;
ffc0e890: 90 1b 00 00 stw r0,0(r27)
if ( policy == SCHED_OTHER ) {
ffc0e894: 40 be 00 10 bne+ cr7,ffc0e8a4 <_POSIX_Thread_Translate_sched_param+0x54>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
ffc0e898: 38 00 00 01 li r0,1
ffc0e89c: 90 1d 00 00 stw r0,0(r29)
ffc0e8a0: 48 00 00 a4 b ffc0e944 <_POSIX_Thread_Translate_sched_param+0xf4>
return 0;
}
if ( policy == SCHED_FIFO ) {
ffc0e8a4: 2f 9f 00 01 cmpwi cr7,r31,1
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
return 0;
ffc0e8a8: 3b 80 00 00 li r28,0
if ( policy == SCHED_OTHER ) {
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
return 0;
}
if ( policy == SCHED_FIFO ) {
ffc0e8ac: 41 9e 00 9c beq- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
return 0;
}
if ( policy == SCHED_RR ) {
ffc0e8b0: 2f 9f 00 02 cmpwi cr7,r31,2
ffc0e8b4: 40 be 00 0c bne+ cr7,ffc0e8c0 <_POSIX_Thread_Translate_sched_param+0x70>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE;
ffc0e8b8: 93 fd 00 00 stw r31,0(r29)
return 0;
ffc0e8bc: 48 00 00 8c b ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
}
if ( policy == SCHED_SPORADIC ) {
ffc0e8c0: 2f 9f 00 04 cmpwi cr7,r31,4
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
return 0;
}
return EINVAL;
ffc0e8c4: 3b 80 00 16 li r28,22
if ( policy == SCHED_RR ) {
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE;
return 0;
}
if ( policy == SCHED_SPORADIC ) {
ffc0e8c8: 40 be 00 80 bne+ cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
if ( (param->sched_ss_repl_period.tv_sec == 0) &&
ffc0e8cc: 80 1e 00 08 lwz r0,8(r30)
ffc0e8d0: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e8d4: 40 9e 00 10 bne- cr7,ffc0e8e4 <_POSIX_Thread_Translate_sched_param+0x94>
ffc0e8d8: 80 1e 00 0c lwz r0,12(r30)
ffc0e8dc: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e8e0: 41 9e 00 68 beq- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
(param->sched_ss_repl_period.tv_nsec == 0) )
return EINVAL;
if ( (param->sched_ss_init_budget.tv_sec == 0) &&
ffc0e8e4: 80 1e 00 10 lwz r0,16(r30)
ffc0e8e8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e8ec: 40 9e 00 14 bne- cr7,ffc0e900 <_POSIX_Thread_Translate_sched_param+0xb0>
ffc0e8f0: 80 1e 00 14 lwz r0,20(r30)
(param->sched_ss_init_budget.tv_nsec == 0) )
return EINVAL;
ffc0e8f4: 3b 80 00 16 li r28,22
if ( policy == SCHED_SPORADIC ) {
if ( (param->sched_ss_repl_period.tv_sec == 0) &&
(param->sched_ss_repl_period.tv_nsec == 0) )
return EINVAL;
if ( (param->sched_ss_init_budget.tv_sec == 0) &&
ffc0e8f8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0e8fc: 41 9e 00 4c beq- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
(param->sched_ss_init_budget.tv_nsec == 0) )
return EINVAL;
if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) <
ffc0e900: 38 7e 00 08 addi r3,r30,8
ffc0e904: 4b ff da 3d bl ffc0c340 <_Timespec_To_ticks>
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
return EINVAL;
ffc0e908: 3b 80 00 16 li r28,22
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 ) <
ffc0e90c: 7c 7f 1b 78 mr r31,r3
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
ffc0e910: 38 7e 00 10 addi r3,r30,16
ffc0e914: 4b ff da 2d bl ffc0c340 <_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 ) <
ffc0e918: 7f 9f 18 40 cmplw cr7,r31,r3
ffc0e91c: 41 9c 00 2c blt- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
return EINVAL;
if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) )
ffc0e920: 80 7e 00 04 lwz r3,4(r30)
ffc0e924: 4b ff ff 05 bl ffc0e828 <_POSIX_Priority_Is_valid>
ffc0e928: 2f 83 00 00 cmpwi cr7,r3,0
ffc0e92c: 41 9e 00 1c beq- cr7,ffc0e948 <_POSIX_Thread_Translate_sched_param+0xf8>
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
ffc0e930: 38 00 00 03 li r0,3
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
ffc0e934: 3d 20 ff c1 lis r9,-63
return EINVAL;
if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) )
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
ffc0e938: 90 1d 00 00 stw r0,0(r29)
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
ffc0e93c: 38 09 82 d4 addi r0,r9,-32044
ffc0e940: 90 1b 00 00 stw r0,0(r27)
return 0;
ffc0e944: 3b 80 00 00 li r28,0
}
return EINVAL;
}
ffc0e948: 39 61 00 20 addi r11,r1,32
ffc0e94c: 7f 83 e3 78 mr r3,r28
ffc0e950: 4b ff 22 84 b ffc00bd4 <_restgpr_27_x>
ffc07fb8 <_POSIX_Threads_Initialize_user_threads_body>:
*
* Output parameters: NONE
*/
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc07fb8: 94 21 ff 90 stwu r1,-112(r1)
ffc07fbc: 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;
ffc07fc0: 3d 20 00 00 lis r9,0
*
* Output parameters: NONE
*/
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc07fc4: 90 01 00 74 stw r0,116(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;
ffc07fc8: 39 29 20 84 addi r9,r9,8324
*
* Output parameters: NONE
*/
void _POSIX_Threads_Initialize_user_threads_body(void)
{
ffc07fcc: bf 61 00 5c stmw r27,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;
ffc07fd0: 83 c9 00 34 lwz r30,52(r9)
maximum = Configuration_POSIX_API.number_of_initialization_threads;
ffc07fd4: 83 89 00 30 lwz r28,48(r9)
if ( !user_threads || maximum == 0 )
ffc07fd8: 2f 9e 00 00 cmpwi cr7,r30,0
ffc07fdc: 41 9e 00 70 beq- cr7,ffc0804c <_POSIX_Threads_Initialize_user_threads_body+0x94><== NEVER TAKEN
ffc07fe0: 2f 9c 00 00 cmpwi cr7,r28,0
ffc07fe4: 41 9e 00 68 beq- cr7,ffc0804c <_POSIX_Threads_Initialize_user_threads_body+0x94><== NEVER TAKEN
ffc07fe8: 3b a0 00 00 li r29,0
for ( index=0 ; index < maximum ; index++ ) {
/*
* There is no way for these calls to fail in this situation.
*/
(void) pthread_attr_init( &attr );
ffc07fec: 3b e1 00 0c addi r31,r1,12
(void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED );
(void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size);
status = pthread_create(
ffc07ff0: 3b 61 00 08 addi r27,r1,8
for ( index=0 ; index < maximum ; index++ ) {
/*
* There is no way for these calls to fail in this situation.
*/
(void) pthread_attr_init( &attr );
ffc07ff4: 7f e3 fb 78 mr r3,r31
ffc07ff8: 48 00 69 5d bl ffc0e954 <pthread_attr_init>
(void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED );
ffc07ffc: 38 80 00 02 li r4,2
ffc08000: 7f e3 fb 78 mr r3,r31
ffc08004: 48 00 69 91 bl ffc0e994 <pthread_attr_setinheritsched>
(void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size);
ffc08008: 80 9e 00 04 lwz r4,4(r30)
ffc0800c: 7f e3 fb 78 mr r3,r31
ffc08010: 48 00 69 bd bl ffc0e9cc <pthread_attr_setstacksize>
status = pthread_create(
ffc08014: 80 be 00 00 lwz r5,0(r30)
ffc08018: 7f 63 db 78 mr r3,r27
ffc0801c: 7f e4 fb 78 mr r4,r31
ffc08020: 38 c0 00 00 li r6,0
ffc08024: 4b ff fc c9 bl ffc07cec <pthread_create>
&thread_id,
&attr,
user_threads[ index ].thread_entry,
NULL
);
if ( status )
ffc08028: 7c 65 1b 79 mr. r5,r3
ffc0802c: 41 a2 00 10 beq+ ffc0803c <_POSIX_Threads_Initialize_user_threads_body+0x84>
_Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status );
ffc08030: 38 60 00 02 li r3,2
ffc08034: 38 80 00 01 li r4,1
ffc08038: 48 00 22 95 bl ffc0a2cc <_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++ ) {
ffc0803c: 3b bd 00 01 addi r29,r29,1
ffc08040: 7f 9d e0 40 cmplw cr7,r29,r28
ffc08044: 3b de 00 08 addi r30,r30,8
ffc08048: 41 9c ff ac blt+ cr7,ffc07ff4 <_POSIX_Threads_Initialize_user_threads_body+0x3c><== NEVER TAKEN
NULL
);
if ( status )
_Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status );
}
}
ffc0804c: 39 61 00 70 addi r11,r1,112
ffc08050: 4b ff 8b 84 b ffc00bd4 <_restgpr_27_x>
ffc11340 <_POSIX_Threads_Sporadic_budget_TSR>:
*/
void _POSIX_Threads_Sporadic_budget_TSR(
Objects_Id id __attribute__((unused)),
void *argument
)
{
ffc11340: 94 21 ff f0 stwu r1,-16(r1)
ffc11344: 7c 08 02 a6 mflr r0
ffc11348: 90 01 00 14 stw r0,20(r1)
ffc1134c: bf c1 00 08 stmw r30,8(r1)
ffc11350: 7c 9e 23 78 mr r30,r4
Thread_Control *the_thread;
POSIX_API_Control *api;
the_thread = argument;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc11354: 83 e4 01 34 lwz r31,308(r4)
/* ticks is guaranteed to be at least one */
ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget );
ffc11358: 38 7f 00 98 addi r3,r31,152
ffc1135c: 48 00 15 e5 bl ffc12940 <_Timespec_To_ticks>
RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core(
int priority
)
{
return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1);
ffc11360: 3d 20 00 00 lis r9,0
ffc11364: 80 1f 00 88 lwz r0,136(r31)
ffc11368: 88 89 26 cc lbz r4,9932(r9)
the_thread->cpu_time_budget = ticks;
ffc1136c: 90 7e 00 78 stw r3,120(r30)
ffc11370: 7c 80 20 50 subf r4,r0,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 ) {
ffc11374: 80 1e 00 1c lwz r0,28(r30)
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;
ffc11378: 90 9e 00 18 stw r4,24(r30)
*/
#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 ) {
ffc1137c: 2f 80 00 00 cmpwi cr7,r0,0
ffc11380: 40 9e 00 1c bne- cr7,ffc1139c <_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 ) {
ffc11384: 80 1e 00 14 lwz r0,20(r30)
ffc11388: 7f 80 20 40 cmplw cr7,r0,r4
ffc1138c: 40 bd 00 10 ble+ cr7,ffc1139c <_POSIX_Threads_Sporadic_budget_TSR+0x5c>
_Thread_Change_priority( the_thread, new_priority, true );
ffc11390: 7f c3 f3 78 mr r3,r30
ffc11394: 38 a0 00 01 li r5,1
ffc11398: 4b ff 9b c1 bl ffc0af58 <_Thread_Change_priority>
#endif
}
}
/* ticks is guaranteed to be at least one */
ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period );
ffc1139c: 38 7f 00 90 addi r3,r31,144
ffc113a0: 48 00 15 a1 bl ffc12940 <_Timespec_To_ticks>
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc113a4: 38 9f 00 a8 addi r4,r31,168
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc113a8: 90 7f 00 b4 stw r3,180(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc113ac: 3c 60 00 00 lis r3,0
ffc113b0: 38 63 2d a8 addi r3,r3,11688
ffc113b4: 4b ff b1 6d bl ffc0c520 <_Watchdog_Insert>
_Watchdog_Insert_ticks( &api->Sporadic_timer, ticks );
}
ffc113b8: 39 61 00 10 addi r11,r1,16
ffc113bc: 48 00 7e a8 b ffc19264 <_restgpr_30_x>
ffc113c0 <_POSIX_Threads_Sporadic_budget_callout>:
* _POSIX_Threads_Sporadic_budget_callout
*/
void _POSIX_Threads_Sporadic_budget_callout(
Thread_Control *the_thread
)
{
ffc113c0: 7c 08 02 a6 mflr r0
ffc113c4: 94 21 ff f8 stwu r1,-8(r1)
ffc113c8: 3d 40 00 00 lis r10,0
ffc113cc: 90 01 00 0c stw r0,12(r1)
/*
* This will prevent the thread from consuming its entire "budget"
* while at low priority.
*/
the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */
ffc113d0: 38 00 ff ff li r0,-1
)
{
POSIX_API_Control *api;
uint32_t new_priority;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc113d4: 81 63 01 34 lwz r11,308(r3)
/*
* This will prevent the thread from consuming its entire "budget"
* while at low priority.
*/
the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */
ffc113d8: 90 03 00 78 stw r0,120(r3)
ffc113dc: 88 8a 26 cc lbz r4,9932(r10)
ffc113e0: 80 0b 00 8c lwz r0,140(r11)
ffc113e4: 7c 80 20 50 subf r4,r0,r4
*/
#if 0
printk( "callout %d %d %d\n", the_thread->resource_count,
the_thread->current_priority, new_priority );
#endif
if ( the_thread->resource_count == 0 ) {
ffc113e8: 80 03 00 1c lwz r0,28(r3)
* while at low priority.
*/
the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */
new_priority = _POSIX_Priority_To_core(api->schedparam.sched_ss_low_priority);
the_thread->real_priority = new_priority;
ffc113ec: 90 83 00 18 stw r4,24(r3)
*/
#if 0
printk( "callout %d %d %d\n", the_thread->resource_count,
the_thread->current_priority, new_priority );
#endif
if ( the_thread->resource_count == 0 ) {
ffc113f0: 2f 80 00 00 cmpwi cr7,r0,0
ffc113f4: 40 9e 00 18 bne- cr7,ffc1140c <_POSIX_Threads_Sporadic_budget_callout+0x4c><== NEVER TAKEN
/*
* Make sure we are actually lowering it. If they have lowered it
* to logically lower than sched_ss_low_priority, then we do not want to
* change it.
*/
if ( the_thread->current_priority < new_priority ) {
ffc113f8: 80 03 00 14 lwz r0,20(r3)
ffc113fc: 7f 80 20 40 cmplw cr7,r0,r4
ffc11400: 40 bc 00 0c bge+ cr7,ffc1140c <_POSIX_Threads_Sporadic_budget_callout+0x4c><== NEVER TAKEN
_Thread_Change_priority( the_thread, new_priority, true );
ffc11404: 38 a0 00 01 li r5,1
ffc11408: 4b ff 9b 51 bl ffc0af58 <_Thread_Change_priority>
#if 0
printk( "lower priority\n" );
#endif
}
}
}
ffc1140c: 80 01 00 0c lwz r0,12(r1)
ffc11410: 38 21 00 08 addi r1,r1,8
ffc11414: 7c 08 03 a6 mtlr r0
ffc11418: 4e 80 00 20 blr
ffc07cd8 <_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)
{
ffc07cd8: 7c 08 02 a6 mflr r0
ffc07cdc: 7c 2b 0b 78 mr r11,r1
ffc07ce0: 94 21 ff f0 stwu r1,-16(r1)
ffc07ce4: 90 01 00 14 stw r0,20(r1)
ffc07ce8: 48 01 3d 91 bl ffc1ba78 <_savegpr_31>
ffc07cec: 7c 9f 23 78 mr r31,r4
bool activated;
ptimer = (POSIX_Timer_Control *)data;
/* Increment the number of expirations. */
ptimer->overrun = ptimer->overrun + 1;
ffc07cf0: 81 24 00 68 lwz r9,104(r4)
ffc07cf4: 38 09 00 01 addi r0,r9,1
ffc07cf8: 90 04 00 68 stw r0,104(r4)
/* The timer must be reprogrammed */
if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) ||
ffc07cfc: 80 04 00 54 lwz r0,84(r4)
ffc07d00: 2f 80 00 00 cmpwi cr7,r0,0
ffc07d04: 40 9e 00 10 bne- cr7,ffc07d14 <_POSIX_Timer_TSR+0x3c>
ffc07d08: 80 04 00 58 lwz r0,88(r4)
ffc07d0c: 2f 80 00 00 cmpwi cr7,r0,0
ffc07d10: 41 9e 00 38 beq- cr7,ffc07d48 <_POSIX_Timer_TSR+0x70> <== NEVER TAKEN
( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) {
activated = _POSIX_Timer_Insert_helper(
ffc07d14: 80 9f 00 64 lwz r4,100(r31)
ffc07d18: 3c c0 ff c0 lis r6,-64
ffc07d1c: 80 bf 00 08 lwz r5,8(r31)
ffc07d20: 38 7f 00 10 addi r3,r31,16
ffc07d24: 38 c6 7c d8 addi r6,r6,31960
ffc07d28: 7f e7 fb 78 mr r7,r31
ffc07d2c: 48 00 68 01 bl ffc0e52c <_POSIX_Timer_Insert_helper>
ptimer->ticks,
ptimer->Object.id,
_POSIX_Timer_TSR,
ptimer
);
if ( !activated )
ffc07d30: 2f 83 00 00 cmpwi cr7,r3,0
ffc07d34: 41 be 00 30 beq+ cr7,ffc07d64 <_POSIX_Timer_TSR+0x8c> <== NEVER TAKEN
return;
/* Store the time when the timer was started again */
_TOD_Get( &ptimer->time );
ffc07d38: 38 7f 00 6c addi r3,r31,108
ffc07d3c: 48 00 19 01 bl ffc0963c <_TOD_Get>
/* The state really did not change but just to be safe */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
ffc07d40: 38 00 00 03 li r0,3
ffc07d44: 48 00 00 08 b ffc07d4c <_POSIX_Timer_TSR+0x74>
} else {
/* Indicates that the timer is stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
ffc07d48: 38 00 00 04 li r0,4
ffc07d4c: 98 1f 00 3c stb r0,60(r31)
/*
* 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 ) ) {
ffc07d50: 80 7f 00 38 lwz r3,56(r31)
ffc07d54: 80 9f 00 44 lwz r4,68(r31)
ffc07d58: 48 00 62 f1 bl ffc0e048 <pthread_kill>
}
/* After the signal handler returns, the count of expirations of the
* timer must be set to 0.
*/
ptimer->overrun = 0;
ffc07d5c: 38 00 00 00 li r0,0
ffc07d60: 90 1f 00 68 stw r0,104(r31)
}
ffc07d64: 39 61 00 10 addi r11,r1,16
ffc07d68: 4b ff 88 bc b ffc00624 <_restgpr_31_x>
ffc13e00 <_POSIX_signals_Check_signal>:
bool _POSIX_signals_Check_signal(
POSIX_API_Control *api,
int signo,
bool is_global
)
{
ffc13e00: 94 21 ff 98 stwu r1,-104(r1)
ffc13e04: 7c 08 02 a6 mflr r0
ffc13e08: 7c a6 2b 78 mr r6,r5
ffc13e0c: 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,
ffc13e10: 3b a1 00 08 addi r29,r1,8
ffc13e14: 7f a5 eb 78 mr r5,r29
ffc13e18: 38 e0 00 01 li r7,1
bool _POSIX_signals_Check_signal(
POSIX_API_Control *api,
int signo,
bool is_global
)
{
ffc13e1c: 90 01 00 6c stw r0,108(r1)
ffc13e20: 7c 7f 1b 78 mr r31,r3
ffc13e24: 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,
ffc13e28: 48 00 00 b5 bl ffc13edc <_POSIX_signals_Clear_signals>
ffc13e2c: 2f 83 00 00 cmpwi cr7,r3,0
is_global, true ) )
return false;
ffc13e30: 38 00 00 00 li r0,0
{
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,
ffc13e34: 41 9e 00 9c beq- cr7,ffc13ed0 <_POSIX_signals_Check_signal+0xd0>
#endif
/*
* Just to prevent sending a signal which is currently being ignored.
*/
if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN )
ffc13e38: 3f 20 00 00 lis r25,0
ffc13e3c: 1f 5e 00 0c mulli r26,r30,12
ffc13e40: 3b 39 31 e0 addi r25,r25,12768
ffc13e44: 7d 39 d2 14 add r9,r25,r26
ffc13e48: 83 89 00 08 lwz r28,8(r9)
ffc13e4c: 2f 9c 00 01 cmpwi cr7,r28,1
ffc13e50: 41 9e 00 80 beq- cr7,ffc13ed0 <_POSIX_signals_Check_signal+0xd0><== NEVER TAKEN
/*
* Block the signals requested in sa_mask
*/
saved_signals_blocked = api->signals_blocked;
api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask;
ffc13e54: 80 09 00 04 lwz r0,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,
ffc13e58: 3d 20 00 00 lis r9,0
return false;
/*
* Block the signals requested in sa_mask
*/
saved_signals_blocked = api->signals_blocked;
ffc13e5c: 83 7f 00 d0 lwz r27,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,
ffc13e60: 38 61 00 14 addi r3,r1,20
ffc13e64: 80 89 31 90 lwz r4,12688(r9)
ffc13e68: 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;
ffc13e6c: 7c 00 db 78 or r0,r0,r27
ffc13e70: 90 1f 00 d0 stw r0,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,
ffc13e74: 38 84 00 20 addi r4,r4,32
ffc13e78: 48 00 12 79 bl ffc150f0 <memcpy>
sizeof( Thread_Wait_information ));
/*
* Here, the signal handler function executes
*/
switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) {
ffc13e7c: 7c 19 d0 2e lwzx r0,r25,r26
ffc13e80: 2f 80 00 02 cmpwi cr7,r0,2
ffc13e84: 40 be 00 1c bne+ cr7,ffc13ea0 <_POSIX_signals_Check_signal+0xa0>
case SA_SIGINFO:
(*_POSIX_signals_Vectors[ signo ].sa_sigaction)(
ffc13e88: 7f c3 f3 78 mr r3,r30
ffc13e8c: 7f 89 03 a6 mtctr r28
ffc13e90: 7f a4 eb 78 mr r4,r29
ffc13e94: 38 a0 00 00 li r5,0
ffc13e98: 4e 80 04 21 bctrl
signo,
&siginfo_struct,
NULL /* context is undefined per 1003.1b-1993, p. 66 */
);
break;
ffc13e9c: 48 00 00 14 b ffc13eb0 <_POSIX_signals_Check_signal+0xb0>
default:
(*_POSIX_signals_Vectors[ signo ].sa_handler)( signo );
ffc13ea0: 7f c3 f3 78 mr r3,r30
ffc13ea4: 7f 89 03 a6 mtctr r28
ffc13ea8: 4c c6 31 82 crclr 4*cr1+eq
ffc13eac: 4e 80 04 21 bctrl
}
/*
* Restore the blocking information
*/
memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information,
ffc13eb0: 3d 20 00 00 lis r9,0
ffc13eb4: 80 69 31 90 lwz r3,12688(r9)
ffc13eb8: 38 81 00 14 addi r4,r1,20
ffc13ebc: 38 a0 00 28 li r5,40
ffc13ec0: 38 63 00 20 addi r3,r3,32
ffc13ec4: 48 00 12 2d bl ffc150f0 <memcpy>
sizeof( Thread_Wait_information ));
/*
* Restore the previous set of blocked signals
*/
api->signals_blocked = saved_signals_blocked;
ffc13ec8: 93 7f 00 d0 stw r27,208(r31)
return true;
ffc13ecc: 38 00 00 01 li r0,1
}
ffc13ed0: 39 61 00 68 addi r11,r1,104
ffc13ed4: 7c 03 03 78 mr r3,r0
ffc13ed8: 48 00 53 78 b ffc19250 <_restgpr_25_x>
ffc14428 <_POSIX_signals_Clear_process_signals>:
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc14428: 7d 60 00 a6 mfmsr r11
ffc1442c: 7c 10 42 a6 mfsprg r0,0
ffc14430: 7d 60 00 78 andc r0,r11,r0
ffc14434: 7c 00 01 24 mtmsr r0
mask = signo_to_mask( signo );
ISR_Level level;
_ISR_Disable( level );
if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) {
ffc14438: 3d 20 00 00 lis r9,0
ffc1443c: 1c 03 00 0c mulli r0,r3,12
ffc14440: 39 29 31 e0 addi r9,r9,12768
ffc14444: 7d 29 00 2e lwzx r9,r9,r0
ffc14448: 2f 89 00 02 cmpwi cr7,r9,2
ffc1444c: 40 be 00 20 bne+ cr7,ffc1446c <_POSIX_signals_Clear_process_signals+0x44>
}
if ( clear_signal ) {
_POSIX_signals_Pending &= ~mask;
}
_ISR_Enable( level );
}
ffc14450: 3d 20 00 00 lis r9,0
ffc14454: 39 29 33 d4 addi r9,r9,13268
ffc14458: 7d 49 02 14 add r10,r9,r0
ISR_Level level;
_ISR_Disable( level );
if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) {
if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) )
ffc1445c: 7c 09 00 2e lwzx r0,r9,r0
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc14460: 39 4a 00 04 addi r10,r10,4
ffc14464: 7f 80 50 00 cmpw cr7,r0,r10
ffc14468: 40 be 00 20 bne+ cr7,ffc14488 <_POSIX_signals_Clear_process_signals+0x60><== NEVER TAKEN
clear_signal = false;
}
if ( clear_signal ) {
_POSIX_signals_Pending &= ~mask;
ffc1446c: 3d 20 00 00 lis r9,0
ffc14470: 38 00 ff fe li r0,-2
ffc14474: 38 63 ff ff addi r3,r3,-1
ffc14478: 5c 03 18 3e rotlw r3,r0,r3
ffc1447c: 80 09 27 d8 lwz r0,10200(r9)
ffc14480: 7c 63 00 38 and r3,r3,r0
ffc14484: 90 69 27 d8 stw r3,10200(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc14488: 7d 60 01 24 mtmsr r11
}
_ISR_Enable( level );
}
ffc1448c: 4e 80 00 20 blr
ffc08790 <_POSIX_signals_Get_lowest>:
ffc08790: 39 40 00 05 li r10,5
ffc08794: 7d 49 03 a6 mtctr r10
sigset_t set
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc08798: 39 20 00 1b li r9,27
ffc0879c: 38 00 00 01 li r0,1
#include <rtems/posix/psignal.h>
#include <rtems/seterr.h>
#include <rtems/posix/time.h>
#include <rtems/score/isr.h>
int _POSIX_signals_Get_lowest(
ffc087a0: 39 69 ff ff addi r11,r9,-1
ffc087a4: 7c 0b 58 30 slw r11,r0,r11
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
if ( set & signo_to_mask( signo ) ) {
ffc087a8: 7d 6a 18 39 and. r10,r11,r3
ffc087ac: 40 82 00 34 bne- ffc087e0 <_POSIX_signals_Get_lowest+0x50><== NEVER TAKEN
sigset_t set
)
{
int signo;
for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) {
ffc087b0: 39 29 00 01 addi r9,r9,1
ffc087b4: 42 00 ff ec bdnz+ ffc087a0 <_POSIX_signals_Get_lowest+0x10>
ffc087b8: 39 60 00 1a li r11,26
ffc087bc: 7d 69 03 a6 mtctr r11
ffc087c0: 39 20 00 01 li r9,1
ffc087c4: 38 00 00 01 li r0,1
#include <rtems/posix/psignal.h>
#include <rtems/seterr.h>
#include <rtems/posix/time.h>
#include <rtems/score/isr.h>
int _POSIX_signals_Get_lowest(
ffc087c8: 39 69 ff ff addi r11,r9,-1
ffc087cc: 7c 0b 58 30 slw r11,r0,r11
#if (SIGHUP != 1)
#error "Assumption that SIGHUP==1 violated!!"
#endif
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
if ( set & signo_to_mask( signo ) ) {
ffc087d0: 7d 6a 18 39 and. r10,r11,r3
ffc087d4: 40 82 00 0c bne- ffc087e0 <_POSIX_signals_Get_lowest+0x50>
*/
#if (SIGHUP != 1)
#error "Assumption that SIGHUP==1 violated!!"
#endif
for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) {
ffc087d8: 39 29 00 01 addi r9,r9,1
ffc087dc: 42 00 ff ec bdnz+ ffc087c8 <_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;
}
ffc087e0: 7d 23 4b 78 mr r3,r9
ffc087e4: 4e 80 00 20 blr
ffc24f28 <_POSIX_signals_Unblock_thread>:
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc24f28: 94 21 ff f0 stwu r1,-16(r1)
ffc24f2c: 7c 08 02 a6 mflr r0
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc24f30: 3c e0 10 00 lis r7,4096
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc24f34: 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 ) ) {
ffc24f38: 60 e7 80 00 ori r7,r7,32768
ffc24f3c: 39 64 ff ff addi r11,r4,-1
ffc24f40: 80 03 00 10 lwz r0,16(r3)
ffc24f44: 39 40 00 01 li r10,1
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc24f48: bf c1 00 08 stmw r30,8(r1)
ffc24f4c: 7c a9 2b 78 mr r9,r5
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc24f50: 7c 06 38 38 and r6,r0,r7
ffc24f54: 7f 86 38 00 cmpw cr7,r6,r7
{
POSIX_API_Control *api;
sigset_t mask;
siginfo_t *the_info = NULL;
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc24f58: 81 03 01 34 lwz r8,308(r3)
bool _POSIX_signals_Unblock_thread(
Thread_Control *the_thread,
int signo,
siginfo_t *info
)
{
ffc24f5c: 7c 7f 1b 78 mr r31,r3
ffc24f60: 7d 4b 58 30 slw r11,r10,r11
/*
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
ffc24f64: 40 be 00 60 bne+ cr7,ffc24fc4 <_POSIX_signals_Unblock_thread+0x9c>
if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) {
ffc24f68: 80 03 00 30 lwz r0,48(r3)
ffc24f6c: 7d 6a 00 39 and. r10,r11,r0
ffc24f70: 40 82 00 14 bne- ffc24f84 <_POSIX_signals_Unblock_thread+0x5c>
ffc24f74: 80 08 00 d0 lwz r0,208(r8)
/*
* This should only be reached via pthread_kill().
*/
return false;
ffc24f78: 3b c0 00 00 li r30,0
* Is the thread is specifically waiting for a signal?
*/
if ( _States_Is_interruptible_signal( the_thread->current_state ) ) {
if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) {
ffc24f7c: 7d 68 00 79 andc. r8,r11,r0
ffc24f80: 41 82 00 cc beq- ffc2504c <_POSIX_signals_Unblock_thread+0x124>
the_thread->Wait.return_code = EINTR;
the_info = (siginfo_t *) the_thread->Wait.return_argument;
if ( !info ) {
ffc24f84: 2f 89 00 00 cmpwi cr7,r9,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;
the_info = (siginfo_t *) the_thread->Wait.return_argument;
ffc24f88: 81 7f 00 28 lwz r11,40(r31)
*/
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;
ffc24f8c: 38 00 00 04 li r0,4
ffc24f90: 90 1f 00 34 stw r0,52(r31)
the_info = (siginfo_t *) the_thread->Wait.return_argument;
if ( !info ) {
ffc24f94: 40 be 00 18 bne+ cr7,ffc24fac <_POSIX_signals_Unblock_thread+0x84>
the_info->si_signo = signo;
the_info->si_code = SI_USER;
ffc24f98: 38 00 00 01 li r0,1
the_thread->Wait.return_code = EINTR;
the_info = (siginfo_t *) the_thread->Wait.return_argument;
if ( !info ) {
the_info->si_signo = signo;
ffc24f9c: 90 8b 00 00 stw r4,0(r11)
the_info->si_code = SI_USER;
ffc24fa0: 90 0b 00 04 stw r0,4(r11)
the_info->si_value.sival_int = 0;
ffc24fa4: 91 2b 00 08 stw r9,8(r11)
ffc24fa8: 48 00 00 0c b ffc24fb4 <_POSIX_signals_Unblock_thread+0x8c>
} else {
*the_info = *info;
ffc24fac: 7c a9 64 aa lswi r5,r9,12
ffc24fb0: 7c ab 65 aa stswi r5,r11,12
}
_Thread_queue_Extract_with_proxy( the_thread );
ffc24fb4: 7f e3 fb 78 mr r3,r31
ffc24fb8: 4b fe b6 61 bl ffc10618 <_Thread_queue_Extract_with_proxy>
return true;
ffc24fbc: 3b c0 00 01 li r30,1
ffc24fc0: 48 00 00 8c b ffc2504c <_POSIX_signals_Unblock_thread+0x124>
}
/*
* Thread is not waiting due to a sigwait.
*/
if ( ~api->signals_blocked & mask ) {
ffc24fc4: 81 28 00 d0 lwz r9,208(r8)
} else if ( the_thread->current_state == STATES_READY ) {
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
_Thread_Dispatch_necessary = true;
}
}
return false;
ffc24fc8: 3b c0 00 00 li r30,0
}
/*
* Thread is not waiting due to a sigwait.
*/
if ( ~api->signals_blocked & mask ) {
ffc24fcc: 7d 68 48 79 andc. r8,r11,r9
ffc24fd0: 41 82 00 7c beq- ffc2504c <_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 ) ) {
ffc24fd4: 74 09 10 00 andis. r9,r0,4096
ffc24fd8: 41 82 00 48 beq- ffc25020 <_POSIX_signals_Unblock_thread+0xf8>
the_thread->Wait.return_code = EINTR;
ffc24fdc: 39 20 00 04 li r9,4
ffc24fe0: 91 23 00 34 stw r9,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) )
ffc24fe4: 3d 20 00 03 lis r9,3
ffc24fe8: 61 29 be e0 ori r9,r9,48864
ffc24fec: 7c 0a 48 39 and. r10,r0,r9
ffc24ff0: 41 a2 00 0c beq+ ffc24ffc <_POSIX_signals_Unblock_thread+0xd4>
_Thread_queue_Extract_with_proxy( the_thread );
ffc24ff4: 4b fe b6 25 bl ffc10618 <_Thread_queue_Extract_with_proxy>
ffc24ff8: 48 00 00 54 b ffc2504c <_POSIX_signals_Unblock_thread+0x124>
else if ( _States_Is_delaying(the_thread->current_state) ) {
ffc24ffc: 70 0b 00 08 andi. r11,r0,8
ffc25000: 41 a2 00 4c beq+ ffc2504c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
(void) _Watchdog_Remove( &the_thread->Timer );
ffc25004: 38 63 00 48 addi r3,r3,72
ffc25008: 4b fe c0 c5 bl ffc110cc <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc2500c: 3c 80 10 03 lis r4,4099
ffc25010: 7f e3 fb 78 mr r3,r31
ffc25014: 60 84 ff f8 ori r4,r4,65528
ffc25018: 4b fe aa 6d bl ffc0fa84 <_Thread_Clear_state>
ffc2501c: 48 00 00 30 b ffc2504c <_POSIX_signals_Unblock_thread+0x124>
_Thread_Unblock( the_thread );
}
} else if ( the_thread->current_state == STATES_READY ) {
ffc25020: 2f 80 00 00 cmpwi cr7,r0,0
ffc25024: 40 9e 00 28 bne- cr7,ffc2504c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
ffc25028: 3d 20 00 00 lis r9,0
ffc2502c: 39 29 32 64 addi r9,r9,12900
ffc25030: 80 09 00 08 lwz r0,8(r9)
ffc25034: 2f 80 00 00 cmpwi cr7,r0,0
ffc25038: 41 9e 00 14 beq- cr7,ffc2504c <_POSIX_signals_Unblock_thread+0x124>
ffc2503c: 80 09 00 0c lwz r0,12(r9)
ffc25040: 7f 83 00 00 cmpw cr7,r3,r0
ffc25044: 40 be 00 08 bne+ cr7,ffc2504c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc25048: 99 49 00 18 stb r10,24(r9)
}
}
return false;
}
ffc2504c: 39 61 00 10 addi r11,r1,16
ffc25050: 7f c3 f3 78 mr r3,r30
ffc25054: 4b fd cf 3c b ffc01f90 <_restgpr_30_x>
ffc0924c <_Rate_monotonic_Timeout>:
void _Rate_monotonic_Timeout(
Objects_Id id,
void *ignored
)
{
ffc0924c: 7c 2b 0b 78 mr r11,r1
ffc09250: 94 21 ff e0 stwu r1,-32(r1)
ffc09254: 7c 08 02 a6 mflr r0
ffc09258: 7c 64 1b 78 mr r4,r3
ffc0925c: 3c 60 00 00 lis r3,0
ffc09260: 48 01 35 21 bl ffc1c780 <_savegpr_31>
ffc09264: 38 63 2c 38 addi r3,r3,11320
ffc09268: 90 01 00 24 stw r0,36(r1)
ffc0926c: 38 a1 00 08 addi r5,r1,8
ffc09270: 48 00 21 81 bl ffc0b3f0 <_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 ) {
ffc09274: 80 01 00 08 lwz r0,8(r1)
ffc09278: 7c 7f 1b 78 mr r31,r3
ffc0927c: 2f 80 00 00 cmpwi cr7,r0,0
ffc09280: 40 9e 00 84 bne- cr7,ffc09304 <_Rate_monotonic_Timeout+0xb8><== NEVER TAKEN
case OBJECTS_LOCAL:
the_thread = the_period->owner;
ffc09284: 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);
ffc09288: 80 03 00 10 lwz r0,16(r3)
if ( _States_Is_waiting_for_period( the_thread->current_state ) &&
ffc0928c: 70 09 40 00 andi. r9,r0,16384
ffc09290: 41 82 00 24 beq- ffc092b4 <_Rate_monotonic_Timeout+0x68>
ffc09294: 81 23 00 20 lwz r9,32(r3)
ffc09298: 80 1f 00 08 lwz r0,8(r31)
ffc0929c: 7f 89 00 00 cmpw cr7,r9,r0
ffc092a0: 40 be 00 14 bne+ cr7,ffc092b4 <_Rate_monotonic_Timeout+0x68>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
ffc092a4: 3c 80 10 03 lis r4,4099
ffc092a8: 60 84 ff f8 ori r4,r4,65528
ffc092ac: 48 00 2a 61 bl ffc0bd0c <_Thread_Clear_state>
ffc092b0: 48 00 00 18 b ffc092c8 <_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 ) {
ffc092b4: 80 1f 00 38 lwz r0,56(r31)
ffc092b8: 2f 80 00 01 cmpwi cr7,r0,1
ffc092bc: 40 be 00 30 bne+ cr7,ffc092ec <_Rate_monotonic_Timeout+0xa0>
the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING;
ffc092c0: 38 00 00 03 li r0,3
ffc092c4: 90 1f 00 38 stw r0,56(r31)
_Rate_monotonic_Initiate_statistics( the_period );
ffc092c8: 7f e3 fb 78 mr r3,r31
ffc092cc: 4b ff f9 45 bl ffc08c10 <_Rate_monotonic_Initiate_statistics>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc092d0: 80 1f 00 3c lwz r0,60(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc092d4: 3c 60 00 00 lis r3,0
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc092d8: 90 1f 00 1c stw r0,28(r31)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc092dc: 38 63 2e 28 addi r3,r3,11816
ffc092e0: 38 9f 00 10 addi r4,r31,16
ffc092e4: 48 00 40 25 bl ffc0d308 <_Watchdog_Insert>
ffc092e8: 48 00 00 0c b ffc092f4 <_Rate_monotonic_Timeout+0xa8>
_Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length );
} else
the_period->state = RATE_MONOTONIC_EXPIRED;
ffc092ec: 38 00 00 04 li r0,4
ffc092f0: 90 1f 00 38 stw r0,56(r31)
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc092f4: 3d 20 00 00 lis r9,0
ffc092f8: 81 69 27 f0 lwz r11,10224(r9)
ffc092fc: 38 0b ff ff addi r0,r11,-1
ffc09300: 90 09 27 f0 stw r0,10224(r9)
case OBJECTS_REMOTE: /* impossible */
#endif
case OBJECTS_ERROR:
break;
}
}
ffc09304: 39 61 00 20 addi r11,r1,32
ffc09308: 4b ff 7e c4 b ffc011cc <_restgpr_31_x>
ffc124f8 <_Scheduler_priority_Block>:
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_extract(
Thread_Control *the_thread
)
{
Chain_Control *ready = the_thread->scheduler.priority->ready_chain;
ffc124f8: 81 24 00 8c lwz r9,140(r4)
ffc124fc: 81 29 00 00 lwz r9,0(r9)
if ( _Chain_Has_only_one_node( ready ) ) {
ffc12500: 81 69 00 00 lwz r11,0(r9)
ffc12504: 80 09 00 08 lwz r0,8(r9)
ffc12508: 7f 8b 00 00 cmpw cr7,r11,r0
ffc1250c: 40 be 00 50 bne+ cr7,ffc1255c <_Scheduler_priority_Block+0x64>
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 );
ffc12510: 38 09 00 04 addi r0,r9,4
head->next = tail;
head->previous = NULL;
tail->previous = head;
ffc12514: 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;
ffc12518: 90 09 00 00 stw r0,0(r9)
head->previous = NULL;
ffc1251c: 38 00 00 00 li r0,0
ffc12520: 90 09 00 04 stw r0,4(r9)
_Chain_Initialize_empty( ready );
_Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map );
ffc12524: 81 24 00 8c lwz r9,140(r4)
RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove (
Priority_bit_map_Information *the_priority_map
)
{
*the_priority_map->minor &= the_priority_map->block_minor;
ffc12528: 81 69 00 04 lwz r11,4(r9)
ffc1252c: 80 09 00 14 lwz r0,20(r9)
ffc12530: 81 4b 00 00 lwz r10,0(r11)
ffc12534: 7d 40 00 38 and r0,r10,r0
if ( *the_priority_map->minor == 0 )
ffc12538: 2f 80 00 00 cmpwi cr7,r0,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;
ffc1253c: 90 0b 00 00 stw r0,0(r11)
if ( *the_priority_map->minor == 0 )
ffc12540: 40 9e 00 2c bne- cr7,ffc1256c <_Scheduler_priority_Block+0x74>
_Priority_Major_bit_map &= the_priority_map->block_major;
ffc12544: 3d 60 00 00 lis r11,0
ffc12548: 80 09 00 10 lwz r0,16(r9)
ffc1254c: 81 4b 27 d4 lwz r10,10196(r11)
ffc12550: 7d 40 00 38 and r0,r10,r0
ffc12554: 90 0b 27 d4 stw r0,10196(r11)
ffc12558: 48 00 00 14 b ffc1256c <_Scheduler_priority_Block+0x74>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
ffc1255c: 81 64 00 00 lwz r11,0(r4)
previous = the_node->previous;
ffc12560: 81 24 00 04 lwz r9,4(r4)
next->previous = previous;
ffc12564: 91 2b 00 04 stw r9,4(r11)
previous->next = next;
ffc12568: 91 69 00 00 stw r11,0(r9)
RTEMS_INLINE_ROUTINE bool _Thread_Is_heir (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Heir );
ffc1256c: 3d 20 00 00 lis r9,0
{
_Scheduler_priority_Ready_queue_extract(the_thread);
/* TODO: flash critical section */
if ( _Thread_Is_heir( the_thread ) )
ffc12570: 80 09 31 94 lwz r0,12692(r9)
ffc12574: 7f 84 00 00 cmpw cr7,r4,r0
ffc12578: 40 be 00 60 bne+ cr7,ffc125d8 <_Scheduler_priority_Block+0xe0>
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 );
ffc1257c: 3d 40 00 00 lis r10,0
Scheduler_Control *the_scheduler,
Thread_Control *the_thread
)
{
_Scheduler_priority_Block_body(the_scheduler, the_thread);
}
ffc12580: 81 23 00 00 lwz r9,0(r3)
ffc12584: 80 0a 27 d4 lwz r0,10196(r10)
ffc12588: 7c 0b 00 34 cntlzw r11,r0
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc1258c: 3d 00 00 00 lis r8,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 );
ffc12590: 90 0a 27 d4 stw r0,10196(r10)
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc12594: 39 08 31 a0 addi r8,r8,12704
ffc12598: 55 6a 10 3a rlwinm r10,r11,2,0,29
ffc1259c: 7c 08 50 2e lwzx r0,r8,r10
ffc125a0: 7c 07 00 34 cntlzw r7,r0
ffc125a4: 7c 08 51 2e stwx r0,r8,r10
return (_Priority_Bits_index( major ) << 4) +
ffc125a8: 55 60 20 36 rlwinm r0,r11,4,0,27
ffc125ac: 7c 00 3a 14 add r0,r0,r7
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc125b0: 1c 00 00 0c mulli r0,r0,12
ffc125b4: 7d 69 02 14 add r11,r9,r0
ffc125b8: 7d 29 00 2e lwzx r9,r9,r0
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc125bc: 39 6b 00 04 addi r11,r11,4
ffc125c0: 7f 89 58 00 cmpw cr7,r9,r11
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
return NULL;
ffc125c4: 38 00 00 00 li r0,0
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc125c8: 41 9e 00 08 beq- cr7,ffc125d0 <_Scheduler_priority_Block+0xd8><== NEVER TAKEN
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
ffc125cc: 7d 20 4b 78 mr r0,r9
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(
Scheduler_Control *the_scheduler
)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
ffc125d0: 3d 20 00 00 lis r9,0
ffc125d4: 90 09 31 94 stw r0,12692(r9)
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc125d8: 3d 20 00 00 lis r9,0
ffc125dc: 39 29 31 84 addi r9,r9,12676
/* TODO: flash critical section */
if ( _Thread_Is_heir( the_thread ) )
_Scheduler_priority_Schedule_body(the_scheduler);
if ( _Thread_Is_executing( the_thread ) )
ffc125e0: 80 09 00 0c lwz r0,12(r9)
ffc125e4: 7f 84 00 00 cmpw cr7,r4,r0
ffc125e8: 4c be 00 20 bnelr+ cr7
_Thread_Dispatch_necessary = true;
ffc125ec: 38 00 00 01 li r0,1
ffc125f0: 98 09 00 18 stb r0,24(r9)
ffc125f4: 4e 80 00 20 blr
ffc0aca8 <_Scheduler_priority_Schedule>:
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 );
ffc0aca8: 3d 40 00 00 lis r10,0
void _Scheduler_priority_Schedule(
Scheduler_Control *the_scheduler
)
{
_Scheduler_priority_Schedule_body( the_scheduler );
}
ffc0acac: 81 23 00 00 lwz r9,0(r3)
ffc0acb0: 80 0a 27 d4 lwz r0,10196(r10)
ffc0acb4: 7c 0b 00 34 cntlzw r11,r0
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0acb8: 3d 00 00 00 lis r8,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 );
ffc0acbc: 90 0a 27 d4 stw r0,10196(r10)
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
ffc0acc0: 39 08 31 a0 addi r8,r8,12704
ffc0acc4: 55 6a 10 3a rlwinm r10,r11,2,0,29
ffc0acc8: 7c 08 50 2e lwzx r0,r8,r10
ffc0accc: 7c 07 00 34 cntlzw r7,r0
ffc0acd0: 7c 08 51 2e stwx r0,r8,r10
return (_Priority_Bits_index( major ) << 4) +
ffc0acd4: 55 60 20 36 rlwinm r0,r11,4,0,27
ffc0acd8: 7c 00 3a 14 add r0,r0,r7
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc0acdc: 1c 00 00 0c mulli r0,r0,12
ffc0ace0: 7d 69 02 14 add r11,r9,r0
ffc0ace4: 7d 29 00 2e lwzx r9,r9,r0
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc0ace8: 39 6b 00 04 addi r11,r11,4
ffc0acec: 7f 89 58 00 cmpw cr7,r9,r11
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
return NULL;
ffc0acf0: 38 00 00 00 li r0,0
Chain_Control *the_ready_queue
)
{
Priority_Control index = _Priority_bit_map_Get_highest();
if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) )
ffc0acf4: 41 9e 00 08 beq- cr7,ffc0acfc <_Scheduler_priority_Schedule+0x54><== NEVER TAKEN
return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] );
ffc0acf8: 7d 20 4b 78 mr r0,r9
RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(
Scheduler_Control *the_scheduler
)
{
_Thread_Heir = _Scheduler_priority_Ready_queue_first(
ffc0acfc: 3d 20 00 00 lis r9,0
ffc0ad00: 90 09 31 94 stw r0,12692(r9)
ffc0ad04: 4e 80 00 20 blr
ffc0ae4c <_Scheduler_priority_Yield>:
{
ISR_Level level;
Thread_Control *executing;
Chain_Control *ready;
executing = _Thread_Executing;
ffc0ae4c: 3d 40 00 00 lis r10,0
ffc0ae50: 39 4a 31 84 addi r10,r10,12676
ffc0ae54: 81 2a 00 0c lwz r9,12(r10)
ready = executing->scheduler.priority->ready_chain;
ffc0ae58: 81 69 00 8c lwz r11,140(r9)
ffc0ae5c: 81 6b 00 00 lwz r11,0(r11)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0ae60: 7c 00 00 a6 mfmsr r0
ffc0ae64: 7d 10 42 a6 mfsprg r8,0
ffc0ae68: 7c 08 40 78 andc r8,r0,r8
ffc0ae6c: 7d 00 01 24 mtmsr r8
_ISR_Disable( level );
if ( !_Chain_Has_only_one_node( ready ) ) {
ffc0ae70: 80 eb 00 00 lwz r7,0(r11)
ffc0ae74: 81 0b 00 08 lwz r8,8(r11)
ffc0ae78: 7f 87 40 00 cmpw cr7,r7,r8
ffc0ae7c: 41 9e 00 60 beq- cr7,ffc0aedc <_Scheduler_priority_Yield+0x90>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
ffc0ae80: 80 e9 00 00 lwz r7,0(r9)
previous = the_node->previous;
ffc0ae84: 81 09 00 04 lwz r8,4(r9)
next->previous = previous;
ffc0ae88: 91 07 00 04 stw r8,4(r7)
previous->next = next;
ffc0ae8c: 90 e8 00 00 stw r7,0(r8)
RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected(
Chain_Control *the_chain,
Chain_Node *the_node
)
{
Chain_Node *tail = _Chain_Tail( the_chain );
ffc0ae90: 38 eb 00 04 addi r7,r11,4
Chain_Node *old_last = tail->previous;
ffc0ae94: 81 0b 00 08 lwz r8,8(r11)
the_node->next = tail;
ffc0ae98: 90 e9 00 00 stw r7,0(r9)
tail->previous = the_node;
ffc0ae9c: 91 2b 00 08 stw r9,8(r11)
old_last->next = the_node;
ffc0aea0: 91 28 00 00 stw r9,0(r8)
the_node->previous = old_last;
ffc0aea4: 91 09 00 04 stw r8,4(r9)
static inline void ppc_interrupt_flash( uint32_t level )
{
uint32_t current_level;
asm volatile (
ffc0aea8: 7d 00 00 a6 mfmsr r8
ffc0aeac: 7c 00 01 24 mtmsr r0
ffc0aeb0: 7d 00 01 24 mtmsr r8
_Chain_Extract_unprotected( &executing->Object.Node );
_Chain_Append_unprotected( ready, &executing->Object.Node );
_ISR_Flash( level );
if ( _Thread_Is_heir( executing ) )
ffc0aeb4: 81 0a 00 10 lwz r8,16(r10)
ffc0aeb8: 7f 89 40 00 cmpw cr7,r9,r8
ffc0aebc: 40 be 00 0c bne+ cr7,ffc0aec8 <_Scheduler_priority_Yield+0x7c><== NEVER TAKEN
_Thread_Heir = (Thread_Control *) _Chain_First( ready );
ffc0aec0: 81 2b 00 00 lwz r9,0(r11)
ffc0aec4: 91 2a 00 10 stw r9,16(r10)
_Thread_Dispatch_necessary = true;
ffc0aec8: 3d 20 00 00 lis r9,0
ffc0aecc: 39 60 00 01 li r11,1
ffc0aed0: 39 29 31 84 addi r9,r9,12676
ffc0aed4: 99 69 00 18 stb r11,24(r9)
ffc0aed8: 48 00 00 18 b ffc0aef0 <_Scheduler_priority_Yield+0xa4>
}
else if ( !_Thread_Is_heir( executing ) )
ffc0aedc: 81 6a 00 10 lwz r11,16(r10)
ffc0aee0: 7f 89 58 00 cmpw cr7,r9,r11
ffc0aee4: 41 9e 00 0c beq- cr7,ffc0aef0 <_Scheduler_priority_Yield+0xa4>
_Thread_Dispatch_necessary = true;
ffc0aee8: 39 20 00 01 li r9,1
ffc0aeec: 99 2a 00 18 stb r9,24(r10)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0aef0: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
}
ffc0aef4: 4e 80 00 20 blr
ffc08ca8 <_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();
if ((!the_tod) ||
ffc08ca8: 2c 03 00 00 cmpwi 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();
ffc08cac: 3d 20 00 00 lis r9,0
ffc08cb0: 81 29 20 cc lwz r9,8396(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;
ffc08cb4: 38 00 00 00 li r0,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) ||
ffc08cb8: 41 82 00 94 beq- ffc08d4c <_TOD_Validate+0xa4> <== NEVER TAKEN
)
{
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
ffc08cbc: 3d 60 00 0f lis r11,15
ffc08cc0: 61 6b 42 40 ori r11,r11,16960
ffc08cc4: 7d 2b 4b 96 divwu r9,r11,r9
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
ffc08cc8: 81 63 00 18 lwz r11,24(r3)
ffc08ccc: 7f 8b 48 40 cmplw cr7,r11,r9
ffc08cd0: 40 9c 00 7c bge- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->ticks >= ticks_per_second) ||
ffc08cd4: 81 23 00 14 lwz r9,20(r3)
ffc08cd8: 2b 89 00 3b cmplwi cr7,r9,59
ffc08cdc: 41 9d 00 70 bgt- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
ffc08ce0: 81 23 00 10 lwz r9,16(r3)
ffc08ce4: 2b 89 00 3b cmplwi cr7,r9,59
ffc08ce8: 41 9d 00 64 bgt- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
ffc08cec: 81 23 00 0c lwz r9,12(r3)
ffc08cf0: 2b 89 00 17 cmplwi cr7,r9,23
ffc08cf4: 41 9d 00 58 bgt- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
ffc08cf8: 81 23 00 04 lwz r9,4(r3)
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) ||
ffc08cfc: 2f 89 00 00 cmpwi cr7,r9,0
ffc08d00: 41 9e 00 4c beq- cr7,ffc08d4c <_TOD_Validate+0xa4> <== NEVER TAKEN
(the_tod->month == 0) ||
ffc08d04: 2b 89 00 0c cmplwi cr7,r9,12
ffc08d08: 41 9d 00 44 bgt- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
ffc08d0c: 81 43 00 00 lwz r10,0(r3)
(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) ||
ffc08d10: 2b 8a 07 c3 cmplwi cr7,r10,1987
ffc08d14: 40 9d 00 38 ble- cr7,ffc08d4c <_TOD_Validate+0xa4>
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
ffc08d18: 81 63 00 08 lwz r11,8(r3)
(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) ||
ffc08d1c: 2f 8b 00 00 cmpwi cr7,r11,0
ffc08d20: 41 9e 00 2c beq- cr7,ffc08d4c <_TOD_Validate+0xa4> <== NEVER TAKEN
(the_tod->day == 0) )
return false;
if ( (the_tod->year % 4) == 0 )
ffc08d24: 71 40 00 03 andi. r0,r10,3
ffc08d28: 3d 40 ff c2 lis r10,-62
ffc08d2c: 39 4a f8 28 addi r10,r10,-2008
ffc08d30: 40 82 00 08 bne- ffc08d38 <_TOD_Validate+0x90>
days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ];
ffc08d34: 39 29 00 0d addi r9,r9,13
else
days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ];
ffc08d38: 55 29 10 3a rlwinm r9,r9,2,0,29
ffc08d3c: 7c 0a 48 2e lwzx r0,r10,r9
* false - if the the_tod is invalid
*
* NOTE: This routine only works for leap-years through 2099.
*/
bool _TOD_Validate(
ffc08d40: 7c 0b 00 10 subfc r0,r11,r0
ffc08d44: 38 00 00 00 li r0,0
ffc08d48: 7c 00 01 14 adde r0,r0,r0
if ( the_tod->day > days_in_month )
return false;
return true;
}
ffc08d4c: 7c 03 03 78 mr r3,r0
ffc08d50: 4e 80 00 20 blr
ffc0af58 <_Thread_Change_priority>:
void _Thread_Change_priority(
Thread_Control *the_thread,
Priority_Control new_priority,
bool prepend_it
)
{
ffc0af58: 94 21 ff e0 stwu r1,-32(r1)
ffc0af5c: 7c 08 02 a6 mflr r0
ffc0af60: 90 01 00 24 stw r0,36(r1)
ffc0af64: bf 81 00 10 stmw r28,16(r1)
ffc0af68: 7c 7f 1b 78 mr r31,r3
ffc0af6c: 7c be 2b 78 mr r30,r5
*/
/*
* Save original state
*/
original_state = the_thread->current_state;
ffc0af70: 83 a3 00 10 lwz r29,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 );
ffc0af74: 90 81 00 08 stw r4,8(r1)
ffc0af78: 48 00 0f 41 bl ffc0beb8 <_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 )
ffc0af7c: 80 1f 00 14 lwz r0,20(r31)
ffc0af80: 80 81 00 08 lwz r4,8(r1)
ffc0af84: 7f 80 20 00 cmpw cr7,r0,r4
ffc0af88: 41 9e 00 0c beq- cr7,ffc0af94 <_Thread_Change_priority+0x3c>
_Thread_Set_priority( the_thread, new_priority );
ffc0af8c: 7f e3 fb 78 mr r3,r31
ffc0af90: 48 00 0e 85 bl ffc0be14 <_Thread_Set_priority>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0af94: 7f 80 00 a6 mfmsr r28
ffc0af98: 7c 10 42 a6 mfsprg r0,0
ffc0af9c: 7f 80 00 78 andc r0,r28,r0
ffc0afa0: 7c 00 01 24 mtmsr r0
/*
* 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;
ffc0afa4: 80 1f 00 10 lwz r0,16(r31)
ffc0afa8: 57 bd 07 7a rlwinm r29,r29,0,29,29
if ( state != STATES_TRANSIENT ) {
ffc0afac: 2f 80 00 04 cmpwi cr7,r0,4
ffc0afb0: 41 9e 00 38 beq- cr7,ffc0afe8 <_Thread_Change_priority+0x90>
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) )
ffc0afb4: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0afb8: 40 9e 00 0c bne- cr7,ffc0afc4 <_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);
ffc0afbc: 54 09 07 b8 rlwinm r9,r0,0,30,28
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
ffc0afc0: 91 3f 00 10 stw r9,16(r31)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0afc4: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
if ( _States_Is_waiting_on_thread_queue( state ) ) {
ffc0afc8: 3d 20 00 03 lis r9,3
ffc0afcc: 61 29 be e0 ori r9,r9,48864
ffc0afd0: 7c 0b 48 39 and. r11,r0,r9
ffc0afd4: 41 a2 01 08 beq+ ffc0b0dc <_Thread_Change_priority+0x184>
_Thread_queue_Requeue( the_thread->Wait.queue, the_thread );
ffc0afd8: 80 7f 00 44 lwz r3,68(r31)
ffc0afdc: 7f e4 fb 78 mr r4,r31
ffc0afe0: 48 00 0d 7d bl ffc0bd5c <_Thread_queue_Requeue>
ffc0afe4: 48 00 00 f8 b ffc0b0dc <_Thread_Change_priority+0x184>
}
return;
}
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) ) {
ffc0afe8: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0afec: 40 9e 00 a0 bne- cr7,ffc0b08c <_Thread_Change_priority+0x134><== NEVER TAKEN
* FIXME: hard-coded for priority scheduling. Might be ok since this
* function is specific to priority scheduling?
*/
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
if ( prepend_it )
ffc0aff0: 2f 9e 00 00 cmpwi cr7,r30,0
* Ready Queue with interrupts off.
*
* FIXME: hard-coded for priority scheduling. Might be ok since this
* function is specific to priority scheduling?
*/
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
ffc0aff4: 93 bf 00 10 stw r29,16(r31)
ffc0aff8: 3d 60 00 00 lis r11,0
ffc0affc: 81 3f 00 8c lwz r9,140(r31)
if ( prepend_it )
ffc0b000: 41 9e 00 48 beq- cr7,ffc0b048 <_Thread_Change_priority+0xf0>
RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add (
Priority_bit_map_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
ffc0b004: 81 49 00 04 lwz r10,4(r9)
ffc0b008: 80 09 00 0c lwz r0,12(r9)
ffc0b00c: 81 0a 00 00 lwz r8,0(r10)
ffc0b010: 7d 00 03 78 or r0,r8,r0
ffc0b014: 90 0a 00 00 stw r0,0(r10)
_Priority_Major_bit_map |= the_priority_map->ready_major;
ffc0b018: 80 09 00 08 lwz r0,8(r9)
Thread_Control *the_thread
)
{
_Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map );
_Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain,
ffc0b01c: 81 3f 00 8c lwz r9,140(r31)
ffc0b020: 81 4b 27 d4 lwz r10,10196(r11)
ffc0b024: 81 29 00 00 lwz r9,0(r9)
ffc0b028: 7d 40 03 78 or r0,r10,r0
ffc0b02c: 90 0b 27 d4 stw r0,10196(r11)
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
ffc0b030: 81 69 00 00 lwz r11,0(r9)
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
ffc0b034: 91 3f 00 04 stw r9,4(r31)
before_node = after_node->next;
after_node->next = the_node;
ffc0b038: 93 e9 00 00 stw r31,0(r9)
the_node->next = before_node;
before_node->previous = the_node;
ffc0b03c: 93 eb 00 04 stw r31,4(r11)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
ffc0b040: 91 7f 00 00 stw r11,0(r31)
ffc0b044: 48 00 00 48 b ffc0b08c <_Thread_Change_priority+0x134>
RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add (
Priority_bit_map_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
ffc0b048: 81 49 00 04 lwz r10,4(r9)
ffc0b04c: 80 09 00 0c lwz r0,12(r9)
ffc0b050: 81 0a 00 00 lwz r8,0(r10)
ffc0b054: 7d 00 03 78 or r0,r8,r0
ffc0b058: 90 0a 00 00 stw r0,0(r10)
_Priority_Major_bit_map |= the_priority_map->ready_major;
ffc0b05c: 80 09 00 08 lwz r0,8(r9)
Thread_Control *the_thread
)
{
_Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map );
_Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain,
ffc0b060: 81 3f 00 8c lwz r9,140(r31)
ffc0b064: 81 4b 27 d4 lwz r10,10196(r11)
ffc0b068: 81 29 00 00 lwz r9,0(r9)
ffc0b06c: 7d 40 03 78 or r0,r10,r0
ffc0b070: 90 0b 27 d4 stw r0,10196(r11)
RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected(
Chain_Control *the_chain,
Chain_Node *the_node
)
{
Chain_Node *tail = _Chain_Tail( the_chain );
ffc0b074: 38 09 00 04 addi r0,r9,4
Chain_Node *old_last = tail->previous;
ffc0b078: 81 69 00 08 lwz r11,8(r9)
the_node->next = tail;
ffc0b07c: 90 1f 00 00 stw r0,0(r31)
tail->previous = the_node;
ffc0b080: 93 e9 00 08 stw r31,8(r9)
old_last->next = the_node;
ffc0b084: 93 eb 00 00 stw r31,0(r11)
the_node->previous = old_last;
ffc0b088: 91 7f 00 04 stw r11,4(r31)
static inline void ppc_interrupt_flash( uint32_t level )
{
uint32_t current_level;
asm volatile (
ffc0b08c: 7c 00 00 a6 mfmsr r0
ffc0b090: 7f 80 01 24 mtmsr r28
ffc0b094: 7c 00 01 24 mtmsr r0
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Schedule(
Scheduler_Control *the_scheduler
)
{
the_scheduler->Operations.schedule( the_scheduler );
ffc0b098: 3c 60 00 00 lis r3,0
ffc0b09c: 38 63 2d 60 addi r3,r3,11616
ffc0b0a0: 80 03 00 04 lwz r0,4(r3)
ffc0b0a4: 7c 09 03 a6 mtctr r0
ffc0b0a8: 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 );
ffc0b0ac: 3d 20 00 00 lis r9,0
ffc0b0b0: 39 29 31 84 addi r9,r9,12676
ffc0b0b4: 81 69 00 0c lwz r11,12(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(&_Scheduler);
if ( !_Thread_Is_executing_also_the_heir() &&
ffc0b0b8: 80 09 00 10 lwz r0,16(r9)
ffc0b0bc: 7f 8b 00 00 cmpw cr7,r11,r0
ffc0b0c0: 41 9e 00 18 beq- cr7,ffc0b0d8 <_Thread_Change_priority+0x180>
ffc0b0c4: 88 0b 00 74 lbz r0,116(r11)
ffc0b0c8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0b0cc: 41 9e 00 0c beq- cr7,ffc0b0d8 <_Thread_Change_priority+0x180>
_Thread_Executing->is_preemptible )
_Thread_Dispatch_necessary = true;
ffc0b0d0: 38 00 00 01 li r0,1
ffc0b0d4: 98 09 00 18 stb r0,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0b0d8: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
}
ffc0b0dc: 39 61 00 20 addi r11,r1,32
ffc0b0e0: 48 00 e1 7c b ffc1925c <_restgpr_28_x>
ffc0b14c <_Thread_Close>:
void _Thread_Close(
Objects_Information *information,
Thread_Control *the_thread
)
{
ffc0b14c: 94 21 ff e8 stwu r1,-24(r1)
ffc0b150: 7c 08 02 a6 mflr r0
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc0b154: 39 60 00 00 li r11,0
ffc0b158: 90 01 00 1c stw r0,28(r1)
RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id(
Objects_Information *information,
Objects_Control *the_object
)
{
_Objects_Set_local_object(
ffc0b15c: a0 04 00 0a lhz r0,10(r4)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc0b160: 81 23 00 1c lwz r9,28(r3)
ffc0b164: 54 00 10 3a rlwinm r0,r0,2,0,29
ffc0b168: bf a1 00 0c stmw r29,12(r1)
ffc0b16c: 7c 7e 1b 78 mr r30,r3
ffc0b170: 7d 69 01 2e stwx r11,r9,r0
ffc0b174: 7c 9f 23 78 mr r31,r4
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc0b178: 3f a0 00 00 lis r29,0
ffc0b17c: 81 3d 27 88 lwz r9,10120(r29)
* disappear and set a transient state on it. So we temporarily
* unnest dispatching.
*/
_Thread_Unnest_dispatch();
_User_extensions_Thread_delete( the_thread );
ffc0b180: 7c 83 23 78 mr r3,r4
ffc0b184: 38 09 ff ff addi r0,r9,-1
ffc0b188: 90 1d 27 88 stw r0,10120(r29)
ffc0b18c: 48 00 12 85 bl ffc0c410 <_User_extensions_Thread_delete>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc0b190: 81 3d 27 88 lwz r9,10120(r29)
ffc0b194: 38 09 00 01 addi r0,r9,1
ffc0b198: 90 1d 27 88 stw r0,10120(r29)
/*
* Now we are in a dispatching critical section again and we
* can take the thread OUT of the published set. It is invalid
* to use this thread's Id OR name after this call.
*/
_Objects_Close( information, &the_thread->Object );
ffc0b19c: 7f c3 f3 78 mr r3,r30
ffc0b1a0: 7f e4 fb 78 mr r4,r31
ffc0b1a4: 4b ff f0 fd bl ffc0a2a0 <_Objects_Close>
/*
* By setting the dormant state, the thread will not be considered
* for scheduling when we remove any blocking states.
*/
_Thread_Set_state( the_thread, STATES_DORMANT );
ffc0b1a8: 7f e3 fb 78 mr r3,r31
ffc0b1ac: 38 80 00 01 li r4,1
ffc0b1b0: 48 00 0c a1 bl ffc0be50 <_Thread_Set_state>
if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) {
ffc0b1b4: 7f e3 fb 78 mr r3,r31
ffc0b1b8: 48 00 0a c1 bl ffc0bc78 <_Thread_queue_Extract_with_proxy>
ffc0b1bc: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b1c0: 40 9e 00 18 bne- cr7,ffc0b1d8 <_Thread_Close+0x8c>
if ( _Watchdog_Is_active( &the_thread->Timer ) )
ffc0b1c4: 80 1f 00 50 lwz r0,80(r31)
ffc0b1c8: 2f 80 00 02 cmpwi cr7,r0,2
ffc0b1cc: 40 be 00 0c bne+ cr7,ffc0b1d8 <_Thread_Close+0x8c>
(void) _Watchdog_Remove( &the_thread->Timer );
ffc0b1d0: 38 7f 00 48 addi r3,r31,72
ffc0b1d4: 48 00 14 a1 bl ffc0c674 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Scheduler_Thread_scheduler_free(
Scheduler_Control *the_scheduler,
Thread_Control *the_thread
)
{
return the_scheduler->Operations.scheduler_free( the_scheduler, the_thread );
ffc0b1d8: 3c 60 00 00 lis r3,0
ffc0b1dc: 38 63 2d 60 addi r3,r3,11616
ffc0b1e0: 80 03 00 18 lwz r0,24(r3)
ffc0b1e4: 7f e4 fb 78 mr r4,r31
ffc0b1e8: 7c 09 03 a6 mtctr r0
ffc0b1ec: 4e 80 04 21 bctrl
if ( _Thread_Is_allocated_fp( the_thread ) )
_Thread_Deallocate_fp();
#endif
the_thread->fp_context = NULL;
if ( the_thread->Start.fp_context )
ffc0b1f0: 80 7f 00 c0 lwz r3,192(r31)
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
#if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE )
if ( _Thread_Is_allocated_fp( the_thread ) )
_Thread_Deallocate_fp();
#endif
the_thread->fp_context = NULL;
ffc0b1f4: 38 00 00 00 li r0,0
if ( the_thread->Start.fp_context )
ffc0b1f8: 2f 83 00 00 cmpwi cr7,r3,0
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
#if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE )
if ( _Thread_Is_allocated_fp( the_thread ) )
_Thread_Deallocate_fp();
#endif
the_thread->fp_context = NULL;
ffc0b1fc: 90 1f 01 28 stw r0,296(r31)
if ( the_thread->Start.fp_context )
ffc0b200: 41 9e 00 08 beq- cr7,ffc0b208 <_Thread_Close+0xbc> <== NEVER TAKEN
(void) _Workspace_Free( the_thread->Start.fp_context );
ffc0b204: 48 00 15 bd bl ffc0c7c0 <_Workspace_Free>
/*
* Free the rest of the memory associated with this task
* and set the associated pointers to NULL for safety.
*/
_Thread_Stack_Free( the_thread );
ffc0b208: 7f e3 fb 78 mr r3,r31
ffc0b20c: 48 00 0d bd bl ffc0bfc8 <_Thread_Stack_Free>
the_thread->Start.stack = NULL;
if ( the_thread->extensions )
ffc0b210: 80 7f 01 38 lwz r3,312(r31)
/*
* Free the rest of the memory associated with this task
* and set the associated pointers to NULL for safety.
*/
_Thread_Stack_Free( the_thread );
the_thread->Start.stack = NULL;
ffc0b214: 38 00 00 00 li r0,0
if ( the_thread->extensions )
ffc0b218: 2f 83 00 00 cmpwi cr7,r3,0
/*
* Free the rest of the memory associated with this task
* and set the associated pointers to NULL for safety.
*/
_Thread_Stack_Free( the_thread );
the_thread->Start.stack = NULL;
ffc0b21c: 90 1f 00 c4 stw r0,196(r31)
if ( the_thread->extensions )
ffc0b220: 41 9e 00 08 beq- cr7,ffc0b228 <_Thread_Close+0xdc>
(void) _Workspace_Free( the_thread->extensions );
ffc0b224: 48 00 15 9d bl ffc0c7c0 <_Workspace_Free>
the_thread->extensions = NULL;
ffc0b228: 38 00 00 00 li r0,0
}
ffc0b22c: 39 61 00 18 addi r11,r1,24
_Thread_Stack_Free( the_thread );
the_thread->Start.stack = NULL;
if ( the_thread->extensions )
(void) _Workspace_Free( the_thread->extensions );
the_thread->extensions = NULL;
ffc0b230: 90 1f 01 38 stw r0,312(r31)
}
ffc0b234: 48 00 e0 2c b ffc19260 <_restgpr_29_x>
ffc0b31c <_Thread_Delay_ended>:
void _Thread_Delay_ended(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0b31c: 94 21 ff e8 stwu r1,-24(r1)
ffc0b320: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b324: 38 81 00 08 addi r4,r1,8
void _Thread_Delay_ended(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0b328: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0b32c: 48 00 01 b5 bl ffc0b4e0 <_Thread_Get>
switch ( location ) {
ffc0b330: 80 01 00 08 lwz r0,8(r1)
ffc0b334: 2f 80 00 00 cmpwi cr7,r0,0
ffc0b338: 40 9e 00 20 bne- cr7,ffc0b358 <_Thread_Delay_ended+0x3c><== NEVER TAKEN
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_Clear_state(
ffc0b33c: 3c 80 10 00 lis r4,4096
ffc0b340: 60 84 00 18 ori r4,r4,24
ffc0b344: 4b ff fd a1 bl ffc0b0e4 <_Thread_Clear_state>
ffc0b348: 3d 20 00 00 lis r9,0
ffc0b34c: 81 69 27 88 lwz r11,10120(r9)
ffc0b350: 38 0b ff ff addi r0,r11,-1
ffc0b354: 90 09 27 88 stw r0,10120(r9)
| STATES_INTERRUPTIBLE_BY_SIGNAL
);
_Thread_Unnest_dispatch();
break;
}
}
ffc0b358: 80 01 00 1c lwz r0,28(r1)
ffc0b35c: 38 21 00 18 addi r1,r1,24
ffc0b360: 7c 08 03 a6 mtlr r0
ffc0b364: 4e 80 00 20 blr
ffc0b368 <_Thread_Dispatch>:
* dispatch thread
* no dispatch thread
*/
void _Thread_Dispatch( void )
{
ffc0b368: 94 21 ff b8 stwu r1,-72(r1)
ffc0b36c: 7c 08 02 a6 mflr r0
ffc0b370: be a1 00 1c stmw r21,28(r1)
Thread_Control *executing;
Thread_Control *heir;
ISR_Level level;
executing = _Thread_Executing;
ffc0b374: 3f 40 00 00 lis r26,0
ffc0b378: 39 3a 31 84 addi r9,r26,12676
* dispatch thread
* no dispatch thread
*/
void _Thread_Dispatch( void )
{
ffc0b37c: 90 01 00 4c stw r0,76(r1)
Thread_Control *executing;
Thread_Control *heir;
ISR_Level level;
executing = _Thread_Executing;
ffc0b380: 83 e9 00 0c lwz r31,12(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0b384: 7c 00 00 a6 mfmsr r0
ffc0b388: 7d 30 42 a6 mfsprg r9,0
ffc0b38c: 7c 09 48 78 andc r9,r0,r9
ffc0b390: 7d 20 01 24 mtmsr r9
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
{
Timestamp_Control uptime, ran;
_TOD_Get_uptime( &uptime );
_Timestamp_Subtract(
ffc0b394: 3f 80 00 00 lis r28,0
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
heir = _Thread_Heir;
_Thread_Dispatch_disable_level = 1;
ffc0b398: 3e a0 00 00 lis r21,0
ffc0b39c: 3a c0 00 01 li r22,1
_Thread_Dispatch_necessary = false;
ffc0b3a0: 3a e0 00 00 li r23,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;
ffc0b3a4: 3f 00 00 00 lis r24,0
_ISR_Enable( level );
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
{
Timestamp_Control uptime, ran;
_TOD_Get_uptime( &uptime );
ffc0b3a8: 3b 61 00 08 addi r27,r1,8
_Timestamp_Subtract(
ffc0b3ac: 3b 9c 27 b8 addi r28,r28,10168
ffc0b3b0: 3b a1 00 10 addi r29,r1,16
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b3b4: 3f 20 00 00 lis r25,0
Thread_Control *heir;
ISR_Level level;
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
ffc0b3b8: 48 00 00 dc b ffc0b494 <_Thread_Dispatch+0x12c>
heir = _Thread_Heir;
ffc0b3bc: 83 c9 00 10 lwz r30,16(r9)
_Thread_Dispatch_disable_level = 1;
ffc0b3c0: 92 d5 27 88 stw r22,10120(r21)
/*
* 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 )
ffc0b3c4: 7f 9e f8 00 cmpw cr7,r30,r31
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
heir = _Thread_Heir;
_Thread_Dispatch_disable_level = 1;
_Thread_Dispatch_necessary = false;
ffc0b3c8: 9a e9 00 18 stb r23,24(r9)
_Thread_Executing = heir;
ffc0b3cc: 93 c9 00 0c stw r30,12(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 )
ffc0b3d0: 41 9e 00 d4 beq- cr7,ffc0b4a4 <_Thread_Dispatch+0x13c>
*/
#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 )
ffc0b3d4: 81 3e 00 7c lwz r9,124(r30)
ffc0b3d8: 2f 89 00 01 cmpwi cr7,r9,1
ffc0b3dc: 40 be 00 0c bne+ cr7,ffc0b3e8 <_Thread_Dispatch+0x80>
heir->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0b3e0: 81 38 27 84 lwz r9,10116(r24)
ffc0b3e4: 91 3e 00 78 stw r9,120(r30)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0b3e8: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
{
Timestamp_Control uptime, ran;
_TOD_Get_uptime( &uptime );
ffc0b3ec: 7f 63 db 78 mr r3,r27
ffc0b3f0: 48 00 6b 05 bl ffc11ef4 <_TOD_Get_uptime>
_Timestamp_Subtract(
ffc0b3f4: 7f 83 e3 78 mr r3,r28
ffc0b3f8: 7f 64 db 78 mr r4,r27
ffc0b3fc: 7f a5 eb 78 mr r5,r29
ffc0b400: 48 00 0d a1 bl ffc0c1a0 <_Timespec_Subtract>
&_Thread_Time_of_last_context_switch,
&uptime,
&ran
);
_Timestamp_Add_to( &executing->cpu_time_used, &ran );
ffc0b404: 38 7f 00 84 addi r3,r31,132
ffc0b408: 7f a4 eb 78 mr r4,r29
ffc0b40c: 48 00 0d 39 bl ffc0c144 <_Timespec_Add_to>
_Thread_Time_of_last_context_switch = uptime;
ffc0b410: 81 21 00 08 lwz r9,8(r1)
ffc0b414: 81 41 00 0c lwz r10,12(r1)
ffc0b418: 91 3c 00 00 stw r9,0(r28)
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b41c: 81 39 27 9c lwz r9,10140(r25)
&_Thread_Time_of_last_context_switch,
&uptime,
&ran
);
_Timestamp_Add_to( &executing->cpu_time_used, &ran );
_Thread_Time_of_last_context_switch = uptime;
ffc0b420: 91 5c 00 04 stw r10,4(r28)
#endif
/*
* Switch libc's task specific data.
*/
if ( _Thread_libc_reent ) {
ffc0b424: 2f 89 00 00 cmpwi cr7,r9,0
ffc0b428: 41 9e 00 14 beq- cr7,ffc0b43c <_Thread_Dispatch+0xd4> <== NEVER TAKEN
executing->libc_reent = *_Thread_libc_reent;
ffc0b42c: 80 09 00 00 lwz r0,0(r9)
ffc0b430: 90 1f 01 2c stw r0,300(r31)
*_Thread_libc_reent = heir->libc_reent;
ffc0b434: 80 1e 01 2c lwz r0,300(r30)
ffc0b438: 90 09 00 00 stw r0,0(r9)
}
_User_extensions_Thread_switch( executing, heir );
ffc0b43c: 7f e3 fb 78 mr r3,r31
ffc0b440: 7f c4 f3 78 mr r4,r30
ffc0b444: 48 00 10 89 bl ffc0c4cc <_User_extensions_Thread_switch>
* operations.
*/
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
#if ( CPU_USE_DEFERRED_FP_SWITCH != TRUE )
if ( executing->fp_context != NULL )
ffc0b448: 80 1f 01 28 lwz r0,296(r31)
ffc0b44c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0b450: 41 9e 00 0c beq- cr7,ffc0b45c <_Thread_Dispatch+0xf4>
_Context_Save_fp( &executing->fp_context );
ffc0b454: 38 7f 01 28 addi r3,r31,296
ffc0b458: 48 00 de c9 bl ffc19320 <_CPU_Context_save_fp>
#endif
#endif
_Context_Switch( &executing->Registers, &heir->Registers );
ffc0b45c: 38 7f 00 c8 addi r3,r31,200
ffc0b460: 38 9e 00 c8 addi r4,r30,200
ffc0b464: 48 00 e0 3d bl ffc194a0 <_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 )
ffc0b468: 80 1f 01 28 lwz r0,296(r31)
ffc0b46c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0b470: 41 9e 00 0c beq- cr7,ffc0b47c <_Thread_Dispatch+0x114>
_Context_Restore_fp( &executing->fp_context );
ffc0b474: 38 7f 01 28 addi r3,r31,296
ffc0b478: 48 00 df 69 bl ffc193e0 <_CPU_Context_restore_fp>
#endif
#endif
executing = _Thread_Executing;
ffc0b47c: 39 3a 31 84 addi r9,r26,12676
ffc0b480: 83 e9 00 0c lwz r31,12(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0b484: 7c 00 00 a6 mfmsr r0
ffc0b488: 7d 30 42 a6 mfsprg r9,0
ffc0b48c: 7c 09 48 78 andc r9,r0,r9
ffc0b490: 7d 20 01 24 mtmsr r9
Thread_Control *heir;
ISR_Level level;
executing = _Thread_Executing;
_ISR_Disable( level );
while ( _Thread_Dispatch_necessary == true ) {
ffc0b494: 39 3a 31 84 addi r9,r26,12676
ffc0b498: 89 69 00 18 lbz r11,24(r9)
ffc0b49c: 2f 8b 00 00 cmpwi cr7,r11,0
ffc0b4a0: 40 9e ff 1c bne+ cr7,ffc0b3bc <_Thread_Dispatch+0x54>
_ISR_Disable( level );
}
post_switch:
_Thread_Dispatch_disable_level = 0;
ffc0b4a4: 39 60 00 00 li r11,0
ffc0b4a8: 3d 20 00 00 lis r9,0
ffc0b4ac: 91 69 27 88 stw r11,10120(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0b4b0: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
_API_extensions_Run_postswitch();
ffc0b4b4: 4b ff e2 05 bl ffc096b8 <_API_extensions_Run_postswitch>
}
ffc0b4b8: 39 61 00 48 addi r11,r1,72
ffc0b4bc: 48 00 dd 84 b ffc19240 <_restgpr_21_x>
ffc14280 <_Thread_Handler>:
*
* Output parameters: NONE
*/
void _Thread_Handler( void )
{
ffc14280: 94 21 ff f0 stwu r1,-16(r1)
ffc14284: 7c 08 02 a6 mflr r0
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
static char doneConstructors;
char doneCons;
#endif
executing = _Thread_Executing;
ffc14288: 3d 20 00 00 lis r9,0
*
* Output parameters: NONE
*/
void _Thread_Handler( void )
{
ffc1428c: 90 01 00 14 stw r0,20(r1)
ffc14290: bf c1 00 08 stmw r30,8(r1)
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
static char doneConstructors;
char doneCons;
#endif
executing = _Thread_Executing;
ffc14294: 83 e9 31 90 lwz r31,12688(r9)
/*
* have to put level into a register for those cpu's that use
* inline asm here
*/
level = executing->Start.isr_level;
ffc14298: 81 3f 00 ac lwz r9,172(r31)
}
static inline void _CPU_ISR_Set_level( uint32_t level )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc1429c: 38 00 00 00 li r0,0
ffc142a0: 7c 00 00 a6 mfmsr r0
if (!(level & CPU_MODES_INTERRUPT_MASK)) {
ffc142a4: 71 2b 00 01 andi. r11,r9,1
ffc142a8: 40 82 00 10 bne- ffc142b8 <_Thread_Handler+0x38>
static inline uint32_t ppc_interrupt_get_disable_mask( void )
{
uint32_t mask;
asm volatile (
ffc142ac: 7d 30 42 a6 mfsprg r9,0
msr |= ppc_interrupt_get_disable_mask();
ffc142b0: 7d 20 03 78 or r0,r9,r0
ffc142b4: 48 00 00 0c b ffc142c0 <_Thread_Handler+0x40>
ffc142b8: 7d 30 42 a6 mfsprg r9,0
}
else {
msr &= ~ppc_interrupt_get_disable_mask();
ffc142bc: 7c 00 48 78 andc r0,r0,r9
}
_CPU_MSR_SET(msr);
ffc142c0: 7c 00 01 24 mtmsr r0
_ISR_Set_level(level);
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
doneCons = doneConstructors;
ffc142c4: 3d 20 00 00 lis r9,0
ffc142c8: 8b c9 2a 10 lbz r30,10768(r9)
doneConstructors = 1;
ffc142cc: 38 00 00 01 li r0,1
/*
* Take care that 'begin' extensions get to complete before
* 'switch' extensions can run. This means must keep dispatch
* disabled until all 'begin' extensions complete.
*/
_User_extensions_Thread_begin( executing );
ffc142d0: 7f e3 fb 78 mr r3,r31
level = executing->Start.isr_level;
_ISR_Set_level(level);
#if defined(EXECUTE_GLOBAL_CONSTRUCTORS)
doneCons = doneConstructors;
doneConstructors = 1;
ffc142d4: 98 09 2a 10 stb r0,10768(r9)
/*
* Take care that 'begin' extensions get to complete before
* 'switch' extensions can run. This means must keep dispatch
* disabled until all 'begin' extensions complete.
*/
_User_extensions_Thread_begin( executing );
ffc142d8: 4b ff 7f c1 bl ffc0c298 <_User_extensions_Thread_begin>
/*
* At this point, the dispatch disable level BETTER be 1.
*/
_Thread_Enable_dispatch();
ffc142dc: 4b ff 71 e5 bl ffc0b4c0 <_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 (!doneCons) /* && (volatile void *)_init) */ {
ffc142e0: 2f 9e 00 00 cmpwi cr7,r30,0
ffc142e4: 40 be 00 08 bne+ cr7,ffc142ec <_Thread_Handler+0x6c>
INIT_NAME ();
ffc142e8: 48 00 5c 95 bl ffc19f7c <_init>
}
#endif
if ( executing->Start.prototype == THREAD_START_NUMERIC ) {
ffc142ec: 80 1f 00 94 lwz r0,148(r31)
ffc142f0: 2f 80 00 00 cmpwi cr7,r0,0
ffc142f4: 40 be 00 10 bne+ cr7,ffc14304 <_Thread_Handler+0x84>
executing->Wait.return_argument =
(*(Thread_Entry_numeric) executing->Start.entry_point)(
ffc142f8: 80 1f 00 90 lwz r0,144(r31)
ffc142fc: 80 7f 00 9c lwz r3,156(r31)
ffc14300: 48 00 00 14 b ffc14314 <_Thread_Handler+0x94>
executing->Start.numeric_argument
);
}
#if defined(RTEMS_POSIX_API)
else if ( executing->Start.prototype == THREAD_START_POINTER ) {
ffc14304: 2f 80 00 01 cmpwi cr7,r0,1
ffc14308: 40 be 00 18 bne+ cr7,ffc14320 <_Thread_Handler+0xa0> <== NEVER TAKEN
executing->Wait.return_argument =
(*(Thread_Entry_pointer) executing->Start.entry_point)(
ffc1430c: 80 1f 00 90 lwz r0,144(r31)
ffc14310: 80 7f 00 98 lwz r3,152(r31)
ffc14314: 7c 09 03 a6 mtctr r0
ffc14318: 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 =
ffc1431c: 90 7f 00 28 stw r3,40(r31)
* was placed in return_argument. This assumed that if it returned
* anything (which is not supporting in all APIs), then it would be
* able to fit in a (void *).
*/
_User_extensions_Thread_exitted( executing );
ffc14320: 7f e3 fb 78 mr r3,r31
ffc14324: 4b ff 7f c9 bl ffc0c2ec <_User_extensions_Thread_exitted>
_Internal_error_Occurred(
ffc14328: 38 60 00 00 li r3,0
ffc1432c: 38 80 00 01 li r4,1
ffc14330: 38 a0 00 05 li r5,5
ffc14334: 4b ff 5e 79 bl ffc0a1ac <_Internal_error_Occurred>
ffc0b580 <_Thread_Initialize>:
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b580: 94 21 ff d0 stwu r1,-48(r1)
ffc0b584: 7c 08 02 a6 mflr r0
ffc0b588: be e1 00 0c stmw r23,12(r1)
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
ffc0b58c: 7c b7 2b 79 mr. r23,r5
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b590: 7d 3a 4b 78 mr r26,r9
ffc0b594: 90 01 00 34 stw r0,52(r1)
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b598: 38 00 00 00 li r0,0
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b59c: 7c 7e 1b 78 mr r30,r3
ffc0b5a0: 81 21 00 40 lwz r9,64(r1)
ffc0b5a4: 7c 9f 23 78 mr r31,r4
ffc0b5a8: 7c dd 33 78 mr r29,r6
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b5ac: 90 04 01 30 stw r0,304(r4)
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
ffc0b5b0: 7c fc 3b 78 mr r28,r7
ffc0b5b4: 7d 1b 43 78 mr r27,r8
ffc0b5b8: 83 09 00 00 lwz r24,0(r9)
ffc0b5bc: 7d 59 53 78 mr r25,r10
/*
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
ffc0b5c0: 90 04 01 34 stw r0,308(r4)
extensions_area = NULL;
the_thread->libc_reent = NULL;
ffc0b5c4: 90 04 01 2c stw r0,300(r4)
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
#else
if ( !stack_area ) {
ffc0b5c8: 40 a2 00 38 bne+ ffc0b600 <_Thread_Initialize+0x80>
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
ffc0b5cc: 7c 83 23 78 mr r3,r4
ffc0b5d0: 7c c4 33 78 mr r4,r6
ffc0b5d4: 48 00 09 81 bl ffc0bf54 <_Thread_Stack_Allocate>
if ( !actual_stack_size || actual_stack_size < stack_size )
return false; /* stack allocation failed */
ffc0b5d8: 38 00 00 00 li r0,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 )
ffc0b5dc: 2c 03 00 00 cmpwi r3,0
ffc0b5e0: 41 82 01 e0 beq- ffc0b7c0 <_Thread_Initialize+0x240>
ffc0b5e4: 7f 83 e8 40 cmplw cr7,r3,r29
return false; /* stack allocation failed */
ffc0b5e8: 7e e0 bb 78 mr r0,r23
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 )
ffc0b5ec: 41 9c 01 d4 blt- cr7,ffc0b7c0 <_Thread_Initialize+0x240><== NEVER TAKEN
return false; /* stack allocation failed */
stack = the_thread->Start.stack;
the_thread->Start.core_allocated_stack = true;
ffc0b5f0: 38 00 00 01 li r0,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;
ffc0b5f4: 82 ff 00 c4 lwz r23,196(r31)
the_thread->Start.core_allocated_stack = true;
ffc0b5f8: 98 1f 00 b4 stb r0,180(r31)
ffc0b5fc: 48 00 00 0c b ffc0b608 <_Thread_Initialize+0x88>
} else {
stack = stack_area;
actual_stack_size = stack_size;
the_thread->Start.core_allocated_stack = false;
ffc0b600: 98 04 00 b4 stb r0,180(r4)
ffc0b604: 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 ) {
ffc0b608: 2f 9c 00 00 cmpwi cr7,r28,0
Stack_Control *the_stack,
void *starting_address,
size_t size
)
{
the_stack->area = starting_address;
ffc0b60c: 92 ff 00 bc stw r23,188(r31)
extensions_area = NULL;
the_thread->libc_reent = NULL;
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
fp_area = NULL;
ffc0b610: 3a e0 00 00 li r23,0
the_stack->size = size;
ffc0b614: 90 7f 00 b8 stw r3,184(r31)
/*
* Allocate the floating point area for this thread
*/
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( is_fp ) {
ffc0b618: 41 be 00 14 beq+ cr7,ffc0b62c <_Thread_Initialize+0xac>
fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE );
ffc0b61c: 38 60 01 08 li r3,264
ffc0b620: 48 00 11 6d bl ffc0c78c <_Workspace_Allocate>
if ( !fp_area )
ffc0b624: 7c 77 1b 79 mr. r23,r3
ffc0b628: 41 82 01 24 beq- ffc0b74c <_Thread_Initialize+0x1cc>
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b62c: 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;
ffc0b630: 92 ff 01 28 stw r23,296(r31)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0b634: 38 00 00 00 li r0,0
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b638: 80 69 27 a8 lwz r3,10152(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;
ffc0b63c: 3b a0 00 00 li r29,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;
ffc0b640: 92 ff 00 c0 stw r23,192(r31)
#endif
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
ffc0b644: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b648: 90 1f 00 50 stw r0,80(r31)
the_watchdog->routine = routine;
ffc0b64c: 90 1f 00 64 stw r0,100(r31)
the_watchdog->id = id;
ffc0b650: 90 1f 00 68 stw r0,104(r31)
the_watchdog->user_data = user_data;
ffc0b654: 90 1f 00 6c stw r0,108(r31)
ffc0b658: 41 be 00 18 beq+ cr7,ffc0b670 <_Thread_Initialize+0xf0>
extensions_area = _Workspace_Allocate(
ffc0b65c: 38 63 00 01 addi r3,r3,1
ffc0b660: 54 63 10 3a rlwinm r3,r3,2,0,29
ffc0b664: 48 00 11 29 bl ffc0c78c <_Workspace_Allocate>
(_Thread_Maximum_extensions + 1) * sizeof( void * )
);
if ( !extensions_area )
ffc0b668: 7c 7d 1b 79 mr. r29,r3
ffc0b66c: 41 82 00 e4 beq- ffc0b750 <_Thread_Initialize+0x1d0>
* 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 ) {
ffc0b670: 2f 9d 00 00 cmpwi cr7,r29,0
(_Thread_Maximum_extensions + 1) * sizeof( void * )
);
if ( !extensions_area )
goto failed;
}
the_thread->extensions = (void **) extensions_area;
ffc0b674: 93 bf 01 38 stw r29,312(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 ) {
ffc0b678: 41 9e 00 2c beq- cr7,ffc0b6a4 <_Thread_Initialize+0x124>
for ( i = 0; i <= _Thread_Maximum_extensions ; i++ )
ffc0b67c: 3d 20 00 00 lis r9,0
ffc0b680: 81 49 27 a8 lwz r10,10152(r9)
* all memory associated with this thread. It completes by adding
* the thread to the local object table so operations on this
* thread id are allowed.
*/
bool _Thread_Initialize(
ffc0b684: 39 7d ff fc addi r11,r29,-4
ffc0b688: 39 20 00 00 li r9,0
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
for ( i = 0; i <= _Thread_Maximum_extensions ; i++ )
the_thread->extensions[i] = NULL;
ffc0b68c: 38 00 00 00 li r0,0
ffc0b690: 48 00 00 0c b ffc0b69c <_Thread_Initialize+0x11c>
ffc0b694: 94 0b 00 04 stwu r0,4(r11)
* 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++ )
ffc0b698: 39 29 00 01 addi r9,r9,1
ffc0b69c: 7f 89 50 40 cmplw cr7,r9,r10
ffc0b6a0: 40 9d ff f4 ble+ cr7,ffc0b694 <_Thread_Initialize+0x114>
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
switch ( budget_algorithm ) {
ffc0b6a4: 2f 99 00 02 cmpwi cr7,r25,2
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
ffc0b6a8: 80 01 00 38 lwz r0,56(r1)
/*
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
ffc0b6ac: 9b 5f 00 a0 stb r26,160(r31)
the_thread->Start.budget_algorithm = budget_algorithm;
ffc0b6b0: 93 3f 00 a4 stw r25,164(r31)
the_thread->Start.budget_callout = budget_callout;
ffc0b6b4: 90 1f 00 a8 stw r0,168(r31)
switch ( budget_algorithm ) {
ffc0b6b8: 40 be 00 10 bne+ cr7,ffc0b6c8 <_Thread_Initialize+0x148>
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;
ffc0b6bc: 3d 20 00 00 lis r9,0
ffc0b6c0: 80 09 27 84 lwz r0,10116(r9)
ffc0b6c4: 90 1f 00 78 stw r0,120(r31)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
#endif
}
the_thread->Start.isr_level = isr_level;
ffc0b6c8: 80 01 00 3c lwz r0,60(r1)
Scheduler_Control *the_scheduler,
Thread_Control *the_thread
)
{
return
the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread );
ffc0b6cc: 3c 60 00 00 lis r3,0
ffc0b6d0: 38 63 2d 60 addi r3,r3,11616
the_thread->current_state = STATES_DORMANT;
the_thread->Wait.queue = NULL;
the_thread->resource_count = 0;
the_thread->real_priority = priority;
ffc0b6d4: 93 7f 00 18 stw r27,24(r31)
}
the_thread->Start.isr_level = isr_level;
the_thread->current_state = STATES_DORMANT;
the_thread->Wait.queue = NULL;
ffc0b6d8: 3b 40 00 00 li r26,0
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
#endif
}
the_thread->Start.isr_level = isr_level;
ffc0b6dc: 90 1f 00 ac stw r0,172(r31)
the_thread->current_state = STATES_DORMANT;
ffc0b6e0: 38 00 00 01 li r0,1
RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate(
Scheduler_Control *the_scheduler,
Thread_Control *the_thread
)
{
return
ffc0b6e4: 7f e4 fb 78 mr r4,r31
ffc0b6e8: 90 1f 00 10 stw r0,16(r31)
ffc0b6ec: 80 03 00 14 lwz r0,20(r3)
the_thread->Wait.queue = NULL;
ffc0b6f0: 93 5f 00 44 stw r26,68(r31)
ffc0b6f4: 7c 09 03 a6 mtctr r0
the_thread->resource_count = 0;
ffc0b6f8: 93 5f 00 1c stw r26,28(r31)
the_thread->real_priority = priority;
the_thread->Start.initial_priority = priority;
ffc0b6fc: 93 7f 00 b0 stw r27,176(r31)
ffc0b700: 4e 80 04 21 bctrl
sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread );
if ( !sched )
ffc0b704: 7c 7c 1b 79 mr. r28,r3
ffc0b708: 41 82 00 4c beq- ffc0b754 <_Thread_Initialize+0x1d4>
goto failed;
_Thread_Set_priority( the_thread, priority );
ffc0b70c: 7f e3 fb 78 mr r3,r31
ffc0b710: 7f 64 db 78 mr r4,r27
ffc0b714: 48 00 07 01 bl ffc0be14 <_Thread_Set_priority>
Objects_Information *information,
Objects_Control *the_object,
Objects_Name name
)
{
_Objects_Set_local_object(
ffc0b718: a0 1f 00 0a lhz r0,10(r31)
_Thread_Stack_Free( the_thread );
return false;
}
ffc0b71c: 81 3e 00 1c lwz r9,28(r30)
* enabled when we get here. We want to be able to run the
* 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 );
ffc0b720: 7f e3 fb 78 mr r3,r31
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc0b724: 54 00 10 3a rlwinm r0,r0,2,0,29
/*
* Initialize the CPU usage statistics
*/
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_Set_to_zero( &the_thread->cpu_time_used );
ffc0b728: 93 5f 00 84 stw r26,132(r31)
ffc0b72c: 93 5f 00 88 stw r26,136(r31)
ffc0b730: 7f e9 01 2e stwx r31,r9,r0
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
ffc0b734: 93 1f 00 0c stw r24,12(r31)
* enabled when we get here. We want to be able to run the
* 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 );
ffc0b738: 48 00 0c 65 bl ffc0c39c <_User_extensions_Thread_create>
if ( extension_status )
return true;
ffc0b73c: 38 00 00 01 li r0,1
* 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 )
ffc0b740: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b744: 41 be 00 10 beq+ cr7,ffc0b754 <_Thread_Initialize+0x1d4>
ffc0b748: 48 00 00 78 b ffc0b7c0 <_Thread_Initialize+0x240>
* Zero out all the allocated memory fields
*/
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
the_thread->API_Extensions[i] = NULL;
extensions_area = NULL;
ffc0b74c: 3b a0 00 00 li r29,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;
ffc0b750: 3b 80 00 00 li r28,0
extension_status = _User_extensions_Thread_create( the_thread );
if ( extension_status )
return true;
failed:
if ( the_thread->libc_reent )
ffc0b754: 80 7f 01 2c lwz r3,300(r31)
ffc0b758: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b75c: 41 9e 00 08 beq- cr7,ffc0b764 <_Thread_Initialize+0x1e4>
_Workspace_Free( the_thread->libc_reent );
ffc0b760: 48 00 10 61 bl ffc0c7c0 <_Workspace_Free>
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
if ( the_thread->API_Extensions[i] )
ffc0b764: 80 7f 01 30 lwz r3,304(r31)
ffc0b768: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b76c: 41 9e 00 08 beq- cr7,ffc0b774 <_Thread_Initialize+0x1f4>
_Workspace_Free( the_thread->API_Extensions[i] );
ffc0b770: 48 00 10 51 bl ffc0c7c0 <_Workspace_Free>
failed:
if ( the_thread->libc_reent )
_Workspace_Free( the_thread->libc_reent );
for ( i=0 ; i <= THREAD_API_LAST ; i++ )
if ( the_thread->API_Extensions[i] )
ffc0b774: 80 7f 01 34 lwz r3,308(r31)
ffc0b778: 2f 83 00 00 cmpwi cr7,r3,0
ffc0b77c: 41 9e 00 08 beq- cr7,ffc0b784 <_Thread_Initialize+0x204>
_Workspace_Free( the_thread->API_Extensions[i] );
ffc0b780: 48 00 10 41 bl ffc0c7c0 <_Workspace_Free>
if ( extensions_area )
ffc0b784: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0b788: 41 9e 00 0c beq- cr7,ffc0b794 <_Thread_Initialize+0x214>
(void) _Workspace_Free( extensions_area );
ffc0b78c: 7f a3 eb 78 mr r3,r29
ffc0b790: 48 00 10 31 bl ffc0c7c0 <_Workspace_Free>
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( fp_area )
ffc0b794: 2f 97 00 00 cmpwi cr7,r23,0
ffc0b798: 41 9e 00 0c beq- cr7,ffc0b7a4 <_Thread_Initialize+0x224>
(void) _Workspace_Free( fp_area );
ffc0b79c: 7e e3 bb 78 mr r3,r23
ffc0b7a0: 48 00 10 21 bl ffc0c7c0 <_Workspace_Free>
#endif
if ( sched )
ffc0b7a4: 2f 9c 00 00 cmpwi cr7,r28,0
ffc0b7a8: 41 9e 00 0c beq- cr7,ffc0b7b4 <_Thread_Initialize+0x234>
(void) _Workspace_Free( sched );
ffc0b7ac: 7f 83 e3 78 mr r3,r28
ffc0b7b0: 48 00 10 11 bl ffc0c7c0 <_Workspace_Free>
_Thread_Stack_Free( the_thread );
ffc0b7b4: 7f e3 fb 78 mr r3,r31
ffc0b7b8: 48 00 08 11 bl ffc0bfc8 <_Thread_Stack_Free>
return false;
ffc0b7bc: 38 00 00 00 li r0,0
}
ffc0b7c0: 39 61 00 30 addi r11,r1,48
ffc0b7c4: 7c 03 03 78 mr r3,r0
ffc0b7c8: 48 00 da 80 b ffc19248 <_restgpr_23_x>
ffc0ba78 <_Thread_Restart>:
bool _Thread_Restart(
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
ffc0ba78: 7c 2b 0b 78 mr r11,r1
ffc0ba7c: 7c 08 02 a6 mflr r0
ffc0ba80: 94 21 ff e8 stwu r1,-24(r1)
ffc0ba84: 90 01 00 1c stw r0,28(r1)
ffc0ba88: 48 00 fd d1 bl ffc1b858 <_savegpr_31>
_Thread_Restart_self();
return true;
}
return false;
ffc0ba8c: 38 00 00 00 li r0,0
*/
RTEMS_INLINE_ROUTINE bool _States_Is_dormant (
States_Control the_states
)
{
return (the_states & STATES_DORMANT);
ffc0ba90: 81 23 00 10 lwz r9,16(r3)
bool _Thread_Restart(
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
ffc0ba94: 7c 7f 1b 78 mr r31,r3
if ( !_States_Is_dormant( the_thread->current_state ) ) {
ffc0ba98: 71 2b 00 01 andi. r11,r9,1
ffc0ba9c: 40 a2 00 70 bne+ ffc0bb0c <_Thread_Restart+0x94>
_Thread_Set_transient( the_thread );
ffc0baa0: 90 81 00 08 stw r4,8(r1)
ffc0baa4: 90 a1 00 0c stw r5,12(r1)
ffc0baa8: 48 00 01 15 bl ffc0bbbc <_Thread_Set_transient>
_Thread_Reset( the_thread, pointer_argument, numeric_argument );
ffc0baac: 7f e3 fb 78 mr r3,r31
ffc0bab0: 80 81 00 08 lwz r4,8(r1)
ffc0bab4: 80 a1 00 0c lwz r5,12(r1)
ffc0bab8: 48 00 3c e1 bl ffc0f798 <_Thread_Reset>
_Thread_Load_environment( the_thread );
ffc0babc: 7f e3 fb 78 mr r3,r31
ffc0bac0: 48 00 39 91 bl ffc0f450 <_Thread_Load_environment>
_Thread_Ready( the_thread );
ffc0bac4: 7f e3 fb 78 mr r3,r31
ffc0bac8: 48 00 3c 81 bl ffc0f748 <_Thread_Ready>
_User_extensions_Thread_restart( the_thread );
ffc0bacc: 7f e3 fb 78 mr r3,r31
ffc0bad0: 48 00 07 59 bl ffc0c228 <_User_extensions_Thread_restart>
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
ffc0bad4: 3d 20 00 00 lis r9,0
if ( _Thread_Is_executing ( the_thread ) )
ffc0bad8: 81 29 31 50 lwz r9,12624(r9)
_Thread_Restart_self();
return true;
ffc0badc: 38 00 00 01 li r0,1
_Thread_Ready( the_thread );
_User_extensions_Thread_restart( the_thread );
if ( _Thread_Is_executing ( the_thread ) )
ffc0bae0: 7f 9f 48 00 cmpw cr7,r31,r9
ffc0bae4: 40 be 00 28 bne+ cr7,ffc0bb0c <_Thread_Restart+0x94>
*/
RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void )
{
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( _Thread_Executing->fp_context != NULL )
ffc0bae8: 80 1f 01 28 lwz r0,296(r31)
ffc0baec: 2f 80 00 00 cmpwi cr7,r0,0
ffc0baf0: 41 9e 00 0c beq- cr7,ffc0bafc <_Thread_Restart+0x84> <== NEVER TAKEN
_Context_Restore_fp( &_Thread_Executing->fp_context );
ffc0baf4: 38 7f 01 28 addi r3,r31,296
ffc0baf8: 48 00 fe c9 bl ffc1b9c0 <_CPU_Context_restore_fp>
#endif
_CPU_Context_Restart_self( &_Thread_Executing->Registers );
ffc0bafc: 3d 20 00 00 lis r9,0
ffc0bb00: 80 69 31 50 lwz r3,12624(r9)
ffc0bb04: 38 63 00 c8 addi r3,r3,200
ffc0bb08: 48 01 00 79 bl ffc1bb80 <_CPU_Context_restore>
return true;
}
return false;
}
ffc0bb0c: 39 61 00 18 addi r11,r1,24
ffc0bb10: 7c 03 03 78 mr r3,r0
ffc0bb14: 4b ff 52 44 b ffc00d58 <_restgpr_31_x>
ffc0e0e4 <_Thread_Resume>:
void _Thread_Resume(
Thread_Control *the_thread,
bool force
)
{
ffc0e0e4: 7c 2b 0b 78 mr r11,r1
ffc0e0e8: 7c 08 02 a6 mflr r0
ffc0e0ec: 94 21 ff f0 stwu r1,-16(r1)
ffc0e0f0: 7c 64 1b 78 mr r4,r3
ffc0e0f4: 90 01 00 14 stw r0,20(r1)
ffc0e0f8: 4b ff 25 4d bl ffc00644 <_savegpr_31>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0e0fc: 7f e0 00 a6 mfmsr r31
ffc0e100: 7c 10 42 a6 mfsprg r0,0
ffc0e104: 7f e0 00 78 andc r0,r31,r0
ffc0e108: 7c 00 01 24 mtmsr r0
ISR_Level level;
States_Control current_state;
_ISR_Disable( level );
current_state = the_thread->current_state;
ffc0e10c: 80 03 00 10 lwz r0,16(r3)
if ( current_state & STATES_SUSPENDED ) {
ffc0e110: 70 09 00 02 andi. r9,r0,2
ffc0e114: 41 82 00 28 beq- ffc0e13c <_Thread_Resume+0x58> <== NEVER TAKEN
RTEMS_INLINE_ROUTINE States_Control _States_Clear (
States_Control states_to_clear,
States_Control current_state
)
{
return (current_state & ~states_to_clear);
ffc0e118: 54 00 07 fa rlwinm r0,r0,0,31,29
current_state =
the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state);
if ( _States_Is_ready( current_state ) ) {
ffc0e11c: 2f 80 00 00 cmpwi cr7,r0,0
_ISR_Disable( level );
current_state = the_thread->current_state;
if ( current_state & STATES_SUSPENDED ) {
current_state =
the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state);
ffc0e120: 90 03 00 10 stw r0,16(r3)
if ( _States_Is_ready( current_state ) ) {
ffc0e124: 40 be 00 18 bne+ cr7,ffc0e13c <_Thread_Resume+0x58>
RTEMS_INLINE_ROUTINE void _Scheduler_Unblock(
Scheduler_Control *the_scheduler,
Thread_Control *the_thread
)
{
the_scheduler->Operations.unblock( the_scheduler, the_thread );
ffc0e128: 3c 60 00 00 lis r3,0
ffc0e12c: 38 63 2d 80 addi r3,r3,11648
ffc0e130: 80 03 00 10 lwz r0,16(r3)
ffc0e134: 7c 09 03 a6 mtctr r0
ffc0e138: 4e 80 04 21 bctrl
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0e13c: 7f e0 01 24 mtmsr r31
_Scheduler_Unblock( &_Scheduler, the_thread );
}
}
_ISR_Enable( level );
}
ffc0e140: 39 61 00 10 addi r11,r1,16
ffc0e144: 4b ff 25 4c b ffc00690 <_restgpr_31_x>
ffc0f940 <_Thread_Tickle_timeslice>:
*
* Output parameters: NONE
*/
void _Thread_Tickle_timeslice( void )
{
ffc0f940: 7c 08 02 a6 mflr r0
ffc0f944: 7c 2b 0b 78 mr r11,r1
ffc0f948: 94 21 ff f0 stwu r1,-16(r1)
Thread_Control *executing;
executing = _Thread_Executing;
ffc0f94c: 3d 20 00 00 lis r9,0
*
* Output parameters: NONE
*/
void _Thread_Tickle_timeslice( void )
{
ffc0f950: 90 01 00 14 stw r0,20(r1)
ffc0f954: 4b ff 17 85 bl ffc010d8 <_savegpr_31>
Thread_Control *executing;
executing = _Thread_Executing;
ffc0f958: 83 e9 32 10 lwz r31,12816(r9)
/*
* If the thread is not preemptible or is not ready, then
* just return.
*/
if ( !executing->is_preemptible )
ffc0f95c: 88 1f 00 74 lbz r0,116(r31)
ffc0f960: 2f 80 00 00 cmpwi cr7,r0,0
ffc0f964: 41 9e 00 8c beq- cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
return;
if ( !_States_Is_ready( executing->current_state ) )
ffc0f968: 80 1f 00 10 lwz r0,16(r31)
ffc0f96c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0f970: 40 9e 00 80 bne- cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
/*
* The cpu budget algorithm determines what happens next.
*/
switch ( executing->budget_algorithm ) {
ffc0f974: 80 1f 00 7c lwz r0,124(r31)
ffc0f978: 2b 80 00 01 cmplwi cr7,r0,1
ffc0f97c: 41 9c 00 74 blt- cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
ffc0f980: 2b 80 00 02 cmplwi cr7,r0,2
ffc0f984: 40 9d 00 10 ble- cr7,ffc0f994 <_Thread_Tickle_timeslice+0x54>
ffc0f988: 2f 80 00 03 cmpwi cr7,r0,3
ffc0f98c: 40 be 00 64 bne+ cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0><== NEVER TAKEN
ffc0f990: 48 00 00 3c b ffc0f9cc <_Thread_Tickle_timeslice+0x8c>
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 ) {
ffc0f994: 81 3f 00 78 lwz r9,120(r31)
ffc0f998: 38 09 ff ff addi r0,r9,-1
ffc0f99c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0f9a0: 90 1f 00 78 stw r0,120(r31)
ffc0f9a4: 41 bd 00 4c bgt+ cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
* always operates on the scheduler that 'owns' the currently executing
* thread.
*/
RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void )
{
_Scheduler.Operations.yield( &_Scheduler );
ffc0f9a8: 3c 60 00 00 lis r3,0
ffc0f9ac: 38 63 2d e0 addi r3,r3,11744
ffc0f9b0: 80 03 00 08 lwz r0,8(r3)
ffc0f9b4: 7c 09 03 a6 mtctr r0
ffc0f9b8: 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;
ffc0f9bc: 3d 20 00 00 lis r9,0
ffc0f9c0: 80 09 27 a8 lwz r0,10152(r9)
ffc0f9c4: 90 1f 00 78 stw r0,120(r31)
ffc0f9c8: 48 00 00 28 b ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
}
break;
#if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT)
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
if ( --executing->cpu_time_budget == 0 )
ffc0f9cc: 81 3f 00 78 lwz r9,120(r31)
ffc0f9d0: 38 09 ff ff addi r0,r9,-1
ffc0f9d4: 2f 80 00 00 cmpwi cr7,r0,0
ffc0f9d8: 90 1f 00 78 stw r0,120(r31)
ffc0f9dc: 40 be 00 14 bne+ cr7,ffc0f9f0 <_Thread_Tickle_timeslice+0xb0>
(*executing->budget_callout)( executing );
ffc0f9e0: 80 1f 00 80 lwz r0,128(r31)
ffc0f9e4: 7f e3 fb 78 mr r3,r31
ffc0f9e8: 7c 09 03 a6 mtctr r0
ffc0f9ec: 4e 80 04 21 bctrl
break;
#endif
}
}
ffc0f9f0: 39 61 00 10 addi r11,r1,16
ffc0f9f4: 4b ff 17 30 b ffc01124 <_restgpr_31_x>
ffc0bd5c <_Thread_queue_Requeue>:
void _Thread_queue_Requeue(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread
)
{
ffc0bd5c: 94 21 ff d8 stwu r1,-40(r1)
ffc0bd60: 7c 08 02 a6 mflr r0
ffc0bd64: 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 )
ffc0bd68: 7c 7f 1b 79 mr. r31,r3
void _Thread_queue_Requeue(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread
)
{
ffc0bd6c: 7c 9e 23 78 mr r30,r4
ffc0bd70: 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 )
ffc0bd74: 41 82 00 54 beq- ffc0bdc8 <_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 ) {
ffc0bd78: 80 1f 00 34 lwz r0,52(r31)
ffc0bd7c: 2f 80 00 01 cmpwi cr7,r0,1
ffc0bd80: 40 be 00 48 bne+ cr7,ffc0bdc8 <_Thread_queue_Requeue+0x6c><== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0bd84: 7f a0 00 a6 mfmsr r29
ffc0bd88: 7d 30 42 a6 mfsprg r9,0
ffc0bd8c: 7f a9 48 78 andc r9,r29,r9
ffc0bd90: 7d 20 01 24 mtmsr r9
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 ) ) {
ffc0bd94: 3d 60 00 03 lis r11,3
ffc0bd98: 81 24 00 10 lwz r9,16(r4)
ffc0bd9c: 61 6b be e0 ori r11,r11,48864
ffc0bda0: 7d 6a 48 39 and. r10,r11,r9
ffc0bda4: 41 a2 00 20 beq+ ffc0bdc4 <_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;
ffc0bda8: 90 1f 00 30 stw r0,48(r31)
_Thread_queue_Enter_critical_section( tq );
_Thread_queue_Extract_priority_helper( tq, the_thread, true );
ffc0bdac: 38 a0 00 01 li r5,1
ffc0bdb0: 48 00 69 e5 bl ffc12794 <_Thread_queue_Extract_priority_helper>
(void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored );
ffc0bdb4: 7f e3 fb 78 mr r3,r31
ffc0bdb8: 7f c4 f3 78 mr r4,r30
ffc0bdbc: 38 a1 00 08 addi r5,r1,8
ffc0bdc0: 4b ff fd 09 bl ffc0bac8 <_Thread_queue_Enqueue_priority>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0bdc4: 7f a0 01 24 mtmsr r29
}
_ISR_Enable( level );
}
}
ffc0bdc8: 39 61 00 28 addi r11,r1,40
ffc0bdcc: 48 00 d4 94 b ffc19260 <_restgpr_29_x>
ffc0bdd0 <_Thread_queue_Timeout>:
void _Thread_queue_Timeout(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0bdd0: 94 21 ff e8 stwu r1,-24(r1)
ffc0bdd4: 7c 08 02 a6 mflr r0
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0bdd8: 38 81 00 08 addi r4,r1,8
void _Thread_queue_Timeout(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
ffc0bddc: 90 01 00 1c stw r0,28(r1)
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
ffc0bde0: 4b ff f7 01 bl ffc0b4e0 <_Thread_Get>
switch ( location ) {
ffc0bde4: 80 01 00 08 lwz r0,8(r1)
ffc0bde8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0bdec: 40 9e 00 18 bne- cr7,ffc0be04 <_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 );
ffc0bdf0: 48 00 6a 99 bl ffc12888 <_Thread_queue_Process_timeout>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
ffc0bdf4: 3d 20 00 00 lis r9,0
ffc0bdf8: 81 69 27 88 lwz r11,10120(r9)
ffc0bdfc: 38 0b ff ff addi r0,r11,-1
ffc0be00: 90 09 27 88 stw r0,10120(r9)
_Thread_Unnest_dispatch();
break;
}
}
ffc0be04: 80 01 00 1c lwz r0,28(r1)
ffc0be08: 38 21 00 18 addi r1,r1,24
ffc0be0c: 7c 08 03 a6 mtlr r0
ffc0be10: 4e 80 00 20 blr
ffc18fc4 <_Timer_server_Body>:
* @a arg points to the corresponding timer server control block.
*/
static rtems_task _Timer_server_Body(
rtems_task_argument arg
)
{
ffc18fc4: 94 21 ff a0 stwu r1,-96(r1)
ffc18fc8: 7c 08 02 a6 mflr r0
ffc18fcc: 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;
ffc18fd0: 3a a1 00 0c addi r21,r1,12
head->previous = NULL;
tail->previous = head;
ffc18fd4: 3a 41 00 08 addi r18,r1,8
ffc18fd8: 90 01 00 64 stw r0,100(r1)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc18fdc: 3b 81 00 14 addi r28,r1,20
head->previous = NULL;
ffc18fe0: 38 00 00 00 li r0,0
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc18fe4: 3b 61 00 18 addi r27,r1,24
ffc18fe8: 92 a1 00 08 stw r21,8(r1)
ffc18fec: 7c 7f 1b 78 mr r31,r3
head->previous = NULL;
ffc18ff0: 90 01 00 0c stw r0,12(r1)
static void _Timer_server_Process_interval_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
ffc18ff4: 3e 60 00 00 lis r19,0
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc18ff8: 3b 43 00 30 addi r26,r3,48
tail->previous = head;
ffc18ffc: 92 41 00 10 stw r18,16(r1)
static void _Timer_server_Process_tod_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
ffc19000: 3e 80 00 00 lis r20,0
/*
* 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 );
ffc19004: 3b a3 00 68 addi r29,r3,104
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc19008: 93 61 00 14 stw r27,20(r1)
_ISR_Disable( level );
tmp = ts->insert_chain;
if ( _Chain_Is_empty( insert_chain ) ) {
ts->insert_chain = NULL;
do_loop = false;
ffc1900c: 3a c0 00 00 li r22,0
_Thread_Set_state( ts->thread, STATES_DELAYING );
_Timer_server_Reset_interval_system_watchdog( ts );
_Timer_server_Reset_tod_system_watchdog( ts );
_Thread_Enable_dispatch();
ts->active = true;
ffc19010: 3a e0 00 01 li r23,1
head->previous = NULL;
ffc19014: 90 01 00 18 stw r0,24(r1)
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
ffc19018: 3b 03 00 08 addi r24,r3,8
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
ffc1901c: 3b 23 00 40 addi r25,r3,64
tail->previous = head;
ffc19020: 93 81 00 1c stw r28,28(r1)
Chain_Control *tmp;
/*
* 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;
ffc19024: 92 5f 00 78 stw r18,120(r31)
static void _Timer_server_Process_interval_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
ffc19028: 80 13 28 c0 lwz r0,10432(r19)
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc1902c: 7f 85 e3 78 mr r5,r28
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
/*
* We assume adequate unsigned arithmetic here.
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
ffc19030: 80 9f 00 3c lwz r4,60(r31)
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc19034: 7f 43 d3 78 mr r3,r26
/*
* We assume adequate unsigned arithmetic here.
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
ffc19038: 90 1f 00 3c stw r0,60(r31)
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
ffc1903c: 7c 84 00 50 subf r4,r4,r0
ffc19040: 48 00 4b 6d bl ffc1dbac <_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();
ffc19044: 83 d4 28 9c lwz r30,10396(r20)
Watchdog_Interval last_snapshot = watchdogs->last_snapshot;
ffc19048: 80 bf 00 74 lwz r5,116(r31)
/*
* 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 ) {
ffc1904c: 7f 9e 28 40 cmplw cr7,r30,r5
ffc19050: 40 bd 00 18 ble+ cr7,ffc19068 <_Timer_server_Body+0xa4>
/*
* 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 );
ffc19054: 7c 85 f0 50 subf r4,r5,r30
ffc19058: 7f a3 eb 78 mr r3,r29
ffc1905c: 7f 85 e3 78 mr r5,r28
ffc19060: 48 00 4b 4d bl ffc1dbac <_Watchdog_Adjust_to_chain>
ffc19064: 48 00 00 18 b ffc1907c <_Timer_server_Body+0xb8>
} else if ( snapshot < last_snapshot ) {
ffc19068: 40 bc 00 14 bge+ cr7,ffc1907c <_Timer_server_Body+0xb8>
/*
* 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 );
ffc1906c: 7f a3 eb 78 mr r3,r29
ffc19070: 38 80 00 01 li r4,1
ffc19074: 7c be 28 50 subf r5,r30,r5
ffc19078: 48 00 4a 7d bl ffc1daf4 <_Watchdog_Adjust>
}
watchdogs->last_snapshot = snapshot;
ffc1907c: 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 );
ffc19080: 80 7f 00 78 lwz r3,120(r31)
ffc19084: 48 00 0b d1 bl ffc19c54 <_Chain_Get>
if ( timer == NULL ) {
ffc19088: 7c 7e 1b 79 mr. r30,r3
ffc1908c: 41 82 00 2c beq- ffc190b8 <_Timer_server_Body+0xf4>
static void _Timer_server_Insert_timer(
Timer_server_Control *ts,
Timer_Control *timer
)
{
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
ffc19090: 80 1e 00 38 lwz r0,56(r30)
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
ffc19094: 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 ) {
ffc19098: 2f 80 00 01 cmpwi cr7,r0,1
ffc1909c: 41 9e 00 10 beq- cr7,ffc190ac <_Timer_server_Body+0xe8>
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
ffc190a0: 2f 80 00 03 cmpwi cr7,r0,3
ffc190a4: 40 9e ff dc bne+ cr7,ffc19080 <_Timer_server_Body+0xbc> <== NEVER TAKEN
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
ffc190a8: 7f a3 eb 78 mr r3,r29
ffc190ac: 38 9e 00 10 addi r4,r30,16
ffc190b0: 48 00 4b b1 bl ffc1dc60 <_Watchdog_Insert>
ffc190b4: 4b ff ff cc b ffc19080 <_Timer_server_Body+0xbc>
* of zero it will be processed in the next iteration of the timer server
* body loop.
*/
_Timer_server_Process_insertions( ts );
_ISR_Disable( level );
ffc190b8: 4b ff fe 25 bl ffc18edc <ppc_interrupt_disable>
tmp = ts->insert_chain;
if ( _Chain_Is_empty( insert_chain ) ) {
ffc190bc: 81 21 00 08 lwz r9,8(r1)
* body loop.
*/
_Timer_server_Process_insertions( ts );
_ISR_Disable( level );
tmp = ts->insert_chain;
ffc190c0: 80 1f 00 78 lwz r0,120(r31)
if ( _Chain_Is_empty( insert_chain ) ) {
ffc190c4: 38 00 00 01 li r0,1
ffc190c8: 7f 89 a8 00 cmpw cr7,r9,r21
ffc190cc: 40 be 00 0c bne+ cr7,ffc190d8 <_Timer_server_Body+0x114>
ts->insert_chain = NULL;
ffc190d0: 93 df 00 78 stw r30,120(r31)
do_loop = false;
ffc190d4: 38 00 00 00 li r0,0
ffc190d8: 7c 60 01 24 mtmsr r3
* 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;
while ( do_loop ) {
ffc190dc: 2f 80 00 00 cmpwi cr7,r0,0
ffc190e0: 40 9e ff 48 bne+ cr7,ffc19028 <_Timer_server_Body+0x64>
_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 ) ) {
ffc190e4: 81 21 00 14 lwz r9,20(r1)
ffc190e8: 7f 89 d8 00 cmpw cr7,r9,r27
ffc190ec: 41 9e 00 50 beq- cr7,ffc1913c <_Timer_server_Body+0x178>
/*
* It is essential that interrupts are disable here since an interrupt
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
ffc190f0: 4b ff fd ed bl ffc18edc <ppc_interrupt_disable>
initialized = false;
}
#endif
return status;
}
ffc190f4: 81 21 00 14 lwz r9,20(r1)
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
Chain_Control *the_chain
)
{
if ( !_Chain_Is_empty(the_chain))
ffc190f8: 7f 89 d8 00 cmpw cr7,r9,r27
ffc190fc: 41 9e 00 38 beq- cr7,ffc19134 <_Timer_server_Body+0x170>
* It is essential that interrupts are disable here since an interrupt
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
if ( watchdog != NULL ) {
ffc19100: 2f 89 00 00 cmpwi cr7,r9,0
Chain_Control *the_chain
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *old_first = head->next;
Chain_Node *new_first = old_first->next;
ffc19104: 81 69 00 00 lwz r11,0(r9)
head->next = new_first;
ffc19108: 91 61 00 14 stw r11,20(r1)
new_first->previous = head;
ffc1910c: 93 8b 00 04 stw r28,4(r11)
ffc19110: 41 9e 00 24 beq- cr7,ffc19134 <_Timer_server_Body+0x170><== NEVER TAKEN
watchdog->state = WATCHDOG_INACTIVE;
ffc19114: 92 c9 00 08 stw r22,8(r9)
ffc19118: 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 );
ffc1911c: 80 09 00 1c lwz r0,28(r9)
ffc19120: 80 69 00 20 lwz r3,32(r9)
ffc19124: 80 89 00 24 lwz r4,36(r9)
ffc19128: 7c 09 03 a6 mtctr r0
ffc1912c: 4e 80 04 21 bctrl
}
ffc19130: 4b ff ff c0 b ffc190f0 <_Timer_server_Body+0x12c>
ffc19134: 7c 60 01 24 mtmsr r3
ffc19138: 4b ff fe ec b ffc19024 <_Timer_server_Body+0x60>
} else {
ts->active = false;
ffc1913c: 98 1f 00 7c stb r0,124(r31)
/*
* Block until there is something to do.
*/
_Thread_Disable_dispatch();
ffc19140: 4b ff fd b1 bl ffc18ef0 <_Thread_Disable_dispatch>
_Thread_Set_state( ts->thread, STATES_DELAYING );
ffc19144: 80 7f 00 00 lwz r3,0(r31)
ffc19148: 38 80 00 08 li r4,8
ffc1914c: 48 00 41 49 bl ffc1d294 <_Thread_Set_state>
_Timer_server_Reset_interval_system_watchdog( ts );
ffc19150: 7f e3 fb 78 mr r3,r31
ffc19154: 4b ff fd b1 bl ffc18f04 <_Timer_server_Reset_interval_system_watchdog>
_Timer_server_Reset_tod_system_watchdog( ts );
ffc19158: 7f e3 fb 78 mr r3,r31
ffc1915c: 4b ff fe 09 bl ffc18f64 <_Timer_server_Reset_tod_system_watchdog>
_Thread_Enable_dispatch();
ffc19160: 48 00 36 a1 bl ffc1c800 <_Thread_Enable_dispatch>
ts->active = true;
ffc19164: 9a ff 00 7c stb r23,124(r31)
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
ffc19168: 7f 03 c3 78 mr r3,r24
ffc1916c: 48 00 4c 49 bl ffc1ddb4 <_Watchdog_Remove>
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
ffc19170: 7f 23 cb 78 mr r3,r25
ffc19174: 48 00 4c 41 bl ffc1ddb4 <_Watchdog_Remove>
ffc19178: 4b ff fe ac b ffc19024 <_Timer_server_Body+0x60>
ffc1917c <_Timer_server_Schedule_operation_method>:
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
ffc1917c: 94 21 ff f0 stwu r1,-16(r1)
ffc19180: 7c 08 02 a6 mflr r0
ffc19184: 90 01 00 14 stw r0,20(r1)
if ( ts->insert_chain == NULL ) {
ffc19188: 80 03 00 78 lwz r0,120(r3)
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
ffc1918c: bf c1 00 08 stmw r30,8(r1)
ffc19190: 7c 7f 1b 78 mr r31,r3
if ( ts->insert_chain == NULL ) {
ffc19194: 2f 80 00 00 cmpwi cr7,r0,0
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
ffc19198: 7c 9e 23 78 mr r30,r4
if ( ts->insert_chain == NULL ) {
ffc1919c: 40 be 01 00 bne+ cr7,ffc1929c <_Timer_server_Schedule_operation_method+0x120>
* is the reference point for the delta chain. Thus if we do not update the
* reference point we have to add DT to the initial delta of the watchdog
* being inserted. This could result in an integer overflow.
*/
_Thread_Disable_dispatch();
ffc191a0: 4b ff fd 51 bl ffc18ef0 <_Thread_Disable_dispatch>
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
ffc191a4: 80 1e 00 38 lwz r0,56(r30)
ffc191a8: 2f 80 00 01 cmpwi cr7,r0,1
ffc191ac: 40 be 00 6c bne+ cr7,ffc19218 <_Timer_server_Schedule_operation_method+0x9c>
/*
* We have to advance the last known ticks value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
ffc191b0: 4b ff fd 2d bl ffc18edc <ppc_interrupt_disable>
snapshot = _Watchdog_Ticks_since_boot;
ffc191b4: 3d 20 00 00 lis r9,0
ffc191b8: 80 09 28 c0 lwz r0,10432(r9)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc191bc: 39 7f 00 34 addi r11,r31,52
initialized = false;
}
#endif
return status;
}
ffc191c0: 81 3f 00 30 lwz r9,48(r31)
* We have to advance the last known ticks value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
snapshot = _Watchdog_Ticks_since_boot;
last_snapshot = ts->Interval_watchdogs.last_snapshot;
ffc191c4: 81 5f 00 3c lwz r10,60(r31)
if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) {
ffc191c8: 7f 89 58 00 cmpw cr7,r9,r11
ffc191cc: 41 9e 00 20 beq- cr7,ffc191ec <_Timer_server_Schedule_operation_method+0x70>
/*
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
delta_interval = first_watchdog->delta_interval;
ffc191d0: 81 09 00 10 lwz r8,16(r9)
first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain );
/*
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
ffc191d4: 7d 4a 00 50 subf r10,r10,r0
delta_interval = first_watchdog->delta_interval;
if (delta_interval > delta) {
delta_interval -= delta;
} else {
delta_interval = 0;
ffc191d8: 39 60 00 00 li r11,0
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
delta_interval = first_watchdog->delta_interval;
if (delta_interval > delta) {
ffc191dc: 7f 88 50 40 cmplw cr7,r8,r10
ffc191e0: 40 9d 00 08 ble- cr7,ffc191e8 <_Timer_server_Schedule_operation_method+0x6c>
delta_interval -= delta;
ffc191e4: 7d 6a 40 50 subf r11,r10,r8
} else {
delta_interval = 0;
}
first_watchdog->delta_interval = delta_interval;
ffc191e8: 91 69 00 10 stw r11,16(r9)
}
ts->Interval_watchdogs.last_snapshot = snapshot;
ffc191ec: 90 1f 00 3c stw r0,60(r31)
ffc191f0: 7c 60 01 24 mtmsr r3
_ISR_Enable( level );
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
ffc191f4: 38 7f 00 30 addi r3,r31,48
ffc191f8: 38 9e 00 10 addi r4,r30,16
ffc191fc: 48 00 4a 65 bl ffc1dc60 <_Watchdog_Insert>
if ( !ts->active ) {
ffc19200: 88 1f 00 7c lbz r0,124(r31)
ffc19204: 2f 80 00 00 cmpwi cr7,r0,0
ffc19208: 40 be 00 8c bne+ cr7,ffc19294 <_Timer_server_Schedule_operation_method+0x118>
_Timer_server_Reset_interval_system_watchdog( ts );
ffc1920c: 7f e3 fb 78 mr r3,r31
ffc19210: 4b ff fc f5 bl ffc18f04 <_Timer_server_Reset_interval_system_watchdog>
ffc19214: 48 00 00 80 b ffc19294 <_Timer_server_Schedule_operation_method+0x118>
}
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
ffc19218: 2f 80 00 03 cmpwi cr7,r0,3
ffc1921c: 40 be 00 78 bne+ cr7,ffc19294 <_Timer_server_Schedule_operation_method+0x118>
/*
* We have to advance the last known seconds value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
ffc19220: 4b ff fc bd bl ffc18edc <ppc_interrupt_disable>
snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
ffc19224: 3d 20 00 00 lis r9,0
last_snapshot = ts->TOD_watchdogs.last_snapshot;
ffc19228: 81 1f 00 74 lwz r8,116(r31)
/*
* We have to advance the last known seconds value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
ffc1922c: 80 09 28 9c lwz r0,10396(r9)
ffc19230: 39 7f 00 6c addi r11,r31,108
initialized = false;
}
#endif
return status;
}
ffc19234: 81 3f 00 68 lwz r9,104(r31)
* the watchdog chain accordingly.
*/
_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 ) ) {
ffc19238: 7f 89 58 00 cmpw cr7,r9,r11
ffc1923c: 41 9e 00 30 beq- cr7,ffc1926c <_Timer_server_Schedule_operation_method+0xf0>
first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain );
delta_interval = first_watchdog->delta_interval;
if ( snapshot > last_snapshot ) {
ffc19240: 7f 80 40 40 cmplw cr7,r0,r8
_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;
ffc19244: 81 49 00 10 lwz r10,16(r9)
}
} else {
/*
* Someone put us in the past.
*/
delta = last_snapshot - snapshot;
ffc19248: 7d 6a 42 14 add r11,r10,r8
delta_interval += delta;
ffc1924c: 7d 60 58 50 subf r11,r0,r11
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;
if ( snapshot > last_snapshot ) {
ffc19250: 40 9d 00 18 ble- cr7,ffc19268 <_Timer_server_Schedule_operation_method+0xec>
/*
* We advanced in time.
*/
delta = snapshot - last_snapshot;
ffc19254: 7d 08 00 50 subf r8,r8,r0
if (delta_interval > delta) {
ffc19258: 7f 8a 40 40 cmplw cr7,r10,r8
delta_interval -= delta;
} else {
delta_interval = 0;
ffc1925c: 39 60 00 00 li r11,0
if ( snapshot > last_snapshot ) {
/*
* We advanced in time.
*/
delta = snapshot - last_snapshot;
if (delta_interval > delta) {
ffc19260: 40 9d 00 08 ble- cr7,ffc19268 <_Timer_server_Schedule_operation_method+0xec><== NEVER TAKEN
delta_interval -= delta;
ffc19264: 7d 68 50 50 subf r11,r8,r10
* Someone put us in the past.
*/
delta = last_snapshot - snapshot;
delta_interval += delta;
}
first_watchdog->delta_interval = delta_interval;
ffc19268: 91 69 00 10 stw r11,16(r9)
}
ts->TOD_watchdogs.last_snapshot = snapshot;
ffc1926c: 90 1f 00 74 stw r0,116(r31)
ffc19270: 7c 60 01 24 mtmsr r3
_ISR_Enable( level );
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
ffc19274: 38 7f 00 68 addi r3,r31,104
ffc19278: 38 9e 00 10 addi r4,r30,16
ffc1927c: 48 00 49 e5 bl ffc1dc60 <_Watchdog_Insert>
if ( !ts->active ) {
ffc19280: 88 1f 00 7c lbz r0,124(r31)
ffc19284: 2f 80 00 00 cmpwi cr7,r0,0
ffc19288: 40 be 00 0c bne+ cr7,ffc19294 <_Timer_server_Schedule_operation_method+0x118>
_Timer_server_Reset_tod_system_watchdog( ts );
ffc1928c: 7f e3 fb 78 mr r3,r31
ffc19290: 4b ff fc d5 bl ffc18f64 <_Timer_server_Reset_tod_system_watchdog>
}
}
_Thread_Enable_dispatch();
ffc19294: 48 00 35 6d bl ffc1c800 <_Thread_Enable_dispatch>
ffc19298: 48 00 00 0c b ffc192a4 <_Timer_server_Schedule_operation_method+0x128>
* 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 );
ffc1929c: 80 63 00 78 lwz r3,120(r3)
ffc192a0: 48 00 09 5d bl ffc19bfc <_Chain_Append>
}
}
ffc192a4: 39 61 00 10 addi r11,r1,16
ffc192a8: 4b ff 50 10 b ffc0e2b8 <_restgpr_30_x>
ffc0c1e4 <_User_extensions_Handler_initialization>:
#include <rtems/score/userext.h>
#include <rtems/score/wkspace.h>
#include <string.h>
void _User_extensions_Handler_initialization(void)
{
ffc0c1e4: 94 21 ff e8 stwu r1,-24(r1)
ffc0c1e8: 7c 08 02 a6 mflr r0
User_extensions_Control *extension;
uint32_t i;
uint32_t number_of_extensions;
User_extensions_Table *initial_extensions;
number_of_extensions = Configuration.number_of_initial_extensions;
ffc0c1ec: 3d 20 00 00 lis r9,0
#include <rtems/score/userext.h>
#include <rtems/score/wkspace.h>
#include <string.h>
void _User_extensions_Handler_initialization(void)
{
ffc0c1f0: 90 01 00 1c stw r0,28(r1)
User_extensions_Control *extension;
uint32_t i;
uint32_t number_of_extensions;
User_extensions_Table *initial_extensions;
number_of_extensions = Configuration.number_of_initial_extensions;
ffc0c1f4: 39 29 20 88 addi r9,r9,8328
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc0c1f8: 3d 60 00 00 lis r11,0
#include <rtems/score/userext.h>
#include <rtems/score/wkspace.h>
#include <string.h>
void _User_extensions_Handler_initialization(void)
{
ffc0c1fc: bf 81 00 08 stmw r28,8(r1)
uint32_t i;
uint32_t number_of_extensions;
User_extensions_Table *initial_extensions;
number_of_extensions = Configuration.number_of_initial_extensions;
initial_extensions = Configuration.User_extension_table;
ffc0c200: 83 a9 00 40 lwz r29,64(r9)
User_extensions_Control *extension;
uint32_t i;
uint32_t number_of_extensions;
User_extensions_Table *initial_extensions;
number_of_extensions = Configuration.number_of_initial_extensions;
ffc0c204: 83 c9 00 3c lwz r30,60(r9)
ffc0c208: 39 2b 2e 34 addi r9,r11,11828
initial_extensions = Configuration.User_extension_table;
_Chain_Initialize_empty( &_User_extensions_List );
_Chain_Initialize_empty( &_User_extensions_Switches_list );
if ( initial_extensions ) {
ffc0c20c: 2f 9d 00 00 cmpwi cr7,r29,0
head->previous = NULL;
tail->previous = head;
ffc0c210: 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;
ffc0c214: 38 09 00 04 addi r0,r9,4
ffc0c218: 90 0b 2e 34 stw r0,11828(r11)
head->previous = NULL;
ffc0c21c: 38 00 00 00 li r0,0
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc0c220: 3d 60 00 00 lis r11,0
head->previous = NULL;
ffc0c224: 90 09 00 04 stw r0,4(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc0c228: 39 2b 2c f0 addi r9,r11,11504
ffc0c22c: 39 49 00 04 addi r10,r9,4
ffc0c230: 91 4b 2c f0 stw r10,11504(r11)
head->previous = NULL;
ffc0c234: 90 09 00 04 stw r0,4(r9)
tail->previous = head;
ffc0c238: 91 29 00 08 stw r9,8(r9)
ffc0c23c: 41 9e 00 54 beq- cr7,ffc0c290 <_User_extensions_Handler_initialization+0xac><== NEVER TAKEN
extension = (User_extensions_Control *)
_Workspace_Allocate_or_fatal_error(
number_of_extensions * sizeof( User_extensions_Control )
ffc0c240: 1f 9e 00 34 mulli r28,r30,52
_Chain_Initialize_empty( &_User_extensions_List );
_Chain_Initialize_empty( &_User_extensions_Switches_list );
if ( initial_extensions ) {
extension = (User_extensions_Control *)
_Workspace_Allocate_or_fatal_error(
ffc0c244: 7f 83 e3 78 mr r3,r28
ffc0c248: 48 00 05 a5 bl ffc0c7ec <_Workspace_Allocate_or_fatal_error>
number_of_extensions * sizeof( User_extensions_Control )
);
memset (
ffc0c24c: 7f 85 e3 78 mr r5,r28
ffc0c250: 38 80 00 00 li r4,0
_Chain_Initialize_empty( &_User_extensions_List );
_Chain_Initialize_empty( &_User_extensions_Switches_list );
if ( initial_extensions ) {
extension = (User_extensions_Control *)
_Workspace_Allocate_or_fatal_error(
ffc0c254: 7c 7f 1b 78 mr r31,r3
number_of_extensions * sizeof( User_extensions_Control )
);
memset (
ffc0c258: 48 00 8f 79 bl ffc151d0 <memset>
extension,
0,
number_of_extensions * sizeof( User_extensions_Control )
);
for ( i = 0 ; i < number_of_extensions ; i++ ) {
ffc0c25c: 3b 80 00 00 li r28,0
ffc0c260: 48 00 00 28 b ffc0c288 <_User_extensions_Handler_initialization+0xa4>
#include <rtems/config.h>
#include <rtems/score/userext.h>
#include <rtems/score/wkspace.h>
#include <string.h>
void _User_extensions_Handler_initialization(void)
ffc0c264: 57 83 28 34 rlwinm r3,r28,5,0,26
RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table(
User_extensions_Control *extension,
const User_extensions_Table *extension_table
)
{
extension->Callouts = *extension_table;
ffc0c268: 38 9f 00 14 addi r4,r31,20
ffc0c26c: 7c 7d 1a 14 add r3,r29,r3
ffc0c270: 7c a3 04 aa lswi r5,r3,32
ffc0c274: 7c a4 05 aa stswi r5,r4,32
_User_extensions_Add_set( extension );
ffc0c278: 7f e3 fb 78 mr r3,r31
extension,
0,
number_of_extensions * sizeof( User_extensions_Control )
);
for ( i = 0 ; i < number_of_extensions ; i++ ) {
ffc0c27c: 3b 9c 00 01 addi r28,r28,1
ffc0c280: 48 00 67 21 bl ffc129a0 <_User_extensions_Add_set>
_User_extensions_Add_set_with_table (extension, &initial_extensions[i]);
extension++;
ffc0c284: 3b ff 00 34 addi r31,r31,52
extension,
0,
number_of_extensions * sizeof( User_extensions_Control )
);
for ( i = 0 ; i < number_of_extensions ; i++ ) {
ffc0c288: 7f 9c f0 40 cmplw cr7,r28,r30
ffc0c28c: 41 9c ff d8 blt+ cr7,ffc0c264 <_User_extensions_Handler_initialization+0x80>
_User_extensions_Add_set_with_table (extension, &initial_extensions[i]);
extension++;
}
}
}
ffc0c290: 39 61 00 18 addi r11,r1,24
ffc0c294: 48 00 cf c8 b ffc1925c <_restgpr_28_x>
ffc0d39c <_Watchdog_Adjust>:
void _Watchdog_Adjust(
Chain_Control *header,
Watchdog_Adjust_directions direction,
Watchdog_Interval units
)
{
ffc0d39c: 94 21 ff e0 stwu r1,-32(r1)
ffc0d3a0: 7c 08 02 a6 mflr r0
ffc0d3a4: bf 61 00 0c stmw r27,12(r1)
ffc0d3a8: 7c 7f 1b 78 mr r31,r3
ffc0d3ac: 7c be 2b 78 mr r30,r5
ffc0d3b0: 90 01 00 24 stw r0,36(r1)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0d3b4: 7c 00 00 a6 mfmsr r0
ffc0d3b8: 7d 30 42 a6 mfsprg r9,0
ffc0d3bc: 7c 09 48 78 andc r9,r0,r9
ffc0d3c0: 7d 20 01 24 mtmsr r9
}
}
_ISR_Enable( level );
}
ffc0d3c4: 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 );
ffc0d3c8: 3b 83 00 04 addi r28,r3,4
* hence the compiler must not assume *header to remain
* unmodified across that call.
*
* Till Straumann, 7/2003
*/
if ( !_Chain_Is_empty( header ) ) {
ffc0d3cc: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0d3d0: 41 9e 00 78 beq- cr7,ffc0d448 <_Watchdog_Adjust+0xac>
switch ( direction ) {
ffc0d3d4: 2f 84 00 00 cmpwi cr7,r4,0
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;
ffc0d3d8: 3b 60 00 01 li r27,1
* unmodified across that call.
*
* Till Straumann, 7/2003
*/
if ( !_Chain_Is_empty( header ) ) {
switch ( direction ) {
ffc0d3dc: 41 9e 00 64 beq- cr7,ffc0d440 <_Watchdog_Adjust+0xa4>
ffc0d3e0: 2f 84 00 01 cmpwi cr7,r4,1
ffc0d3e4: 40 be 00 64 bne+ cr7,ffc0d448 <_Watchdog_Adjust+0xac> <== NEVER TAKEN
case WATCHDOG_BACKWARD:
_Watchdog_First( header )->delta_interval += units;
ffc0d3e8: 81 69 00 10 lwz r11,16(r9)
ffc0d3ec: 7f cb 2a 14 add r30,r11,r5
ffc0d3f0: 48 00 00 18 b ffc0d408 <_Watchdog_Adjust+0x6c>
RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First(
Chain_Control *header
)
{
return ( (Watchdog_Control *) _Chain_First( header ) );
ffc0d3f4: 81 3f 00 00 lwz r9,0(r31)
break;
case WATCHDOG_FORWARD:
while ( units ) {
if ( units < _Watchdog_First( header )->delta_interval ) {
ffc0d3f8: 83 a9 00 10 lwz r29,16(r9)
ffc0d3fc: 7f 9e e8 40 cmplw cr7,r30,r29
ffc0d400: 40 bc 00 10 bge+ cr7,ffc0d410 <_Watchdog_Adjust+0x74>
_Watchdog_First( header )->delta_interval -= units;
ffc0d404: 7f de e8 50 subf r30,r30,r29
ffc0d408: 93 c9 00 10 stw r30,16(r9)
break;
ffc0d40c: 48 00 00 3c b ffc0d448 <_Watchdog_Adjust+0xac>
} else {
units -= _Watchdog_First( header )->delta_interval;
_Watchdog_First( header )->delta_interval = 1;
ffc0d410: 93 69 00 10 stw r27,16(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0d414: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
_Watchdog_Tickle( header );
ffc0d418: 7f e3 fb 78 mr r3,r31
ffc0d41c: 48 00 02 35 bl ffc0d650 <_Watchdog_Tickle>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0d420: 7c 00 00 a6 mfmsr r0
ffc0d424: 7d 30 42 a6 mfsprg r9,0
ffc0d428: 7c 09 48 78 andc r9,r0,r9
ffc0d42c: 7d 20 01 24 mtmsr r9
_ISR_Disable( level );
if ( _Chain_Is_empty( header ) )
ffc0d430: 81 3f 00 00 lwz r9,0(r31)
ffc0d434: 7f 89 e0 00 cmpw cr7,r9,r28
ffc0d438: 41 9e 00 10 beq- cr7,ffc0d448 <_Watchdog_Adjust+0xac>
while ( units ) {
if ( units < _Watchdog_First( header )->delta_interval ) {
_Watchdog_First( header )->delta_interval -= units;
break;
} else {
units -= _Watchdog_First( header )->delta_interval;
ffc0d43c: 7f dd f0 50 subf r30,r29,r30
switch ( direction ) {
case WATCHDOG_BACKWARD:
_Watchdog_First( header )->delta_interval += units;
break;
case WATCHDOG_FORWARD:
while ( units ) {
ffc0d440: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0d444: 40 9e ff b0 bne+ cr7,ffc0d3f4 <_Watchdog_Adjust+0x58> <== ALWAYS TAKEN
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0d448: 7c 00 01 24 mtmsr r0
}
}
_ISR_Enable( level );
}
ffc0d44c: 39 61 00 20 addi r11,r1,32
ffc0d450: 4b ff 3e f0 b ffc01340 <_restgpr_27_x>
ffc0c674 <_Watchdog_Remove>:
*/
Watchdog_States _Watchdog_Remove(
Watchdog_Control *the_watchdog
)
{
ffc0c674: 7c 69 1b 78 mr r9,r3
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0c678: 7c 00 00 a6 mfmsr r0
ffc0c67c: 7d 70 42 a6 mfsprg r11,0
ffc0c680: 7c 0b 58 78 andc r11,r0,r11
ffc0c684: 7d 60 01 24 mtmsr r11
ISR_Level level;
Watchdog_States previous_state;
Watchdog_Control *next_watchdog;
_ISR_Disable( level );
previous_state = the_watchdog->state;
ffc0c688: 80 63 00 08 lwz r3,8(r3)
switch ( previous_state ) {
ffc0c68c: 2f 83 00 01 cmpwi cr7,r3,1
ffc0c690: 41 9e 00 18 beq- cr7,ffc0c6a8 <_Watchdog_Remove+0x34>
ffc0c694: 2b 83 00 01 cmplwi cr7,r3,1
ffc0c698: 41 9c 00 70 blt- cr7,ffc0c708 <_Watchdog_Remove+0x94>
ffc0c69c: 2b 83 00 03 cmplwi cr7,r3,3
ffc0c6a0: 41 9d 00 68 bgt- cr7,ffc0c708 <_Watchdog_Remove+0x94> <== NEVER TAKEN
ffc0c6a4: 48 00 00 10 b ffc0c6b4 <_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;
ffc0c6a8: 39 60 00 00 li r11,0
ffc0c6ac: 91 69 00 08 stw r11,8(r9)
break;
ffc0c6b0: 48 00 00 58 b ffc0c708 <_Watchdog_Remove+0x94>
case WATCHDOG_ACTIVE:
case WATCHDOG_REMOVE_IT:
the_watchdog->state = WATCHDOG_INACTIVE;
ffc0c6b4: 39 60 00 00 li r11,0
ffc0c6b8: 91 69 00 08 stw r11,8(r9)
}
the_watchdog->stop_time = _Watchdog_Ticks_since_boot;
_ISR_Enable( level );
return( previous_state );
}
ffc0c6bc: 81 69 00 00 lwz r11,0(r9)
case WATCHDOG_REMOVE_IT:
the_watchdog->state = WATCHDOG_INACTIVE;
next_watchdog = _Watchdog_Next( the_watchdog );
if ( _Watchdog_Next(next_watchdog) )
ffc0c6c0: 81 4b 00 00 lwz r10,0(r11)
ffc0c6c4: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0c6c8: 41 9e 00 14 beq- cr7,ffc0c6dc <_Watchdog_Remove+0x68>
next_watchdog->delta_interval += the_watchdog->delta_interval;
ffc0c6cc: 81 0b 00 10 lwz r8,16(r11)
ffc0c6d0: 81 49 00 10 lwz r10,16(r9)
ffc0c6d4: 7d 48 52 14 add r10,r8,r10
ffc0c6d8: 91 4b 00 10 stw r10,16(r11)
if ( _Watchdog_Sync_count )
ffc0c6dc: 3d 40 00 00 lis r10,0
ffc0c6e0: 81 4a 27 c0 lwz r10,10176(r10)
ffc0c6e4: 2f 8a 00 00 cmpwi cr7,r10,0
ffc0c6e8: 41 9e 00 14 beq- cr7,ffc0c6fc <_Watchdog_Remove+0x88>
_Watchdog_Sync_level = _ISR_Nest_level;
ffc0c6ec: 3d 40 00 00 lis r10,0
ffc0c6f0: 81 0a 31 8c lwz r8,12684(r10)
ffc0c6f4: 3d 40 00 00 lis r10,0
ffc0c6f8: 91 0a 27 b0 stw r8,10160(r10)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
ffc0c6fc: 81 49 00 04 lwz r10,4(r9)
next->previous = previous;
ffc0c700: 91 4b 00 04 stw r10,4(r11)
previous->next = next;
ffc0c704: 91 6a 00 00 stw r11,0(r10)
_Chain_Extract_unprotected( &the_watchdog->Node );
break;
}
the_watchdog->stop_time = _Watchdog_Ticks_since_boot;
ffc0c708: 3d 60 00 00 lis r11,0
ffc0c70c: 81 6b 27 c4 lwz r11,10180(r11)
ffc0c710: 91 69 00 18 stw r11,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0c714: 7c 00 01 24 mtmsr r0
_ISR_Enable( level );
return( previous_state );
}
ffc0c718: 4e 80 00 20 blr
ffc0cc04 <_Watchdog_Report_chain>:
void _Watchdog_Report_chain(
const char *name,
Chain_Control *header
)
{
ffc0cc04: 94 21 ff e8 stwu r1,-24(r1)
ffc0cc08: 7c 08 02 a6 mflr r0
ffc0cc0c: bf 81 00 08 stmw r28,8(r1)
ffc0cc10: 7c 7e 1b 78 mr r30,r3
ffc0cc14: 7c 9f 23 78 mr r31,r4
ffc0cc18: 90 01 00 1c stw r0,28(r1)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0cc1c: 7f a0 00 a6 mfmsr r29
ffc0cc20: 7c 10 42 a6 mfsprg r0,0
ffc0cc24: 7f a0 00 78 andc r0,r29,r0
ffc0cc28: 7c 00 01 24 mtmsr r0
ISR_Level level;
Chain_Node *node;
_ISR_Disable( level );
printk( "Watchdog Chain: %s %p\n", name, header );
ffc0cc2c: 3c 60 ff c2 lis r3,-62
ffc0cc30: 7f e5 fb 78 mr r5,r31
ffc0cc34: 38 63 f0 dc addi r3,r3,-3876
ffc0cc38: 7f c4 f3 78 mr r4,r30
ffc0cc3c: 4c c6 31 82 crclr 4*cr1+eq
ffc0cc40: 4b ff 95 55 bl ffc06194 <printk>
printk( "== end of %s \n", name );
} else {
printk( "Chain is empty\n" );
}
_ISR_Enable( level );
}
ffc0cc44: 83 9f 00 00 lwz r28,0(r31)
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc0cc48: 3b ff 00 04 addi r31,r31,4
ISR_Level level;
Chain_Node *node;
_ISR_Disable( level );
printk( "Watchdog Chain: %s %p\n", name, header );
if ( !_Chain_Is_empty( header ) ) {
ffc0cc4c: 7f 9c f8 00 cmpw cr7,r28,r31
ffc0cc50: 41 9e 00 34 beq- cr7,ffc0cc84 <_Watchdog_Report_chain+0x80>
node != _Chain_Tail(header) ;
node = node->next )
{
Watchdog_Control *watch = (Watchdog_Control *) node;
_Watchdog_Report( NULL, watch );
ffc0cc54: 7f 84 e3 78 mr r4,r28
ffc0cc58: 38 60 00 00 li r3,0
ffc0cc5c: 48 00 00 45 bl ffc0cca0 <_Watchdog_Report>
_ISR_Disable( level );
printk( "Watchdog Chain: %s %p\n", name, header );
if ( !_Chain_Is_empty( header ) ) {
for ( node = _Chain_First( header ) ;
node != _Chain_Tail(header) ;
node = node->next )
ffc0cc60: 83 9c 00 00 lwz r28,0(r28)
Chain_Node *node;
_ISR_Disable( level );
printk( "Watchdog Chain: %s %p\n", name, header );
if ( !_Chain_Is_empty( header ) ) {
for ( node = _Chain_First( header ) ;
ffc0cc64: 7f 9c f8 00 cmpw cr7,r28,r31
ffc0cc68: 40 9e ff ec bne+ cr7,ffc0cc54 <_Watchdog_Report_chain+0x50><== NEVER TAKEN
{
Watchdog_Control *watch = (Watchdog_Control *) node;
_Watchdog_Report( NULL, watch );
}
printk( "== end of %s \n", name );
ffc0cc6c: 3c 60 ff c2 lis r3,-62
ffc0cc70: 38 63 f0 f3 addi r3,r3,-3853
ffc0cc74: 7f c4 f3 78 mr r4,r30
ffc0cc78: 4c c6 31 82 crclr 4*cr1+eq
ffc0cc7c: 4b ff 95 19 bl ffc06194 <printk>
ffc0cc80: 48 00 00 14 b ffc0cc94 <_Watchdog_Report_chain+0x90>
} else {
printk( "Chain is empty\n" );
ffc0cc84: 3c 60 ff c2 lis r3,-62
ffc0cc88: 38 63 f1 02 addi r3,r3,-3838
ffc0cc8c: 4c c6 31 82 crclr 4*cr1+eq
ffc0cc90: 4b ff 95 05 bl ffc06194 <printk>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc0cc94: 7f a0 01 24 mtmsr r29
}
_ISR_Enable( level );
}
ffc0cc98: 39 61 00 18 addi r11,r1,24
ffc0cc9c: 4b ff 42 28 b ffc00ec4 <_restgpr_28_x>
ffc0ffd0 <_Watchdog_Tickle>:
*/
void _Watchdog_Tickle(
Chain_Control *header
)
{
ffc0ffd0: 94 21 ff e8 stwu r1,-24(r1)
ffc0ffd4: 7c 08 02 a6 mflr r0
ffc0ffd8: bf 81 00 08 stmw r28,8(r1)
ffc0ffdc: 7c 7f 1b 78 mr r31,r3
ffc0ffe0: 90 01 00 1c stw r0,28(r1)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0ffe4: 7f 80 00 a6 mfmsr r28
ffc0ffe8: 7c 10 42 a6 mfsprg r0,0
ffc0ffec: 7f 80 00 78 andc r0,r28,r0
ffc0fff0: 7c 00 01 24 mtmsr r0
} while ( !_Chain_Is_empty( header ) &&
(the_watchdog->delta_interval == 0) );
leave:
_ISR_Enable(level);
}
ffc0fff4: 83 a3 00 00 lwz r29,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 );
ffc0fff8: 3b c3 00 04 addi r30,r3,4
* volatile data - till, 2003/7
*/
_ISR_Disable( level );
if ( _Chain_Is_empty( header ) )
ffc0fffc: 7f 9d f0 00 cmpw cr7,r29,r30
ffc10000: 41 9e 00 6c beq- cr7,ffc1006c <_Watchdog_Tickle+0x9c>
* to be inserted has already had its delta_interval adjusted to 0, and
* so is added to the head of the chain with a delta_interval of 0.
*
* Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc)
*/
if (the_watchdog->delta_interval != 0) {
ffc10004: 81 3d 00 10 lwz r9,16(r29)
ffc10008: 2f 89 00 00 cmpwi cr7,r9,0
ffc1000c: 41 9e 00 14 beq- cr7,ffc10020 <_Watchdog_Tickle+0x50>
the_watchdog->delta_interval--;
ffc10010: 38 09 ff ff addi r0,r9,-1
ffc10014: 90 1d 00 10 stw r0,16(r29)
if ( the_watchdog->delta_interval != 0 )
ffc10018: 2f 80 00 00 cmpwi cr7,r0,0
ffc1001c: 40 9e 00 50 bne- cr7,ffc1006c <_Watchdog_Tickle+0x9c>
goto leave;
}
do {
watchdog_state = _Watchdog_Remove( the_watchdog );
ffc10020: 7f a3 eb 78 mr r3,r29
ffc10024: 4b ff ff 05 bl ffc0ff28 <_Watchdog_Remove>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc10028: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
switch( watchdog_state ) {
ffc1002c: 2f 83 00 02 cmpwi cr7,r3,2
ffc10030: 40 be 00 18 bne+ cr7,ffc10048 <_Watchdog_Tickle+0x78> <== NEVER TAKEN
case WATCHDOG_ACTIVE:
(*the_watchdog->routine)(
ffc10034: 80 1d 00 1c lwz r0,28(r29)
ffc10038: 80 7d 00 20 lwz r3,32(r29)
ffc1003c: 80 9d 00 24 lwz r4,36(r29)
ffc10040: 7c 09 03 a6 mtctr r0
ffc10044: 4e 80 04 21 bctrl
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc10048: 7f 80 00 a6 mfmsr r28
ffc1004c: 7c 10 42 a6 mfsprg r0,0
ffc10050: 7f 80 00 78 andc r0,r28,r0
ffc10054: 7c 00 01 24 mtmsr r0
} while ( !_Chain_Is_empty( header ) &&
(the_watchdog->delta_interval == 0) );
leave:
_ISR_Enable(level);
}
ffc10058: 83 bf 00 00 lwz r29,0(r31)
_ISR_Disable( level );
the_watchdog = _Watchdog_First( header );
} while ( !_Chain_Is_empty( header ) &&
(the_watchdog->delta_interval == 0) );
ffc1005c: 7f 9d f0 00 cmpw cr7,r29,r30
ffc10060: 41 9e 00 0c beq- cr7,ffc1006c <_Watchdog_Tickle+0x9c>
}
_ISR_Disable( level );
the_watchdog = _Watchdog_First( header );
} while ( !_Chain_Is_empty( header ) &&
ffc10064: 80 1d 00 10 lwz r0,16(r29)
ffc10068: 4b ff ff b0 b ffc10018 <_Watchdog_Tickle+0x48>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc1006c: 7f 80 01 24 mtmsr r28
(the_watchdog->delta_interval == 0) );
leave:
_ISR_Enable(level);
}
ffc10070: 39 61 00 18 addi r11,r1,24
ffc10074: 4b ff 10 a4 b ffc01118 <_restgpr_28_x>
ffc084f0 <aio_cancel>:
* operation(s) cannot be canceled
*/
int aio_cancel(int fildes, struct aiocb *aiocbp)
{
ffc084f0: 94 21 ff e8 stwu r1,-24(r1)
ffc084f4: 7c 08 02 a6 mflr r0
ffc084f8: bf 81 00 08 stmw r28,8(r1)
rtems_aio_request_chain *r_chain;
int result;
pthread_mutex_lock (&aio_request_queue.mutex);
ffc084fc: 3f e0 00 00 lis r31,0
ffc08500: 3b ff 2c 08 addi r31,r31,11272
* operation(s) cannot be canceled
*/
int aio_cancel(int fildes, struct aiocb *aiocbp)
{
ffc08504: 7c 9e 23 78 mr r30,r4
ffc08508: 90 01 00 1c stw r0,28(r1)
ffc0850c: 7c 7d 1b 78 mr r29,r3
rtems_aio_request_chain *r_chain;
int result;
pthread_mutex_lock (&aio_request_queue.mutex);
ffc08510: 7f e3 fb 78 mr r3,r31
ffc08514: 48 00 11 ed bl ffc09700 <pthread_mutex_lock>
if (aiocbp == NULL)
ffc08518: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0851c: 40 be 00 e0 bne+ cr7,ffc085fc <aio_cancel+0x10c>
{
if (fcntl (fildes, F_GETFL) < 0) {
ffc08520: 7f a3 eb 78 mr r3,r29
ffc08524: 38 80 00 03 li r4,3
ffc08528: 4c c6 31 82 crclr 4*cr1+eq
ffc0852c: 48 00 73 49 bl ffc0f874 <fcntl>
ffc08530: 2f 83 00 00 cmpwi cr7,r3,0
ffc08534: 40 bc 00 18 bge+ cr7,ffc0854c <aio_cancel+0x5c> <== NEVER TAKEN
pthread_mutex_unlock(&aio_request_queue.mutex);
ffc08538: 7f e3 fb 78 mr r3,r31
ffc0853c: 48 00 12 69 bl ffc097a4 <pthread_mutex_unlock>
rtems_set_errno_and_return_minus_one (EBADF);
ffc08540: 48 00 ad 5d bl ffc1329c <__errno>
ffc08544: 38 00 00 09 li r0,9
ffc08548: 48 00 00 d0 b ffc08618 <aio_cancel+0x128>
}
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc0854c: 38 7f 00 48 addi r3,r31,72 <== NOT EXECUTED
ffc08550: 7f a4 eb 78 mr r4,r29 <== NOT EXECUTED
ffc08554: 38 a0 00 00 li r5,0 <== NOT EXECUTED
ffc08558: 48 00 02 d5 bl ffc0882c <rtems_aio_search_fd> <== NOT EXECUTED
fildes,
0);
if (r_chain == NULL)
ffc0855c: 7c 7e 1b 79 mr. r30,r3 <== NOT EXECUTED
ffc08560: 40 a2 00 68 bne+ ffc085c8 <aio_cancel+0xd8> <== NOT EXECUTED
{
if (!rtems_chain_is_empty (&aio_request_queue.idle_req))
ffc08564: 81 3f 00 54 lwz r9,84(r31) <== NOT EXECUTED
ffc08568: 38 1f 00 58 addi r0,r31,88 <== NOT EXECUTED
ffc0856c: 7f 89 00 00 cmpw cr7,r9,r0 <== NOT EXECUTED
ffc08570: 41 9e 00 48 beq- cr7,ffc085b8 <aio_cancel+0xc8> <== NOT EXECUTED
{
r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req,
ffc08574: 38 7f 00 54 addi r3,r31,84 <== NOT EXECUTED
ffc08578: 7f a4 eb 78 mr r4,r29 <== NOT EXECUTED
ffc0857c: 38 a0 00 00 li r5,0 <== NOT EXECUTED
ffc08580: 48 00 02 ad bl ffc0882c <rtems_aio_search_fd> <== NOT EXECUTED
fildes,
0);
if (r_chain == NULL) {
ffc08584: 7c 7e 1b 79 mr. r30,r3 <== NOT EXECUTED
ffc08588: 41 82 00 30 beq- ffc085b8 <aio_cancel+0xc8> <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE void rtems_chain_extract(
rtems_chain_node *the_node
)
{
_Chain_Extract( the_node );
ffc0858c: 48 00 2d 85 bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
return AIO_ALLDONE;
}
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
pthread_mutex_destroy (&r_chain->mutex);
ffc08590: 3b be 00 1c addi r29,r30,28 <== NOT EXECUTED
pthread_mutex_unlock(&aio_request_queue.mutex);
return AIO_ALLDONE;
}
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
ffc08594: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc08598: 48 00 06 31 bl ffc08bc8 <rtems_aio_remove_fd> <== NOT EXECUTED
pthread_mutex_destroy (&r_chain->mutex);
ffc0859c: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc085a0: 48 00 0e 95 bl ffc09434 <pthread_mutex_destroy> <== NOT EXECUTED
pthread_cond_destroy (&r_chain->mutex);
ffc085a4: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc085a8: 48 00 0a c5 bl ffc0906c <pthread_cond_destroy> <== NOT EXECUTED
free (r_chain);
ffc085ac: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc085b0: 4b ff cb 25 bl ffc050d4 <free> <== NOT EXECUTED
ffc085b4: 48 00 00 38 b ffc085ec <aio_cancel+0xfc> <== NOT EXECUTED
pthread_mutex_unlock (&aio_request_queue.mutex);
return AIO_CANCELED;
}
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc085b8: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc085bc: 48 00 11 e9 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
return AIO_ALLDONE;
ffc085c0: 3b c0 00 02 li r30,2 <== NOT EXECUTED
ffc085c4: 48 00 00 e4 b ffc086a8 <aio_cancel+0x1b8> <== NOT EXECUTED
}
pthread_mutex_lock (&r_chain->mutex);
ffc085c8: 3b be 00 1c addi r29,r30,28 <== NOT EXECUTED
ffc085cc: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc085d0: 48 00 11 31 bl ffc09700 <pthread_mutex_lock> <== NOT EXECUTED
ffc085d4: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc085d8: 48 00 2d 39 bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
rtems_chain_extract (&r_chain->next_fd);
rtems_aio_remove_fd (r_chain);
ffc085dc: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc085e0: 48 00 05 e9 bl ffc08bc8 <rtems_aio_remove_fd> <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
ffc085e4: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc085e8: 48 00 11 bd bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc085ec: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc085f0: 48 00 11 b5 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
return AIO_CANCELED;
ffc085f4: 3b c0 00 00 li r30,0 <== NOT EXECUTED
ffc085f8: 48 00 00 b0 b ffc086a8 <aio_cancel+0x1b8> <== NOT EXECUTED
}
else
{
if (aiocbp->aio_fildes != fildes) {
ffc085fc: 83 9e 00 00 lwz r28,0(r30)
ffc08600: 7f 9c e8 00 cmpw cr7,r28,r29
ffc08604: 41 be 00 20 beq+ cr7,ffc08624 <aio_cancel+0x134> <== NEVER TAKEN
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08608: 7f e3 fb 78 mr r3,r31
ffc0860c: 48 00 11 99 bl ffc097a4 <pthread_mutex_unlock>
rtems_set_errno_and_return_minus_one (EINVAL);
ffc08610: 48 00 ac 8d bl ffc1329c <__errno>
ffc08614: 38 00 00 16 li r0,22
ffc08618: 90 03 00 00 stw r0,0(r3)
ffc0861c: 3b c0 ff ff li r30,-1
ffc08620: 48 00 00 88 b ffc086a8 <aio_cancel+0x1b8>
}
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc08624: 38 7f 00 48 addi r3,r31,72 <== NOT EXECUTED
ffc08628: 7f 84 e3 78 mr r4,r28 <== NOT EXECUTED
ffc0862c: 38 a0 00 00 li r5,0 <== NOT EXECUTED
ffc08630: 48 00 01 fd bl ffc0882c <rtems_aio_search_fd> <== NOT EXECUTED
fildes,
0);
if (r_chain == NULL)
ffc08634: 7c 7d 1b 79 mr. r29,r3 <== NOT EXECUTED
ffc08638: 40 a2 00 40 bne+ ffc08678 <aio_cancel+0x188> <== NOT EXECUTED
if (!rtems_chain_is_empty (&aio_request_queue.idle_req))
ffc0863c: 81 3f 00 54 lwz r9,84(r31) <== NOT EXECUTED
ffc08640: 38 1f 00 58 addi r0,r31,88 <== NOT EXECUTED
ffc08644: 7f 89 00 00 cmpw cr7,r9,r0 <== NOT EXECUTED
ffc08648: 41 9e 00 30 beq- cr7,ffc08678 <aio_cancel+0x188> <== NOT EXECUTED
{
r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req,
ffc0864c: 38 7f 00 54 addi r3,r31,84 <== NOT EXECUTED
ffc08650: 7f 84 e3 78 mr r4,r28 <== NOT EXECUTED
ffc08654: 38 a0 00 00 li r5,0 <== NOT EXECUTED
ffc08658: 48 00 01 d5 bl ffc0882c <rtems_aio_search_fd> <== NOT EXECUTED
fildes,
0);
if (r_chain == NULL)
ffc0865c: 2f 83 00 00 cmpwi cr7,r3,0 <== NOT EXECUTED
ffc08660: 41 be ff a8 beq- cr7,ffc08608 <aio_cancel+0x118> <== NOT EXECUTED
{
pthread_mutex_unlock (&aio_request_queue.mutex);
rtems_set_errno_and_return_minus_one (EINVAL);
}
result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp);
ffc08664: 7f c4 f3 78 mr r4,r30 <== NOT EXECUTED
ffc08668: 48 00 05 c1 bl ffc08c28 <rtems_aio_remove_req> <== NOT EXECUTED
ffc0866c: 7c 7e 1b 78 mr r30,r3 <== NOT EXECUTED
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08670: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08674: 48 00 00 30 b ffc086a4 <aio_cancel+0x1b4> <== NOT EXECUTED
return result;
}
pthread_mutex_lock (&r_chain->mutex);
ffc08678: 3b fd 00 1c addi r31,r29,28 <== NOT EXECUTED
ffc0867c: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08680: 48 00 10 81 bl ffc09700 <pthread_mutex_lock> <== NOT EXECUTED
result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp);
ffc08684: 7f c4 f3 78 mr r4,r30 <== NOT EXECUTED
ffc08688: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc0868c: 48 00 05 9d bl ffc08c28 <rtems_aio_remove_req> <== NOT EXECUTED
ffc08690: 7c 7e 1b 78 mr r30,r3 <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
ffc08694: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08698: 48 00 11 0d bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc0869c: 3c 60 00 00 lis r3,0 <== NOT EXECUTED
ffc086a0: 38 63 2c 08 addi r3,r3,11272 <== NOT EXECUTED
ffc086a4: 48 00 11 01 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
return result;
}
return AIO_ALLDONE;
}
ffc086a8: 39 61 00 18 addi r11,r1,24
ffc086ac: 7f c3 f3 78 mr r3,r30
ffc086b0: 4b ff 84 7c b ffc00b2c <_restgpr_28_x>
ffc086bc <aio_fsync>:
)
{
rtems_aio_request *req;
int mode;
if (op != O_SYNC)
ffc086bc: 2f 83 20 00 cmpwi cr7,r3,8192
int aio_fsync(
int op,
struct aiocb *aiocbp
)
{
ffc086c0: 94 21 ff f0 stwu r1,-16(r1)
ffc086c4: 7c 08 02 a6 mflr r0
ffc086c8: bf c1 00 08 stmw r30,8(r1)
ffc086cc: 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);
ffc086d0: 3b c0 00 16 li r30,22
int aio_fsync(
int op,
struct aiocb *aiocbp
)
{
ffc086d4: 90 01 00 14 stw r0,20(r1)
rtems_aio_request *req;
int mode;
if (op != O_SYNC)
ffc086d8: 40 9e 00 28 bne- cr7,ffc08700 <aio_fsync+0x44>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc086dc: 80 64 00 00 lwz r3,0(r4)
ffc086e0: 38 80 00 03 li r4,3
ffc086e4: 4c c6 31 82 crclr 4*cr1+eq
ffc086e8: 48 00 71 8d bl ffc0f874 <fcntl>
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc086ec: 54 63 07 be clrlwi r3,r3,30
ffc086f0: 38 63 ff ff addi r3,r3,-1
ffc086f4: 2b 83 00 01 cmplwi cr7,r3,1
ffc086f8: 40 bd 00 24 ble+ cr7,ffc0871c <aio_fsync+0x60> <== NEVER TAKEN
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
ffc086fc: 3b c0 00 09 li r30,9
ffc08700: 38 00 ff ff li r0,-1
ffc08704: 93 df 00 34 stw r30,52(r31)
ffc08708: 90 1f 00 38 stw r0,56(r31)
ffc0870c: 48 00 ab 91 bl ffc1329c <__errno>
ffc08710: 93 c3 00 00 stw r30,0(r3)
ffc08714: 38 60 ff ff li r3,-1
ffc08718: 48 00 00 28 b ffc08740 <aio_fsync+0x84>
req = malloc (sizeof (rtems_aio_request));
ffc0871c: 38 60 00 18 li r3,24
ffc08720: 4b ff d0 2d bl ffc0574c <malloc>
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc08724: 3b c0 00 0b li r30,11 <== NOT EXECUTED
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);
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
ffc08728: 7c 69 1b 79 mr. r9,r3 <== NOT EXECUTED
ffc0872c: 41 a2 ff d4 beq- ffc08700 <aio_fsync+0x44> <== NOT EXECUTED
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_SYNC;
ffc08730: 38 00 00 03 li r0,3 <== NOT EXECUTED
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc08734: 93 e9 00 14 stw r31,20(r9) <== NOT EXECUTED
req->aiocbp->aio_lio_opcode = LIO_SYNC;
ffc08738: 90 1f 00 30 stw r0,48(r31) <== NOT EXECUTED
return rtems_aio_enqueue (req);
ffc0873c: 48 00 05 5d bl ffc08c98 <rtems_aio_enqueue> <== NOT EXECUTED
}
ffc08740: 39 61 00 10 addi r11,r1,16
ffc08744: 4b ff 83 f0 b ffc00b34 <_restgpr_30_x>
ffc08eb4 <aio_read>:
* 0 - otherwise
*/
int
aio_read (struct aiocb *aiocbp)
{
ffc08eb4: 94 21 ff f0 stwu r1,-16(r1)
ffc08eb8: 7c 08 02 a6 mflr r0
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc08ebc: 38 80 00 03 li r4,3
* 0 - otherwise
*/
int
aio_read (struct aiocb *aiocbp)
{
ffc08ec0: 90 01 00 14 stw r0,20(r1)
ffc08ec4: bf c1 00 08 stmw r30,8(r1)
ffc08ec8: 7c 7f 1b 78 mr r31,r3
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc08ecc: 80 63 00 00 lwz r3,0(r3)
ffc08ed0: 4c c6 31 82 crclr 4*cr1+eq
ffc08ed4: 48 00 69 a1 bl ffc0f874 <fcntl>
if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc08ed8: 70 63 00 03 andi. r3,r3,3
ffc08edc: 41 82 00 10 beq- ffc08eec <aio_read+0x38> <== NEVER TAKEN
ffc08ee0: 2f 83 00 02 cmpwi cr7,r3,2
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
ffc08ee4: 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)))
ffc08ee8: 40 9e 00 14 bne- cr7,ffc08efc <aio_read+0x48>
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX)
ffc08eec: 80 1f 00 18 lwz r0,24(r31)
ffc08ef0: 2f 80 00 00 cmpwi cr7,r0,0
ffc08ef4: 41 be 00 24 beq+ cr7,ffc08f18 <aio_read+0x64>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
ffc08ef8: 3b c0 00 16 li r30,22
ffc08efc: 38 00 ff ff li r0,-1
ffc08f00: 93 df 00 34 stw r30,52(r31)
ffc08f04: 90 1f 00 38 stw r0,56(r31)
ffc08f08: 48 00 a3 95 bl ffc1329c <__errno>
ffc08f0c: 93 c3 00 00 stw r30,0(r3)
ffc08f10: 38 60 ff ff li r3,-1
ffc08f14: 48 00 00 34 b ffc08f48 <aio_read+0x94>
if (aiocbp->aio_offset < 0)
ffc08f18: 80 1f 00 08 lwz r0,8(r31)
ffc08f1c: 2f 80 00 00 cmpwi cr7,r0,0
ffc08f20: 41 bc ff d8 blt- cr7,ffc08ef8 <aio_read+0x44>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
req = malloc (sizeof (rtems_aio_request));
ffc08f24: 38 60 00 18 li r3,24
ffc08f28: 4b ff c8 25 bl ffc0574c <malloc>
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc08f2c: 3b c0 00 0b li r30,11
if (aiocbp->aio_offset < 0)
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
ffc08f30: 7c 69 1b 79 mr. r9,r3
ffc08f34: 41 a2 ff c8 beq- ffc08efc <aio_read+0x48> <== NEVER TAKEN
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_READ;
ffc08f38: 38 00 00 01 li r0,1
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc08f3c: 93 e9 00 14 stw r31,20(r9)
req->aiocbp->aio_lio_opcode = LIO_READ;
ffc08f40: 90 1f 00 30 stw r0,48(r31)
return rtems_aio_enqueue (req);
ffc08f44: 4b ff fd 55 bl ffc08c98 <rtems_aio_enqueue>
}
ffc08f48: 39 61 00 10 addi r11,r1,16
ffc08f4c: 4b ff 7b e8 b ffc00b34 <_restgpr_30_x>
ffc08f58 <aio_write>:
* 0 - otherwise
*/
int
aio_write (struct aiocb *aiocbp)
{
ffc08f58: 94 21 ff f0 stwu r1,-16(r1)
ffc08f5c: 7c 08 02 a6 mflr r0
rtems_aio_request *req;
int mode;
mode = fcntl (aiocbp->aio_fildes, F_GETFL);
ffc08f60: 38 80 00 03 li r4,3
* 0 - otherwise
*/
int
aio_write (struct aiocb *aiocbp)
{
ffc08f64: 90 01 00 14 stw r0,20(r1)
ffc08f68: bf c1 00 08 stmw r30,8(r1)
ffc08f6c: 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);
ffc08f70: 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);
ffc08f74: 80 63 00 00 lwz r3,0(r3)
ffc08f78: 4c c6 31 82 crclr 4*cr1+eq
ffc08f7c: 48 00 68 f9 bl ffc0f874 <fcntl>
if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR)))
ffc08f80: 54 63 07 be clrlwi r3,r3,30
ffc08f84: 38 63 ff ff addi r3,r3,-1
ffc08f88: 2b 83 00 01 cmplwi cr7,r3,1
ffc08f8c: 41 9d 00 14 bgt- cr7,ffc08fa0 <aio_write+0x48>
rtems_aio_set_errno_return_minus_one (EBADF, aiocbp);
if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX)
ffc08f90: 80 1f 00 18 lwz r0,24(r31)
ffc08f94: 2f 80 00 00 cmpwi cr7,r0,0
ffc08f98: 41 be 00 24 beq+ cr7,ffc08fbc <aio_write+0x64>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
ffc08f9c: 3b c0 00 16 li r30,22
ffc08fa0: 38 00 ff ff li r0,-1
ffc08fa4: 93 df 00 34 stw r30,52(r31)
ffc08fa8: 90 1f 00 38 stw r0,56(r31)
ffc08fac: 48 00 a2 f1 bl ffc1329c <__errno>
ffc08fb0: 93 c3 00 00 stw r30,0(r3)
ffc08fb4: 38 60 ff ff li r3,-1
ffc08fb8: 48 00 00 34 b ffc08fec <aio_write+0x94>
if (aiocbp->aio_offset < 0)
ffc08fbc: 80 1f 00 08 lwz r0,8(r31)
ffc08fc0: 2f 80 00 00 cmpwi cr7,r0,0
ffc08fc4: 41 bc ff d8 blt- cr7,ffc08f9c <aio_write+0x44>
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
req = malloc (sizeof (rtems_aio_request));
ffc08fc8: 38 60 00 18 li r3,24
ffc08fcc: 4b ff c7 81 bl ffc0574c <malloc>
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
ffc08fd0: 3b c0 00 0b li r30,11
if (aiocbp->aio_offset < 0)
rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp);
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
ffc08fd4: 7c 69 1b 79 mr. r9,r3
ffc08fd8: 41 a2 ff c8 beq- ffc08fa0 <aio_write+0x48> <== NEVER TAKEN
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
req->aiocbp->aio_lio_opcode = LIO_WRITE;
ffc08fdc: 38 00 00 02 li r0,2
req = malloc (sizeof (rtems_aio_request));
if (req == NULL)
rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp);
req->aiocbp = aiocbp;
ffc08fe0: 93 e9 00 14 stw r31,20(r9)
req->aiocbp->aio_lio_opcode = LIO_WRITE;
ffc08fe4: 90 1f 00 30 stw r0,48(r31)
return rtems_aio_enqueue (req);
ffc08fe8: 4b ff fc b1 bl ffc08c98 <rtems_aio_enqueue>
}
ffc08fec: 39 61 00 10 addi r11,r1,16
ffc08ff0: 4b ff 7b 44 b ffc00b34 <_restgpr_30_x>
ffc0797c <clock_gettime>:
int clock_gettime(
clockid_t clock_id,
struct timespec *tp
)
{
ffc0797c: 7c 08 02 a6 mflr r0
ffc07980: 94 21 ff f8 stwu r1,-8(r1)
ffc07984: 90 01 00 0c stw r0,12(r1)
ffc07988: 7c 60 1b 78 mr r0,r3
if ( !tp )
ffc0798c: 7c 83 23 79 mr. r3,r4
ffc07990: 41 82 00 44 beq- ffc079d4 <clock_gettime+0x58>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( clock_id == CLOCK_REALTIME ) {
ffc07994: 2f 80 00 01 cmpwi cr7,r0,1
ffc07998: 40 be 00 0c bne+ cr7,ffc079a4 <clock_gettime+0x28>
_TOD_Get(tp);
ffc0799c: 48 00 21 99 bl ffc09b34 <_TOD_Get>
ffc079a0: 48 00 00 18 b ffc079b8 <clock_gettime+0x3c>
return 0;
}
#ifdef CLOCK_MONOTONIC
if ( clock_id == CLOCK_MONOTONIC ) {
ffc079a4: 2f 80 00 04 cmpwi cr7,r0,4
ffc079a8: 41 9e 00 0c beq- cr7,ffc079b4 <clock_gettime+0x38> <== NEVER TAKEN
return 0;
}
#endif
#ifdef _POSIX_CPUTIME
if ( clock_id == CLOCK_PROCESS_CPUTIME ) {
ffc079ac: 2f 80 00 02 cmpwi cr7,r0,2
ffc079b0: 40 be 00 10 bne+ cr7,ffc079c0 <clock_gettime+0x44>
_TOD_Get_uptime_as_timespec( tp );
ffc079b4: 48 00 22 0d bl ffc09bc0 <_TOD_Get_uptime_as_timespec>
return 0;
ffc079b8: 38 60 00 00 li r3,0
ffc079bc: 48 00 00 28 b ffc079e4 <clock_gettime+0x68>
}
#endif
#ifdef _POSIX_THREAD_CPUTIME
if ( clock_id == CLOCK_THREAD_CPUTIME )
ffc079c0: 2f 80 00 03 cmpwi cr7,r0,3
ffc079c4: 40 be 00 10 bne+ cr7,ffc079d4 <clock_gettime+0x58>
rtems_set_errno_and_return_minus_one( ENOSYS );
ffc079c8: 48 00 9d 61 bl ffc11728 <__errno>
ffc079cc: 38 00 00 58 li r0,88
ffc079d0: 48 00 00 0c b ffc079dc <clock_gettime+0x60>
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
ffc079d4: 48 00 9d 55 bl ffc11728 <__errno>
ffc079d8: 38 00 00 16 li r0,22
ffc079dc: 90 03 00 00 stw r0,0(r3)
ffc079e0: 38 60 ff ff li r3,-1
return 0;
}
ffc079e4: 80 01 00 0c lwz r0,12(r1)
ffc079e8: 38 21 00 08 addi r1,r1,8
ffc079ec: 7c 08 03 a6 mtlr r0
ffc079f0: 4e 80 00 20 blr
ffc079f4 <clock_settime>:
int clock_settime(
clockid_t clock_id,
const struct timespec *tp
)
{
ffc079f4: 7c 08 02 a6 mflr r0
ffc079f8: 94 21 ff f8 stwu r1,-8(r1)
ffc079fc: 90 01 00 0c stw r0,12(r1)
ffc07a00: 7c 60 1b 78 mr r0,r3
if ( !tp )
ffc07a04: 7c 83 23 79 mr. r3,r4
ffc07a08: 41 82 00 5c beq- ffc07a64 <clock_settime+0x70> <== NEVER TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
if ( clock_id == CLOCK_REALTIME ) {
ffc07a0c: 2f 80 00 01 cmpwi cr7,r0,1
ffc07a10: 40 be 00 38 bne+ cr7,ffc07a48 <clock_settime+0x54>
if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 )
ffc07a14: 81 23 00 00 lwz r9,0(r3)
ffc07a18: 3c 00 21 da lis r0,8666
ffc07a1c: 60 00 e4 ff ori r0,r0,58623
ffc07a20: 7f 89 00 40 cmplw cr7,r9,r0
ffc07a24: 40 9d 00 40 ble- cr7,ffc07a64 <clock_settime+0x70>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc07a28: 3d 20 00 00 lis r9,0
ffc07a2c: 81 69 27 fc lwz r11,10236(r9)
ffc07a30: 38 0b 00 01 addi r0,r11,1
ffc07a34: 90 09 27 fc stw r0,10236(r9)
rtems_set_errno_and_return_minus_one( EINVAL );
_Thread_Disable_dispatch();
_TOD_Set( tp );
ffc07a38: 48 00 21 f9 bl ffc09c30 <_TOD_Set>
_Thread_Enable_dispatch();
ffc07a3c: 48 00 39 49 bl ffc0b384 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( ENOSYS );
#endif
else
rtems_set_errno_and_return_minus_one( EINVAL );
return 0;
ffc07a40: 38 60 00 00 li r3,0
ffc07a44: 48 00 00 30 b ffc07a74 <clock_settime+0x80>
_Thread_Disable_dispatch();
_TOD_Set( tp );
_Thread_Enable_dispatch();
}
#ifdef _POSIX_CPUTIME
else if ( clock_id == CLOCK_PROCESS_CPUTIME )
ffc07a48: 2f 80 00 02 cmpwi cr7,r0,2
ffc07a4c: 41 9e 00 0c beq- cr7,ffc07a58 <clock_settime+0x64>
rtems_set_errno_and_return_minus_one( ENOSYS );
#endif
#ifdef _POSIX_THREAD_CPUTIME
else if ( clock_id == CLOCK_THREAD_CPUTIME )
ffc07a50: 2f 80 00 03 cmpwi cr7,r0,3
ffc07a54: 40 be 00 10 bne+ cr7,ffc07a64 <clock_settime+0x70>
rtems_set_errno_and_return_minus_one( ENOSYS );
ffc07a58: 48 00 9c d1 bl ffc11728 <__errno>
ffc07a5c: 38 00 00 58 li r0,88
ffc07a60: 48 00 00 0c b ffc07a6c <clock_settime+0x78>
#endif
else
rtems_set_errno_and_return_minus_one( EINVAL );
ffc07a64: 48 00 9c c5 bl ffc11728 <__errno>
ffc07a68: 38 00 00 16 li r0,22
ffc07a6c: 90 03 00 00 stw r0,0(r3)
ffc07a70: 38 60 ff ff li r3,-1
return 0;
}
ffc07a74: 80 01 00 0c lwz r0,12(r1)
ffc07a78: 38 21 00 08 addi r1,r1,8
ffc07a7c: 7c 08 03 a6 mtlr r0
ffc07a80: 4e 80 00 20 blr
ffc24c88 <killinfo>:
int killinfo(
pid_t pid,
int sig,
const union sigval *value
)
{
ffc24c88: 94 21 ff d8 stwu r1,-40(r1)
ffc24c8c: 7c 08 02 a6 mflr r0
ffc24c90: bf 81 00 18 stmw r28,24(r1)
ffc24c94: 7c 7e 1b 78 mr r30,r3
ffc24c98: 7c 9f 23 78 mr r31,r4
ffc24c9c: 90 01 00 2c stw r0,44(r1)
ffc24ca0: 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() )
ffc24ca4: 4b ff fc 7d bl ffc24920 <getpid>
ffc24ca8: 7f 9e 18 00 cmpw cr7,r30,r3
ffc24cac: 41 be 00 10 beq+ cr7,ffc24cbc <killinfo+0x34>
rtems_set_errno_and_return_minus_one( ESRCH );
ffc24cb0: 4b ff 14 65 bl ffc16114 <__errno>
ffc24cb4: 38 00 00 03 li r0,3
ffc24cb8: 48 00 00 14 b ffc24ccc <killinfo+0x44>
/*
* Validate the signal passed.
*/
if ( !sig )
ffc24cbc: 2f 9f 00 00 cmpwi cr7,r31,0
ffc24cc0: 40 be 00 18 bne+ cr7,ffc24cd8 <killinfo+0x50>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc24cc4: 4b ff 14 51 bl ffc16114 <__errno>
ffc24cc8: 38 00 00 16 li r0,22
ffc24ccc: 90 03 00 00 stw r0,0(r3)
ffc24cd0: 38 60 ff ff li r3,-1
ffc24cd4: 48 00 02 24 b ffc24ef8 <killinfo+0x270>
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc24cd8: 3b df ff ff addi r30,r31,-1
if ( !is_valid_signo(sig) )
ffc24cdc: 2b 9e 00 1f cmplwi cr7,r30,31
ffc24ce0: 41 bd ff e4 bgt- cr7,ffc24cc4 <killinfo+0x3c>
rtems_set_errno_and_return_minus_one( EINVAL );
/*
* If the signal is being ignored, then we are out of here.
*/
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN )
ffc24ce4: 1c 1f 00 0c mulli r0,r31,12
ffc24ce8: 3d 20 00 00 lis r9,0
ffc24cec: 39 29 32 c0 addi r9,r9,12992
ffc24cf0: 7d 29 02 14 add r9,r9,r0
ffc24cf4: 80 09 00 08 lwz r0,8(r9)
return 0;
ffc24cf8: 38 60 00 00 li r3,0
rtems_set_errno_and_return_minus_one( EINVAL );
/*
* If the signal is being ignored, then we are out of here.
*/
if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN )
ffc24cfc: 2f 80 00 01 cmpwi cr7,r0,1
ffc24d00: 41 9e 01 f8 beq- cr7,ffc24ef8 <killinfo+0x270>
/*
* 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 ) )
ffc24d04: 2f 9f 00 08 cmpwi cr7,r31,8
ffc24d08: 41 9e 00 14 beq- cr7,ffc24d1c <killinfo+0x94>
ffc24d0c: 2f 9f 00 04 cmpwi cr7,r31,4
ffc24d10: 41 9e 00 0c beq- cr7,ffc24d1c <killinfo+0x94>
ffc24d14: 2f 9f 00 0b cmpwi cr7,r31,11
ffc24d18: 40 be 00 14 bne+ cr7,ffc24d2c <killinfo+0xa4>
return pthread_kill( pthread_self(), sig );
ffc24d1c: 48 00 04 1d bl ffc25138 <pthread_self>
ffc24d20: 7f e4 fb 78 mr r4,r31
ffc24d24: 48 00 03 35 bl ffc25058 <pthread_kill>
ffc24d28: 48 00 01 d0 b ffc24ef8 <killinfo+0x270>
* Build up a siginfo structure
*/
siginfo = &siginfo_struct;
siginfo->si_signo = sig;
siginfo->si_code = SI_USER;
if ( !value ) {
ffc24d2c: 2f 9d 00 00 cmpwi cr7,r29,0
/*
* Build up a siginfo structure
*/
siginfo = &siginfo_struct;
siginfo->si_signo = sig;
ffc24d30: 93 e1 00 08 stw r31,8(r1)
static inline sigset_t signo_to_mask(
uint32_t sig
)
{
return 1u << (sig - 1);
ffc24d34: 38 00 00 01 li r0,1
ffc24d38: 7c 1e f0 30 slw r30,r0,r30
siginfo->si_code = SI_USER;
ffc24d3c: 90 01 00 0c stw r0,12(r1)
if ( !value ) {
ffc24d40: 40 be 00 0c bne+ cr7,ffc24d4c <killinfo+0xc4>
siginfo->si_value.sival_int = 0;
ffc24d44: 93 a1 00 10 stw r29,16(r1)
ffc24d48: 48 00 00 0c b ffc24d54 <killinfo+0xcc>
} else {
siginfo->si_value = *value;
ffc24d4c: 80 1d 00 00 lwz r0,0(r29)
ffc24d50: 90 01 00 10 stw r0,16(r1)
ffc24d54: 3d 20 00 00 lis r9,0
ffc24d58: 81 69 27 f0 lwz r11,10224(r9)
ffc24d5c: 38 0b 00 01 addi r0,r11,1
ffc24d60: 90 09 27 f0 stw r0,10224(r9)
/*
* 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;
ffc24d64: 3d 20 00 00 lis r9,0
ffc24d68: 80 69 32 70 lwz r3,12912(r9)
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
if ( _POSIX_signals_Is_interested( api, mask ) ) {
ffc24d6c: 81 23 01 34 lwz r9,308(r3)
ffc24d70: 80 09 00 d0 lwz r0,208(r9)
ffc24d74: 7f c5 00 79 andc. r5,r30,r0
ffc24d78: 40 82 01 00 bne- ffc24e78 <killinfo+0x1f0>
}
DEBUG_STEP("\n");
_Thread_Enable_dispatch();
return 0;
}
ffc24d7c: 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 );
ffc24d80: 3d 60 00 00 lis r11,0
}
DEBUG_STEP("\n");
_Thread_Enable_dispatch();
return 0;
}
ffc24d84: 81 29 34 4c lwz r9,13388(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 );
ffc24d88: 38 0b 34 50 addi r0,r11,13392
ffc24d8c: 48 00 00 28 b ffc24db4 <killinfo+0x12c>
#endif
/*
* Is this thread is actually blocked waiting for the signal?
*/
if (the_thread->Wait.option & mask)
ffc24d90: 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;
ffc24d94: 7d 23 4b 78 mr r3,r9
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc24d98: 81 69 01 34 lwz r11,308(r9)
#endif
/*
* Is this thread is actually blocked waiting for the signal?
*/
if (the_thread->Wait.option & mask)
ffc24d9c: 7f c8 50 39 and. r8,r30,r10
ffc24da0: 40 82 00 d8 bne- ffc24e78 <killinfo+0x1f0>
/*
* Is this thread is blocked waiting for another signal but has
* not blocked this one?
*/
if (~api->signals_blocked & mask)
ffc24da4: 81 6b 00 d0 lwz r11,208(r11)
ffc24da8: 7f ca 58 79 andc. r10,r30,r11
ffc24dac: 40 82 00 cc bne- ffc24e78 <killinfo+0x1f0>
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 ) {
ffc24db0: 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 );
ffc24db4: 7f 89 00 00 cmpw cr7,r9,r0
ffc24db8: 40 9e ff d8 bne+ cr7,ffc24d90 <killinfo+0x108>
* NOTES:
*
* + rtems internal threads do not receive signals.
*/
interested = NULL;
interested_priority = PRIORITY_MAXIMUM + 1;
ffc24dbc: 3d 20 00 00 lis r9,0
ffc24dc0: 89 29 27 2c lbz r9,10028(r9)
ffc24dc4: 3d 60 00 00 lis r11,0
ffc24dc8: 39 6b 2d 64 addi r11,r11,11620
ffc24dcc: 38 09 00 01 addi r0,r9,1
*/
#define _POSIX_signals_Is_interested( _api, _mask ) \
( ~(_api)->signals_blocked & (_mask) )
int killinfo(
ffc24dd0: 38 8b 00 08 addi r4,r11,8
*
* NOTES:
*
* + rtems internal threads do not receive signals.
*/
interested = NULL;
ffc24dd4: 38 60 00 00 li r3,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 ] )
ffc24dd8: 85 2b 00 04 lwzu r9,4(r11)
ffc24ddc: 2f 89 00 00 cmpwi cr7,r9,0
ffc24de0: 41 9e 00 88 beq- cr7,ffc24e68 <killinfo+0x1e0> <== NEVER TAKEN
continue;
the_info = _Objects_Information_table[ the_api ][ 1 ];
ffc24de4: 81 29 00 04 lwz r9,4(r9)
#endif
maximum = the_info->maximum;
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
ffc24de8: 39 00 00 01 li r8,1
*/
if ( !the_info )
continue;
#endif
maximum = the_info->maximum;
ffc24dec: a3 a9 00 10 lhz r29,16(r9)
ffc24df0: 80 e9 00 1c lwz r7,28(r9)
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
ffc24df4: 48 00 00 6c b ffc24e60 <killinfo+0x1d8>
the_thread = (Thread_Control *) object_table[ index ];
ffc24df8: 85 27 00 04 lwzu r9,4(r7)
if ( !the_thread )
ffc24dfc: 2f 89 00 00 cmpwi cr7,r9,0
ffc24e00: 41 9e 00 5c beq- cr7,ffc24e5c <killinfo+0x1d4>
/*
* If this thread is of lower priority than the interested thread,
* go on to the next thread.
*/
if ( the_thread->current_priority > interested_priority )
ffc24e04: 81 49 00 14 lwz r10,20(r9)
ffc24e08: 7f 8a 00 40 cmplw cr7,r10,r0
ffc24e0c: 41 9d 00 50 bgt- cr7,ffc24e5c <killinfo+0x1d4>
#if defined(RTEMS_DEBUG)
if ( !api )
continue;
#endif
if ( !_POSIX_signals_Is_interested( api, mask ) )
ffc24e10: 80 c9 01 34 lwz r6,308(r9)
ffc24e14: 80 c6 00 d0 lwz r6,208(r6)
ffc24e18: 7f dc 30 79 andc. r28,r30,r6
ffc24e1c: 41 82 00 40 beq- ffc24e5c <killinfo+0x1d4>
*
* 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 ) {
ffc24e20: 41 9c 00 34 blt- cr7,ffc24e54 <killinfo+0x1cc>
* and blocking interruptibutable by signal.
*
* If the interested thread is ready, don't think about changing.
*/
if ( interested && !_States_Is_ready( interested->current_state ) ) {
ffc24e24: 2f 83 00 00 cmpwi cr7,r3,0
ffc24e28: 41 9e 00 34 beq- cr7,ffc24e5c <killinfo+0x1d4> <== NEVER TAKEN
ffc24e2c: 80 a3 00 10 lwz r5,16(r3)
ffc24e30: 2f 85 00 00 cmpwi cr7,r5,0
ffc24e34: 41 9e 00 28 beq- cr7,ffc24e5c <killinfo+0x1d4> <== NEVER TAKEN
/* preferred ready over blocked */
DEBUG_STEP("5");
if ( _States_Is_ready( the_thread->current_state ) ) {
ffc24e38: 80 c9 00 10 lwz r6,16(r9)
ffc24e3c: 2f 86 00 00 cmpwi cr7,r6,0
ffc24e40: 41 9e 00 14 beq- cr7,ffc24e54 <killinfo+0x1cc>
continue;
}
DEBUG_STEP("6");
/* prefer blocked/interruptible over blocked/not interruptible */
if ( !_States_Is_interruptible_by_signal(interested->current_state) ) {
ffc24e44: 74 bc 10 00 andis. r28,r5,4096
ffc24e48: 40 82 00 14 bne- ffc24e5c <killinfo+0x1d4>
DEBUG_STEP("7");
if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) {
ffc24e4c: 74 c5 10 00 andis. r5,r6,4096
ffc24e50: 41 82 00 0c beq- ffc24e5c <killinfo+0x1d4>
*/
if ( interested && !_States_Is_ready( interested->current_state ) ) {
/* preferred ready over blocked */
DEBUG_STEP("5");
if ( _States_Is_ready( the_thread->current_state ) ) {
ffc24e54: 7d 40 53 78 mr r0,r10
ffc24e58: 7d 23 4b 78 mr r3,r9
#endif
maximum = the_info->maximum;
object_table = the_info->local_table;
for ( index = 1 ; index <= maximum ; index++ ) {
ffc24e5c: 39 08 00 01 addi r8,r8,1
ffc24e60: 7f 88 e8 40 cmplw cr7,r8,r29
ffc24e64: 40 9d ff 94 ble+ cr7,ffc24df8 <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++) {
ffc24e68: 7f 8b 20 00 cmpw cr7,r11,r4
ffc24e6c: 40 be ff 6c bne- cr7,ffc24dd8 <killinfo+0x150>
}
}
}
}
if ( interested ) {
ffc24e70: 2f 83 00 00 cmpwi cr7,r3,0
ffc24e74: 41 9e 00 18 beq- cr7,ffc24e8c <killinfo+0x204>
/*
* 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 ) ) {
ffc24e78: 7f e4 fb 78 mr r4,r31
ffc24e7c: 38 a1 00 08 addi r5,r1,8
ffc24e80: 48 00 00 a9 bl ffc24f28 <_POSIX_signals_Unblock_thread>
ffc24e84: 2f 83 00 00 cmpwi cr7,r3,0
ffc24e88: 40 9e 00 68 bne- cr7,ffc24ef0 <killinfo+0x268>
/*
* 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 );
ffc24e8c: 7f c3 f3 78 mr r3,r30
ffc24e90: 48 00 00 71 bl ffc24f00 <_POSIX_signals_Set_process_signals>
if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) {
ffc24e94: 1f ff 00 0c mulli r31,r31,12
ffc24e98: 3d 20 00 00 lis r9,0
ffc24e9c: 39 29 32 c0 addi r9,r9,12992
ffc24ea0: 7c 09 f8 2e lwzx r0,r9,r31
ffc24ea4: 2f 80 00 02 cmpwi cr7,r0,2
ffc24ea8: 40 be 00 48 bne+ cr7,ffc24ef0 <killinfo+0x268>
psiginfo = (POSIX_signals_Siginfo_node *)
_Chain_Get( &_POSIX_signals_Inactive_siginfo );
ffc24eac: 3c 60 00 00 lis r3,0
ffc24eb0: 38 63 34 40 addi r3,r3,13376
ffc24eb4: 4b fe 92 c1 bl ffc0e174 <_Chain_Get>
if ( !psiginfo ) {
ffc24eb8: 7c 64 1b 79 mr. r4,r3
ffc24ebc: 40 a2 00 14 bne+ ffc24ed0 <killinfo+0x248>
_Thread_Enable_dispatch();
ffc24ec0: 4b fe af a1 bl ffc0fe60 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EAGAIN );
ffc24ec4: 4b ff 12 51 bl ffc16114 <__errno>
ffc24ec8: 38 00 00 0b li r0,11
ffc24ecc: 4b ff fe 00 b ffc24ccc <killinfo+0x44>
}
psiginfo->Info = *siginfo;
ffc24ed0: 39 24 00 08 addi r9,r4,8
ffc24ed4: 39 61 00 08 addi r11,r1,8
_Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node );
ffc24ed8: 3c 60 00 00 lis r3,0
if ( !psiginfo ) {
_Thread_Enable_dispatch();
rtems_set_errno_and_return_minus_one( EAGAIN );
}
psiginfo->Info = *siginfo;
ffc24edc: 7c ab 64 aa lswi r5,r11,12
ffc24ee0: 7c a9 65 aa stswi r5,r9,12
_Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node );
ffc24ee4: 38 63 34 b4 addi r3,r3,13492
ffc24ee8: 7c 63 fa 14 add r3,r3,r31
ffc24eec: 4b fe 92 31 bl ffc0e11c <_Chain_Append>
}
DEBUG_STEP("\n");
_Thread_Enable_dispatch();
ffc24ef0: 4b fe af 71 bl ffc0fe60 <_Thread_Enable_dispatch>
return 0;
ffc24ef4: 38 60 00 00 li r3,0
}
ffc24ef8: 39 61 00 28 addi r11,r1,40
ffc24efc: 4b fd d0 8c b ffc01f88 <_restgpr_28_x>
ffc0d738 <pthread_attr_setschedpolicy>:
int pthread_attr_setschedpolicy(
pthread_attr_t *attr,
int policy
)
{
if ( !attr || !attr->is_initialized )
ffc0d738: 2c 03 00 00 cmpwi r3,0
return EINVAL;
ffc0d73c: 38 00 00 16 li r0,22
int pthread_attr_setschedpolicy(
pthread_attr_t *attr,
int policy
)
{
if ( !attr || !attr->is_initialized )
ffc0d740: 41 82 00 38 beq- ffc0d778 <pthread_attr_setschedpolicy+0x40>
ffc0d744: 81 23 00 00 lwz r9,0(r3)
ffc0d748: 2f 89 00 00 cmpwi cr7,r9,0
ffc0d74c: 41 9e 00 2c beq- cr7,ffc0d778 <pthread_attr_setschedpolicy+0x40>
return EINVAL;
switch ( policy ) {
ffc0d750: 2b 84 00 04 cmplwi cr7,r4,4
ffc0d754: 41 9d 00 20 bgt- cr7,ffc0d774 <pthread_attr_setschedpolicy+0x3c>
ffc0d758: 38 00 00 01 li r0,1
ffc0d75c: 7c 00 20 30 slw r0,r0,r4
ffc0d760: 70 09 00 17 andi. r9,r0,23
ffc0d764: 41 82 00 10 beq- ffc0d774 <pthread_attr_setschedpolicy+0x3c><== NEVER TAKEN
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
case SCHED_SPORADIC:
attr->schedpolicy = policy;
ffc0d768: 90 83 00 14 stw r4,20(r3)
return 0;
ffc0d76c: 38 00 00 00 li r0,0
ffc0d770: 48 00 00 08 b ffc0d778 <pthread_attr_setschedpolicy+0x40>
default:
return ENOTSUP;
ffc0d774: 38 00 00 86 li r0,134
}
}
ffc0d778: 7c 03 03 78 mr r3,r0
ffc0d77c: 4e 80 00 20 blr
ffc080a8 <pthread_barrier_init>:
int pthread_barrier_init(
pthread_barrier_t *barrier,
const pthread_barrierattr_t *attr,
unsigned int count
)
{
ffc080a8: 94 21 ff d8 stwu r1,-40(r1)
ffc080ac: 7c 08 02 a6 mflr r0
ffc080b0: bf 81 00 18 stmw r28,24(r1)
const pthread_barrierattr_t *the_attr;
/*
* Error check parameters
*/
if ( !barrier )
ffc080b4: 7c 7c 1b 79 mr. r28,r3
int pthread_barrier_init(
pthread_barrier_t *barrier,
const pthread_barrierattr_t *attr,
unsigned int count
)
{
ffc080b8: 7c bf 2b 78 mr r31,r5
ffc080bc: 90 01 00 2c stw r0,44(r1)
/*
* Error check parameters
*/
if ( !barrier )
return EINVAL;
ffc080c0: 38 00 00 16 li r0,22
const pthread_barrierattr_t *the_attr;
/*
* Error check parameters
*/
if ( !barrier )
ffc080c4: 41 82 00 a8 beq- ffc0816c <pthread_barrier_init+0xc4>
return EINVAL;
if ( count == 0 )
ffc080c8: 2f 85 00 00 cmpwi cr7,r5,0
ffc080cc: 41 9e 00 a0 beq- cr7,ffc0816c <pthread_barrier_init+0xc4>
return EINVAL;
/*
* If the user passed in NULL, use the default attributes
*/
if ( attr ) {
ffc080d0: 2f 84 00 00 cmpwi cr7,r4,0
ffc080d4: 7c 9e 23 78 mr r30,r4
ffc080d8: 40 be 00 10 bne+ cr7,ffc080e8 <pthread_barrier_init+0x40>
the_attr = attr;
} else {
(void) pthread_barrierattr_init( &my_attr );
ffc080dc: 3b c1 00 10 addi r30,r1,16
ffc080e0: 7f c3 f3 78 mr r3,r30
ffc080e4: 4b ff fe e9 bl ffc07fcc <pthread_barrierattr_init>
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc080e8: 81 3e 00 00 lwz r9,0(r30)
return EINVAL;
ffc080ec: 38 00 00 16 li r0,22
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc080f0: 2f 89 00 00 cmpwi cr7,r9,0
ffc080f4: 41 9e 00 78 beq- cr7,ffc0816c <pthread_barrier_init+0xc4>
return EINVAL;
switch ( the_attr->process_shared ) {
ffc080f8: 83 de 00 04 lwz r30,4(r30)
ffc080fc: 2f 9e 00 00 cmpwi cr7,r30,0
ffc08100: 40 9e 00 6c bne- cr7,ffc0816c <pthread_barrier_init+0xc4><== NEVER TAKEN
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc08104: 3d 20 00 00 lis r9,0
}
/*
* Convert from POSIX attributes to Core Barrier attributes
*/
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
ffc08108: 93 c1 00 08 stw r30,8(r1)
ffc0810c: 81 69 27 b8 lwz r11,10168(r9)
the_attributes.maximum_count = count;
ffc08110: 93 e1 00 0c stw r31,12(r1)
ffc08114: 38 0b 00 01 addi r0,r11,1
ffc08118: 90 09 27 b8 stw r0,10168(r9)
* the inactive chain of free barrier control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void )
{
return (POSIX_Barrier_Control *)
_Objects_Allocate( &_POSIX_Barrier_Information );
ffc0811c: 3f a0 00 00 lis r29,0
ffc08120: 3b bd 2f 6c addi r29,r29,12140
ffc08124: 7f a3 eb 78 mr r3,r29
ffc08128: 48 00 23 b1 bl ffc0a4d8 <_Objects_Allocate>
*/
_Thread_Disable_dispatch(); /* prevents deletion */
the_barrier = _POSIX_Barrier_Allocate();
if ( !the_barrier ) {
ffc0812c: 7c 7f 1b 79 mr. r31,r3
ffc08130: 40 a2 00 10 bne+ ffc08140 <pthread_barrier_init+0x98>
_Thread_Enable_dispatch();
ffc08134: 48 00 35 b1 bl ffc0b6e4 <_Thread_Enable_dispatch>
return EAGAIN;
ffc08138: 38 00 00 0b li r0,11
ffc0813c: 48 00 00 30 b ffc0816c <pthread_barrier_init+0xc4>
}
_CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes );
ffc08140: 38 7f 00 10 addi r3,r31,16
ffc08144: 38 81 00 08 addi r4,r1,8
ffc08148: 48 00 18 f9 bl ffc09a40 <_CORE_barrier_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc0814c: 80 1f 00 08 lwz r0,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc08150: 81 7d 00 1c lwz r11,28(r29)
ffc08154: 54 09 13 ba rlwinm r9,r0,2,14,29
ffc08158: 7f eb 49 2e stwx r31,r11,r9
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc0815c: 93 df 00 0c stw r30,12(r31)
);
/*
* Exit the critical section and return the user an operational barrier
*/
*barrier = the_barrier->Object.id;
ffc08160: 90 1c 00 00 stw r0,0(r28)
_Thread_Enable_dispatch();
ffc08164: 48 00 35 81 bl ffc0b6e4 <_Thread_Enable_dispatch>
return 0;
ffc08168: 38 00 00 00 li r0,0
}
ffc0816c: 39 61 00 28 addi r11,r1,40
ffc08170: 7c 03 03 78 mr r3,r0
ffc08174: 4b ff 8d b8 b ffc00f2c <_restgpr_28_x>
ffc07724 <pthread_cleanup_push>:
void pthread_cleanup_push(
void (*routine)( void * ),
void *arg
)
{
ffc07724: 94 21 ff f0 stwu r1,-16(r1)
ffc07728: 7c 08 02 a6 mflr r0
ffc0772c: 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 )
ffc07730: 7c 7e 1b 79 mr. r30,r3
void pthread_cleanup_push(
void (*routine)( void * ),
void *arg
)
{
ffc07734: 7c 9f 23 78 mr r31,r4
ffc07738: 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 )
ffc0773c: 41 82 00 48 beq- ffc07784 <pthread_cleanup_push+0x60>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc07740: 3d 20 00 00 lis r9,0
ffc07744: 81 69 27 b0 lwz r11,10160(r9)
ffc07748: 38 0b 00 01 addi r0,r11,1
ffc0774c: 90 09 27 b0 stw r0,10160(r9)
return;
_Thread_Disable_dispatch();
handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) );
ffc07750: 38 60 00 10 li r3,16
ffc07754: 48 00 4b 65 bl ffc0c2b8 <_Workspace_Allocate>
if ( handler ) {
ffc07758: 7c 69 1b 79 mr. r9,r3
ffc0775c: 41 82 00 24 beq- ffc07780 <pthread_cleanup_push+0x5c> <== NEVER TAKEN
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc07760: 3d 60 00 00 lis r11,0
ffc07764: 81 6b 30 f0 lwz r11,12528(r11)
handler_stack = &thread_support->Cancellation_Handlers;
handler->routine = routine;
handler->arg = arg;
_Chain_Append( handler_stack, &handler->Node );
ffc07768: 7d 24 4b 78 mr r4,r9
handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) );
if ( handler ) {
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
ffc0776c: 80 6b 01 34 lwz r3,308(r11)
handler->routine = routine;
ffc07770: 93 c9 00 08 stw r30,8(r9)
handler->arg = arg;
_Chain_Append( handler_stack, &handler->Node );
ffc07774: 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;
ffc07778: 93 e9 00 0c stw r31,12(r9)
_Chain_Append( handler_stack, &handler->Node );
ffc0777c: 48 00 1a 05 bl ffc09180 <_Chain_Append>
}
_Thread_Enable_dispatch();
ffc07780: 48 00 36 5d bl ffc0addc <_Thread_Enable_dispatch>
}
ffc07784: 39 61 00 10 addi r11,r1,16
ffc07788: 48 00 ed 2c b ffc164b4 <_restgpr_30_x>
ffc08a40 <pthread_cond_init>:
int pthread_cond_init(
pthread_cond_t *cond,
const pthread_condattr_t *attr
)
{
ffc08a40: 94 21 ff e8 stwu r1,-24(r1)
ffc08a44: 7c 08 02 a6 mflr r0
ffc08a48: 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;
ffc08a4c: 7c 9e 23 79 mr. r30,r4
int pthread_cond_init(
pthread_cond_t *cond,
const pthread_condattr_t *attr
)
{
ffc08a50: 7c 7c 1b 78 mr r28,r3
ffc08a54: 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;
ffc08a58: 40 a2 00 0c bne+ ffc08a64 <pthread_cond_init+0x24>
else the_attr = &_POSIX_Condition_variables_Default_attributes;
ffc08a5c: 3f c0 00 00 lis r30,0
ffc08a60: 3b de 27 10 addi r30,r30,10000
/*
* Be careful about attributes when global!!!
*/
if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED )
ffc08a64: 80 1e 00 04 lwz r0,4(r30)
return EINVAL;
ffc08a68: 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 )
ffc08a6c: 2f 80 00 01 cmpwi cr7,r0,1
ffc08a70: 41 9e 00 8c beq- cr7,ffc08afc <pthread_cond_init+0xbc> <== NEVER TAKEN
return EINVAL;
if ( !the_attr->is_initialized )
ffc08a74: 80 1e 00 00 lwz r0,0(r30)
ffc08a78: 2f 80 00 00 cmpwi cr7,r0,0
ffc08a7c: 41 be 00 80 beq+ cr7,ffc08afc <pthread_cond_init+0xbc>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc08a80: 3d 20 00 00 lis r9,0
ffc08a84: 81 69 27 c4 lwz r11,10180(r9)
ffc08a88: 38 0b 00 01 addi r0,r11,1
ffc08a8c: 90 09 27 c4 stw r0,10180(r9)
RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control
*_POSIX_Condition_variables_Allocate( void )
{
return (POSIX_Condition_variables_Control *)
_Objects_Allocate( &_POSIX_Condition_variables_Information );
ffc08a90: 3f a0 00 00 lis r29,0
ffc08a94: 3b bd 30 04 addi r29,r29,12292
ffc08a98: 7f a3 eb 78 mr r3,r29
ffc08a9c: 48 00 2a 01 bl ffc0b49c <_Objects_Allocate>
_Thread_Disable_dispatch();
the_cond = _POSIX_Condition_variables_Allocate();
if ( !the_cond ) {
ffc08aa0: 7c 7f 1b 79 mr. r31,r3
ffc08aa4: 40 a2 00 10 bne+ ffc08ab4 <pthread_cond_init+0x74>
_Thread_Enable_dispatch();
ffc08aa8: 48 00 3c 01 bl ffc0c6a8 <_Thread_Enable_dispatch>
return ENOMEM;
ffc08aac: 38 60 00 0c li r3,12
ffc08ab0: 48 00 00 4c b ffc08afc <pthread_cond_init+0xbc>
}
the_cond->process_shared = the_attr->process_shared;
ffc08ab4: 80 1e 00 04 lwz r0,4(r30)
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
ffc08ab8: 3b c0 00 00 li r30,0
ffc08abc: 93 df 00 14 stw r30,20(r31)
_Thread_queue_Initialize(
ffc08ac0: 3c a0 10 00 lis r5,4096
ffc08ac4: 38 7f 00 18 addi r3,r31,24
if ( !the_cond ) {
_Thread_Enable_dispatch();
return ENOMEM;
}
the_cond->process_shared = the_attr->process_shared;
ffc08ac8: 90 1f 00 10 stw r0,16(r31)
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
_Thread_queue_Initialize(
ffc08acc: 38 80 00 00 li r4,0
ffc08ad0: 60 a5 08 00 ori r5,r5,2048
ffc08ad4: 38 c0 00 74 li r6,116
ffc08ad8: 48 00 44 85 bl ffc0cf5c <_Thread_queue_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc08adc: 80 1f 00 08 lwz r0,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc08ae0: 81 7d 00 1c lwz r11,28(r29)
ffc08ae4: 54 09 13 ba rlwinm r9,r0,2,14,29
ffc08ae8: 7f eb 49 2e stwx r31,r11,r9
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc08aec: 93 df 00 0c stw r30,12(r31)
&_POSIX_Condition_variables_Information,
&the_cond->Object,
0
);
*cond = the_cond->Object.id;
ffc08af0: 90 1c 00 00 stw r0,0(r28)
_Thread_Enable_dispatch();
ffc08af4: 48 00 3b b5 bl ffc0c6a8 <_Thread_Enable_dispatch>
return 0;
ffc08af8: 38 60 00 00 li r3,0
}
ffc08afc: 39 61 00 18 addi r11,r1,24
ffc08b00: 4b ff 8c d4 b ffc017d4 <_restgpr_28_x>
ffc08898 <pthread_condattr_destroy>:
int pthread_condattr_destroy(
pthread_condattr_t *attr
)
{
if ( !attr || attr->is_initialized == false )
ffc08898: 2c 03 00 00 cmpwi r3,0
return EINVAL;
ffc0889c: 38 00 00 16 li r0,22
int pthread_condattr_destroy(
pthread_condattr_t *attr
)
{
if ( !attr || attr->is_initialized == false )
ffc088a0: 41 82 00 18 beq- ffc088b8 <pthread_condattr_destroy+0x20>
ffc088a4: 81 23 00 00 lwz r9,0(r3)
ffc088a8: 2f 89 00 00 cmpwi cr7,r9,0
ffc088ac: 41 9e 00 0c beq- cr7,ffc088b8 <pthread_condattr_destroy+0x20><== NEVER TAKEN
return EINVAL;
attr->is_initialized = false;
ffc088b0: 38 00 00 00 li r0,0
ffc088b4: 90 03 00 00 stw r0,0(r3)
return 0;
}
ffc088b8: 7c 03 03 78 mr r3,r0
ffc088bc: 4e 80 00 20 blr
ffc07cec <pthread_create>:
pthread_t *thread,
const pthread_attr_t *attr,
void *(*start_routine)( void * ),
void *arg
)
{
ffc07cec: 94 21 ff 88 stwu r1,-120(r1)
ffc07cf0: 7c 08 02 a6 mflr r0
ffc07cf4: be c1 00 50 stmw r22,80(r1)
int schedpolicy = SCHED_RR;
struct sched_param schedparam;
Objects_Name name;
int rc;
if ( !start_routine )
ffc07cf8: 7c b8 2b 79 mr. r24,r5
pthread_t *thread,
const pthread_attr_t *attr,
void *(*start_routine)( void * ),
void *arg
)
{
ffc07cfc: 7c 7a 1b 78 mr r26,r3
ffc07d00: 90 01 00 7c stw r0,124(r1)
ffc07d04: 7c d9 33 78 mr r25,r6
struct sched_param schedparam;
Objects_Name name;
int rc;
if ( !start_routine )
return EFAULT;
ffc07d08: 3b c0 00 0e li r30,14
int schedpolicy = SCHED_RR;
struct sched_param schedparam;
Objects_Name name;
int rc;
if ( !start_routine )
ffc07d0c: 41 82 02 0c beq- ffc07f18 <pthread_create+0x22c>
return EFAULT;
the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes;
ffc07d10: 2f 84 00 00 cmpwi cr7,r4,0
ffc07d14: 7c 9f 23 78 mr r31,r4
ffc07d18: 40 be 00 0c bne+ cr7,ffc07d24 <pthread_create+0x38>
ffc07d1c: 3f e0 ff c2 lis r31,-62
ffc07d20: 3b ff e9 74 addi r31,r31,-5772
if ( !the_attr->is_initialized )
ffc07d24: 80 1f 00 00 lwz r0,0(r31)
return EINVAL;
ffc07d28: 3b c0 00 16 li r30,22
if ( !start_routine )
return EFAULT;
the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes;
if ( !the_attr->is_initialized )
ffc07d2c: 2f 80 00 00 cmpwi cr7,r0,0
ffc07d30: 41 9e 01 e8 beq- cr7,ffc07f18 <pthread_create+0x22c>
* 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) )
ffc07d34: 80 1f 00 04 lwz r0,4(r31)
ffc07d38: 2f 80 00 00 cmpwi cr7,r0,0
ffc07d3c: 41 9e 00 18 beq- cr7,ffc07d54 <pthread_create+0x68>
ffc07d40: 3d 60 00 00 lis r11,0
ffc07d44: 81 3f 00 08 lwz r9,8(r31)
ffc07d48: 80 0b 26 d0 lwz r0,9936(r11)
ffc07d4c: 7f 89 00 40 cmplw cr7,r9,r0
ffc07d50: 41 9c 01 c8 blt- cr7,ffc07f18 <pthread_create+0x22c>
* 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 ) {
ffc07d54: 80 1f 00 10 lwz r0,16(r31)
ffc07d58: 2f 80 00 01 cmpwi cr7,r0,1
ffc07d5c: 41 9e 00 14 beq- cr7,ffc07d70 <pthread_create+0x84>
ffc07d60: 2f 80 00 02 cmpwi cr7,r0,2
schedpolicy = the_attr->schedpolicy;
schedparam = the_attr->schedparam;
break;
default:
return EINVAL;
ffc07d64: 3b c0 00 16 li r30,22
* 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 ) {
ffc07d68: 40 be 01 b0 bne+ cr7,ffc07f18 <pthread_create+0x22c>
ffc07d6c: 48 00 00 1c b ffc07d88 <pthread_create+0x9c>
case PTHREAD_INHERIT_SCHED:
api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc07d70: 3d 20 00 00 lis r9,0
ffc07d74: 81 29 30 f0 lwz r9,12528(r9)
ffc07d78: 80 69 01 34 lwz r3,308(r9)
schedpolicy = api->schedpolicy;
ffc07d7c: 83 63 00 84 lwz r27,132(r3)
schedparam = api->schedparam;
ffc07d80: 38 63 00 88 addi r3,r3,136
ffc07d84: 48 00 00 0c b ffc07d90 <pthread_create+0xa4>
break;
case PTHREAD_EXPLICIT_SCHED:
schedpolicy = the_attr->schedpolicy;
ffc07d88: 83 7f 00 14 lwz r27,20(r31)
schedparam = the_attr->schedparam;
ffc07d8c: 38 7f 00 18 addi r3,r31,24
ffc07d90: 38 81 00 20 addi r4,r1,32
ffc07d94: 7c a3 e4 aa lswi r5,r3,28
ffc07d98: 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;
ffc07d9c: 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 )
ffc07da0: 80 1f 00 0c lwz r0,12(r31)
ffc07da4: 2f 80 00 00 cmpwi cr7,r0,0
ffc07da8: 40 9e 01 70 bne- cr7,ffc07f18 <pthread_create+0x22c>
return ENOTSUP;
/*
* Interpret the scheduling parameters.
*/
if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) )
ffc07dac: 80 61 00 20 lwz r3,32(r1)
return EINVAL;
ffc07db0: 3b c0 00 16 li r30,22
return ENOTSUP;
/*
* Interpret the scheduling parameters.
*/
if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) )
ffc07db4: 48 00 6a 75 bl ffc0e828 <_POSIX_Priority_Is_valid>
ffc07db8: 2f 83 00 00 cmpwi cr7,r3,0
ffc07dbc: 41 be 01 5c beq+ cr7,ffc07f18 <pthread_create+0x22c> <== NEVER TAKEN
return EINVAL;
core_priority = _POSIX_Priority_To_core( schedparam.sched_priority );
ffc07dc0: 7c 24 0b 78 mr r4,r1
ffc07dc4: 86 e4 00 20 lwzu r23,32(r4)
RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core(
int priority
)
{
return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1);
ffc07dc8: 3d 20 00 00 lis r9,0
/*
* Set the core scheduling policy information.
*/
rc = _POSIX_Thread_Translate_sched_param(
ffc07dcc: 7f 63 db 78 mr r3,r27
ffc07dd0: 8a c9 26 d4 lbz r22,9940(r9)
ffc07dd4: 38 a1 00 18 addi r5,r1,24
ffc07dd8: 38 c1 00 1c addi r6,r1,28
ffc07ddc: 48 00 6a 75 bl ffc0e850 <_POSIX_Thread_Translate_sched_param>
schedpolicy,
&schedparam,
&budget_algorithm,
&budget_callout
);
if ( rc )
ffc07de0: 7c 7e 1b 79 mr. r30,r3
ffc07de4: 40 a2 01 34 bne+ ffc07f18 <pthread_create+0x22c>
#endif
/*
* Lock the allocator mutex for protection
*/
_RTEMS_Lock_allocator();
ffc07de8: 3f a0 00 00 lis r29,0
ffc07dec: 80 7d 27 d8 lwz r3,10200(r29)
ffc07df0: 48 00 1a 21 bl ffc09810 <_API_Mutex_Lock>
* _POSIX_Threads_Allocate
*/
RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void )
{
return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information );
ffc07df4: 3c 60 00 00 lis r3,0
ffc07df8: 38 63 2d ec addi r3,r3,11756
ffc07dfc: 48 00 25 2d bl ffc0a328 <_Objects_Allocate>
* Allocate the thread control block.
*
* NOTE: Global threads are not currently supported.
*/
the_thread = _POSIX_Threads_Allocate();
if ( !the_thread ) {
ffc07e00: 7c 7c 1b 79 mr. r28,r3
ffc07e04: 40 a2 00 0c bne+ ffc07e10 <pthread_create+0x124>
_RTEMS_Unlock_allocator();
ffc07e08: 80 7d 27 d8 lwz r3,10200(r29)
ffc07e0c: 48 00 00 80 b ffc07e8c <pthread_create+0x1a0>
static inline size_t _POSIX_Threads_Ensure_minimum_stack (
size_t size
)
{
if ( size >= PTHREAD_MINIMUM_STACK_SIZE )
ffc07e10: 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(
ffc07e14: 80 1f 00 08 lwz r0,8(r31)
static inline size_t _POSIX_Threads_Ensure_minimum_stack (
size_t size
)
{
if ( size >= PTHREAD_MINIMUM_STACK_SIZE )
ffc07e18: 80 c9 26 d0 lwz r6,9936(r9)
/*
* Initialize the core thread for this task.
*/
name.name_p = NULL; /* posix threads don't have a name by default */
status = _Thread_Initialize(
ffc07e1c: 80 bf 00 04 lwz r5,4(r31)
static inline size_t _POSIX_Threads_Ensure_minimum_stack (
size_t size
)
{
if ( size >= PTHREAD_MINIMUM_STACK_SIZE )
ffc07e20: 54 c6 08 3c rlwinm r6,r6,1,0,30
/*
* Initialize the core thread for this task.
*/
name.name_p = NULL; /* posix threads don't have a name by default */
status = _Thread_Initialize(
ffc07e24: 7f 86 00 40 cmplw cr7,r6,r0
ffc07e28: 40 9c 00 08 bge- cr7,ffc07e30 <pthread_create+0x144>
ffc07e2c: 7c 06 03 78 mr r6,r0
ffc07e30: 38 00 00 00 li r0,0
ffc07e34: 81 61 00 1c lwz r11,28(r1)
ffc07e38: 7c 29 0b 78 mr r9,r1
ffc07e3c: 81 41 00 18 lwz r10,24(r1)
ffc07e40: 94 09 00 48 stwu r0,72(r9)
ffc07e44: 3f a0 00 00 lis r29,0
ffc07e48: 3b bd 2d ec addi r29,r29,11756
ffc07e4c: 91 21 00 10 stw r9,16(r1)
ffc07e50: 7f a3 eb 78 mr r3,r29
ffc07e54: 7f 84 e3 78 mr r4,r28
ffc07e58: 38 e0 00 01 li r7,1
ffc07e5c: 91 61 00 08 stw r11,8(r1)
ffc07e60: 7d 17 b0 50 subf r8,r23,r22
ffc07e64: 39 20 00 01 li r9,1
ffc07e68: 90 01 00 0c stw r0,12(r1)
ffc07e6c: 48 00 37 89 bl ffc0b5f4 <_Thread_Initialize>
budget_callout,
0, /* isr level */
name /* posix threads don't have a name */
);
if ( !status ) {
ffc07e70: 2f 83 00 00 cmpwi cr7,r3,0
ffc07e74: 40 9e 00 24 bne- cr7,ffc07e98 <pthread_create+0x1ac>
RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free (
Thread_Control *the_pthread
)
{
_Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object );
ffc07e78: 7f a3 eb 78 mr r3,r29
ffc07e7c: 7f 84 e3 78 mr r4,r28
ffc07e80: 48 00 28 21 bl ffc0a6a0 <_Objects_Free>
_POSIX_Threads_Free( the_thread );
_RTEMS_Unlock_allocator();
ffc07e84: 3d 20 00 00 lis r9,0
ffc07e88: 80 69 27 d8 lwz r3,10200(r9)
ffc07e8c: 48 00 1a 09 bl ffc09894 <_API_Mutex_Unlock>
return EAGAIN;
ffc07e90: 3b c0 00 0b li r30,11
ffc07e94: 48 00 00 84 b ffc07f18 <pthread_create+0x22c>
}
/*
* finish initializing the per API structure
*/
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc07e98: 83 bc 01 34 lwz r29,308(r28)
api->Attributes = *the_attr;
ffc07e9c: 38 a0 00 40 li r5,64
ffc07ea0: 7f e4 fb 78 mr r4,r31
ffc07ea4: 7f a3 eb 78 mr r3,r29
ffc07ea8: 48 00 a1 61 bl ffc12008 <memcpy>
api->detachstate = the_attr->detachstate;
ffc07eac: 80 1f 00 3c lwz r0,60(r31)
api->schedpolicy = schedpolicy;
ffc07eb0: 93 7d 00 84 stw r27,132(r29)
api->schedparam = schedparam;
ffc07eb4: 38 9d 00 88 addi r4,r29,136
ffc07eb8: 38 61 00 20 addi r3,r1,32
* finish initializing the per API structure
*/
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
api->Attributes = *the_attr;
api->detachstate = the_attr->detachstate;
ffc07ebc: 90 1d 00 40 stw r0,64(r29)
api->schedpolicy = schedpolicy;
api->schedparam = schedparam;
ffc07ec0: 7c a3 e4 aa lswi r5,r3,28
ffc07ec4: 7c a4 e5 aa stswi r5,r4,28
/*
* POSIX threads are allocated and started in one operation.
*/
status = _Thread_Start(
ffc07ec8: 7f 83 e3 78 mr r3,r28
ffc07ecc: 38 80 00 01 li r4,1
ffc07ed0: 7f 05 c3 78 mr r5,r24
ffc07ed4: 7f 26 cb 78 mr r6,r25
ffc07ed8: 38 e0 00 00 li r7,0
ffc07edc: 48 00 42 19 bl ffc0c0f4 <_Thread_Start>
_RTEMS_Unlock_allocator();
return EINVAL;
}
#endif
if ( schedpolicy == SCHED_SPORADIC ) {
ffc07ee0: 2f 9b 00 04 cmpwi cr7,r27,4
ffc07ee4: 40 be 00 20 bne+ cr7,ffc07f04 <pthread_create+0x218>
_Watchdog_Insert_ticks(
ffc07ee8: 38 7d 00 90 addi r3,r29,144
ffc07eec: 48 00 44 55 bl ffc0c340 <_Timespec_To_ticks>
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc07ef0: 38 9d 00 a8 addi r4,r29,168
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc07ef4: 90 7d 00 b4 stw r3,180(r29)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc07ef8: 3c 60 00 00 lis r3,0
ffc07efc: 38 63 2d 08 addi r3,r3,11528
ffc07f00: 48 00 48 2d bl ffc0c72c <_Watchdog_Insert>
}
/*
* Return the id and indicate we successfully created the thread
*/
*thread = the_thread->Object.id;
ffc07f04: 80 1c 00 08 lwz r0,8(r28)
_RTEMS_Unlock_allocator();
ffc07f08: 3d 20 00 00 lis r9,0
ffc07f0c: 80 69 27 d8 lwz r3,10200(r9)
}
/*
* Return the id and indicate we successfully created the thread
*/
*thread = the_thread->Object.id;
ffc07f10: 90 1a 00 00 stw r0,0(r26)
_RTEMS_Unlock_allocator();
ffc07f14: 48 00 19 81 bl ffc09894 <_API_Mutex_Unlock>
return 0;
}
ffc07f18: 39 61 00 78 addi r11,r1,120
ffc07f1c: 7f c3 f3 78 mr r3,r30
ffc07f20: 4b ff 8c a0 b ffc00bc0 <_restgpr_22_x>
ffc0a248 <pthread_mutex_timedlock>:
int pthread_mutex_timedlock(
pthread_mutex_t *mutex,
const struct timespec *abstime
)
{
ffc0a248: 94 21 ff d8 stwu r1,-40(r1)
ffc0a24c: 7c 08 02 a6 mflr r0
ffc0a250: bf a1 00 1c stmw r29,28(r1)
ffc0a254: 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 );
ffc0a258: 7c 83 23 78 mr r3,r4
ffc0a25c: 38 81 00 08 addi r4,r1,8
int pthread_mutex_timedlock(
pthread_mutex_t *mutex,
const struct timespec *abstime
)
{
ffc0a260: 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 );
ffc0a264: 48 00 00 f5 bl ffc0a358 <_POSIX_Absolute_timeout_to_ticks>
int _EXFUN(pthread_mutex_trylock, (pthread_mutex_t *__mutex));
int _EXFUN(pthread_mutex_unlock, (pthread_mutex_t *__mutex));
#if defined(_POSIX_TIMEOUTS)
int _EXFUN(pthread_mutex_timedlock,
ffc0a268: 68 7f 00 03 xori r31,r3,3
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks );
ffc0a26c: 80 a1 00 08 lwz r5,8(r1)
ffc0a270: 7f ff 00 34 cntlzw r31,r31
ffc0a274: 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 );
ffc0a278: 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 );
ffc0a27c: 7f e4 fb 78 mr r4,r31
ffc0a280: 7f a3 eb 78 mr r3,r29
ffc0a284: 4b ff fe c1 bl ffc0a144 <_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) ) {
ffc0a288: 2f 9f 00 00 cmpwi cr7,r31,0
ffc0a28c: 40 9e 00 30 bne- cr7,ffc0a2bc <pthread_mutex_timedlock+0x74>
ffc0a290: 2f 83 00 10 cmpwi cr7,r3,16
ffc0a294: 40 be 00 28 bne+ cr7,ffc0a2bc <pthread_mutex_timedlock+0x74><== NEVER TAKEN
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc0a298: 2f 9e 00 00 cmpwi cr7,r30,0
ffc0a29c: 41 9e 00 14 beq- cr7,ffc0a2b0 <pthread_mutex_timedlock+0x68><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc0a2a0: 3b de ff ff addi r30,r30,-1
ffc0a2a4: 2b 9e 00 01 cmplwi cr7,r30,1
ffc0a2a8: 41 bd 00 14 bgt+ cr7,ffc0a2bc <pthread_mutex_timedlock+0x74><== NEVER TAKEN
ffc0a2ac: 48 00 00 0c b ffc0a2b8 <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;
ffc0a2b0: 38 60 00 16 li r3,22 <== NOT EXECUTED
ffc0a2b4: 48 00 00 08 b ffc0a2bc <pthread_mutex_timedlock+0x74><== NOT EXECUTED
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc0a2b8: 38 60 00 74 li r3,116
}
return lock_status;
}
ffc0a2bc: 39 61 00 28 addi r11,r1,40
ffc0a2c0: 4b ff 88 c4 b ffc02b84 <_restgpr_29_x>
ffc09dc8 <pthread_mutexattr_setpshared>:
int pthread_mutexattr_setpshared(
pthread_mutexattr_t *attr,
int pshared
)
{
if ( !attr || !attr->is_initialized )
ffc09dc8: 2c 03 00 00 cmpwi r3,0
return EINVAL;
ffc09dcc: 38 00 00 16 li r0,22
int pthread_mutexattr_setpshared(
pthread_mutexattr_t *attr,
int pshared
)
{
if ( !attr || !attr->is_initialized )
ffc09dd0: 41 82 00 20 beq- ffc09df0 <pthread_mutexattr_setpshared+0x28>
ffc09dd4: 81 23 00 00 lwz r9,0(r3)
ffc09dd8: 2f 89 00 00 cmpwi cr7,r9,0
ffc09ddc: 41 9e 00 14 beq- cr7,ffc09df0 <pthread_mutexattr_setpshared+0x28>
return EINVAL;
switch ( pshared ) {
ffc09de0: 2b 84 00 01 cmplwi cr7,r4,1
ffc09de4: 41 9d 00 0c bgt- cr7,ffc09df0 <pthread_mutexattr_setpshared+0x28><== NEVER TAKEN
case PTHREAD_PROCESS_SHARED:
case PTHREAD_PROCESS_PRIVATE:
attr->process_shared = pshared;
ffc09de8: 90 83 00 04 stw r4,4(r3)
return 0;
ffc09dec: 38 00 00 00 li r0,0
default:
return EINVAL;
}
}
ffc09df0: 7c 03 03 78 mr r3,r0
ffc09df4: 4e 80 00 20 blr
ffc07360 <pthread_mutexattr_settype>:
int pthread_mutexattr_settype(
pthread_mutexattr_t *attr,
int type
)
{
if ( !attr || !attr->is_initialized )
ffc07360: 2c 03 00 00 cmpwi r3,0
return EINVAL;
ffc07364: 38 00 00 16 li r0,22
int pthread_mutexattr_settype(
pthread_mutexattr_t *attr,
int type
)
{
if ( !attr || !attr->is_initialized )
ffc07368: 41 82 00 20 beq- ffc07388 <pthread_mutexattr_settype+0x28>
ffc0736c: 81 23 00 00 lwz r9,0(r3)
ffc07370: 2f 89 00 00 cmpwi cr7,r9,0
ffc07374: 41 9e 00 14 beq- cr7,ffc07388 <pthread_mutexattr_settype+0x28><== NEVER TAKEN
return EINVAL;
switch ( type ) {
ffc07378: 2b 84 00 03 cmplwi cr7,r4,3
ffc0737c: 41 9d 00 0c bgt- cr7,ffc07388 <pthread_mutexattr_settype+0x28>
case PTHREAD_MUTEX_NORMAL:
case PTHREAD_MUTEX_RECURSIVE:
case PTHREAD_MUTEX_ERRORCHECK:
case PTHREAD_MUTEX_DEFAULT:
attr->type = type;
ffc07380: 90 83 00 10 stw r4,16(r3)
return 0;
ffc07384: 38 00 00 00 li r0,0
default:
return EINVAL;
}
}
ffc07388: 7c 03 03 78 mr r3,r0
ffc0738c: 4e 80 00 20 blr
ffc0838c <pthread_once>:
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
ffc0838c: 94 21 ff e0 stwu r1,-32(r1)
ffc08390: 7c 08 02 a6 mflr r0
ffc08394: bf c1 00 18 stmw r30,24(r1)
if ( !once_control || !init_routine )
ffc08398: 7c 7f 1b 79 mr. r31,r3
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
ffc0839c: 7c 9e 23 78 mr r30,r4
ffc083a0: 90 01 00 24 stw r0,36(r1)
if ( !once_control || !init_routine )
return EINVAL;
ffc083a4: 38 00 00 16 li r0,22
int pthread_once(
pthread_once_t *once_control,
void (*init_routine)(void)
)
{
if ( !once_control || !init_routine )
ffc083a8: 41 82 00 60 beq- ffc08408 <pthread_once+0x7c>
ffc083ac: 2f 84 00 00 cmpwi cr7,r4,0
ffc083b0: 41 9e 00 58 beq- cr7,ffc08408 <pthread_once+0x7c>
return EINVAL;
if ( !once_control->init_executed ) {
ffc083b4: 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;
ffc083b8: 38 00 00 00 li r0,0
)
{
if ( !once_control || !init_routine )
return EINVAL;
if ( !once_control->init_executed ) {
ffc083bc: 2f 89 00 00 cmpwi cr7,r9,0
ffc083c0: 40 be 00 48 bne+ cr7,ffc08408 <pthread_once+0x7c>
rtems_mode saveMode;
rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode);
ffc083c4: 38 60 01 00 li r3,256
ffc083c8: 38 80 01 00 li r4,256
ffc083cc: 38 a1 00 08 addi r5,r1,8
ffc083d0: 48 00 0c b9 bl ffc09088 <rtems_task_mode>
if ( !once_control->init_executed ) {
ffc083d4: 80 1f 00 04 lwz r0,4(r31)
ffc083d8: 2f 80 00 00 cmpwi cr7,r0,0
ffc083dc: 40 be 00 18 bne+ cr7,ffc083f4 <pthread_once+0x68> <== NEVER TAKEN
once_control->is_initialized = true;
ffc083e0: 38 00 00 01 li r0,1
once_control->init_executed = true;
(*init_routine)();
ffc083e4: 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;
ffc083e8: 90 1f 00 00 stw r0,0(r31)
once_control->init_executed = true;
ffc083ec: 90 1f 00 04 stw r0,4(r31)
(*init_routine)();
ffc083f0: 4e 80 04 21 bctrl
}
rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode);
ffc083f4: 7c 25 0b 78 mr r5,r1
ffc083f8: 84 65 00 08 lwzu r3,8(r5)
ffc083fc: 38 80 01 00 li r4,256
ffc08400: 48 00 0c 89 bl ffc09088 <rtems_task_mode>
}
return 0;
ffc08404: 38 00 00 00 li r0,0
}
ffc08408: 39 61 00 20 addi r11,r1,32
ffc0840c: 7c 03 03 78 mr r3,r0
ffc08410: 4b ff 87 d0 b ffc00be0 <_restgpr_30_x>
ffc08f80 <pthread_rwlock_init>:
int pthread_rwlock_init(
pthread_rwlock_t *rwlock,
const pthread_rwlockattr_t *attr
)
{
ffc08f80: 94 21 ff d8 stwu r1,-40(r1)
ffc08f84: 7c 08 02 a6 mflr r0
ffc08f88: bf 81 00 18 stmw r28,24(r1)
const pthread_rwlockattr_t *the_attr;
/*
* Error check parameters
*/
if ( !rwlock )
ffc08f8c: 7c 7c 1b 79 mr. r28,r3
int pthread_rwlock_init(
pthread_rwlock_t *rwlock,
const pthread_rwlockattr_t *attr
)
{
ffc08f90: 90 01 00 2c stw r0,44(r1)
/*
* Error check parameters
*/
if ( !rwlock )
return EINVAL;
ffc08f94: 38 00 00 16 li r0,22
const pthread_rwlockattr_t *the_attr;
/*
* Error check parameters
*/
if ( !rwlock )
ffc08f98: 41 82 00 9c beq- ffc09034 <pthread_rwlock_init+0xb4>
return EINVAL;
/*
* If the user passed in NULL, use the default attributes
*/
if ( attr ) {
ffc08f9c: 2f 84 00 00 cmpwi cr7,r4,0
ffc08fa0: 7c 9f 23 78 mr r31,r4
ffc08fa4: 40 be 00 10 bne+ cr7,ffc08fb4 <pthread_rwlock_init+0x34>
the_attr = attr;
} else {
(void) pthread_rwlockattr_init( &default_attr );
ffc08fa8: 3b e1 00 0c addi r31,r1,12
ffc08fac: 7f e3 fb 78 mr r3,r31
ffc08fb0: 48 00 0a 41 bl ffc099f0 <pthread_rwlockattr_init>
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc08fb4: 81 3f 00 00 lwz r9,0(r31)
return EINVAL;
ffc08fb8: 38 00 00 16 li r0,22
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
ffc08fbc: 2f 89 00 00 cmpwi cr7,r9,0
ffc08fc0: 41 9e 00 74 beq- cr7,ffc09034 <pthread_rwlock_init+0xb4><== NEVER TAKEN
return EINVAL;
switch ( the_attr->process_shared ) {
ffc08fc4: 83 df 00 04 lwz r30,4(r31)
ffc08fc8: 2f 9e 00 00 cmpwi cr7,r30,0
ffc08fcc: 40 9e 00 68 bne- cr7,ffc09034 <pthread_rwlock_init+0xb4><== NEVER TAKEN
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc08fd0: 3d 20 00 00 lis r9,0
*/
RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes(
CORE_RWLock_Attributes *the_attributes
)
{
the_attributes->XXX = 0;
ffc08fd4: 93 c1 00 08 stw r30,8(r1)
ffc08fd8: 81 69 27 b8 lwz r11,10168(r9)
ffc08fdc: 38 0b 00 01 addi r0,r11,1
ffc08fe0: 90 09 27 b8 stw r0,10168(r9)
* the inactive chain of free RWLock control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void )
{
return (POSIX_RWLock_Control *)
_Objects_Allocate( &_POSIX_RWLock_Information );
ffc08fe4: 3f a0 00 00 lis r29,0
ffc08fe8: 3b bd 2d ac addi r29,r29,11692
ffc08fec: 7f a3 eb 78 mr r3,r29
ffc08ff0: 48 00 2a 19 bl ffc0ba08 <_Objects_Allocate>
*/
_Thread_Disable_dispatch(); /* prevents deletion */
the_rwlock = _POSIX_RWLock_Allocate();
if ( !the_rwlock ) {
ffc08ff4: 7c 7f 1b 79 mr. r31,r3
ffc08ff8: 40 a2 00 10 bne+ ffc09008 <pthread_rwlock_init+0x88>
_Thread_Enable_dispatch();
ffc08ffc: 48 00 3c 19 bl ffc0cc14 <_Thread_Enable_dispatch>
return EAGAIN;
ffc09000: 38 00 00 0b li r0,11
ffc09004: 48 00 00 30 b ffc09034 <pthread_rwlock_init+0xb4>
}
_CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes );
ffc09008: 38 7f 00 10 addi r3,r31,16
ffc0900c: 38 81 00 08 addi r4,r1,8
ffc09010: 48 00 20 71 bl ffc0b080 <_CORE_RWLock_Initialize>
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc09014: 80 1f 00 08 lwz r0,8(r31)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc09018: 81 7d 00 1c lwz r11,28(r29)
ffc0901c: 54 09 13 ba rlwinm r9,r0,2,14,29
ffc09020: 7f eb 49 2e stwx r31,r11,r9
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc09024: 93 df 00 0c stw r30,12(r31)
&_POSIX_RWLock_Information,
&the_rwlock->Object,
0
);
*rwlock = the_rwlock->Object.id;
ffc09028: 90 1c 00 00 stw r0,0(r28)
_Thread_Enable_dispatch();
ffc0902c: 48 00 3b e9 bl ffc0cc14 <_Thread_Enable_dispatch>
return 0;
ffc09030: 38 00 00 00 li r0,0
}
ffc09034: 39 61 00 28 addi r11,r1,40
ffc09038: 7c 03 03 78 mr r3,r0
ffc0903c: 4b ff 8d f4 b ffc01e30 <_restgpr_28_x>
ffc090b8 <pthread_rwlock_timedrdlock>:
int pthread_rwlock_timedrdlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc090b8: 94 21 ff d8 stwu r1,-40(r1)
ffc090bc: 7c 08 02 a6 mflr r0
ffc090c0: bf 81 00 18 stmw r28,24(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc090c4: 7c 7c 1b 79 mr. r28,r3
return EINVAL;
ffc090c8: 3b c0 00 16 li r30,22
int pthread_rwlock_timedrdlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc090cc: 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 )
ffc090d0: 41 82 00 a4 beq- ffc09174 <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 );
ffc090d4: 7c 83 23 78 mr r3,r4
ffc090d8: 38 81 00 0c addi r4,r1,12
ffc090dc: 48 00 6c 91 bl ffc0fd6c <_POSIX_Absolute_timeout_to_ticks>
ffc090e0: 80 9c 00 00 lwz r4,0(r28)
ffc090e4: 7c 7d 1b 78 mr r29,r3
ffc090e8: 3c 60 00 00 lis r3,0
ffc090ec: 38 63 2d ac addi r3,r3,11692
ffc090f0: 38 a1 00 08 addi r5,r1,8
ffc090f4: 48 00 2e 29 bl ffc0bf1c <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
ffc090f8: 80 01 00 08 lwz r0,8(r1)
ffc090fc: 2f 80 00 00 cmpwi cr7,r0,0
ffc09100: 40 9e 00 74 bne- cr7,ffc09174 <pthread_rwlock_timedrdlock+0xbc>
int _EXFUN(pthread_rwlock_init,
(pthread_rwlock_t *__rwlock, _CONST pthread_rwlockattr_t *__attr));
int _EXFUN(pthread_rwlock_destroy, (pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_rdlock,(pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_tryrdlock,(pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_timedrdlock,
ffc09104: 6b bf 00 03 xori r31,r29,3
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
ffc09108: 80 9c 00 00 lwz r4,0(r28)
ffc0910c: 7f ff 00 34 cntlzw r31,r31
ffc09110: 80 c1 00 0c lwz r6,12(r1)
ffc09114: 57 ff d9 7e rlwinm r31,r31,27,5,31
ffc09118: 38 63 00 10 addi r3,r3,16
ffc0911c: 7f e5 fb 78 mr r5,r31
ffc09120: 38 e0 00 00 li r7,0
ffc09124: 48 00 1f 9d bl ffc0b0c0 <_CORE_RWLock_Obtain_for_reading>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
ffc09128: 48 00 3a ed bl ffc0cc14 <_Thread_Enable_dispatch>
if ( !do_wait ) {
ffc0912c: 2f 9f 00 00 cmpwi cr7,r31,0
ffc09130: 40 9e 00 30 bne- cr7,ffc09160 <pthread_rwlock_timedrdlock+0xa8>
if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) {
ffc09134: 3d 20 00 00 lis r9,0
ffc09138: 81 29 30 f0 lwz r9,12528(r9)
ffc0913c: 80 09 00 34 lwz r0,52(r9)
ffc09140: 2f 80 00 02 cmpwi cr7,r0,2
ffc09144: 40 be 00 1c bne+ cr7,ffc09160 <pthread_rwlock_timedrdlock+0xa8>
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc09148: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0914c: 41 9e 00 28 beq- cr7,ffc09174 <pthread_rwlock_timedrdlock+0xbc><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc09150: 3b bd ff ff addi r29,r29,-1
ffc09154: 2b 9d 00 01 cmplwi cr7,r29,1
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc09158: 3b c0 00 74 li r30,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 ||
ffc0915c: 40 9d 00 18 ble- cr7,ffc09174 <pthread_rwlock_timedrdlock+0xbc><== ALWAYS TAKEN
return ETIMEDOUT;
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
(CORE_RWLock_Status) _Thread_Executing->Wait.return_code
ffc09160: 3d 20 00 00 lis r9,0
ffc09164: 81 29 30 f0 lwz r9,12528(r9)
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
ffc09168: 80 69 00 34 lwz r3,52(r9)
ffc0916c: 48 00 00 dd bl ffc09248 <_POSIX_RWLock_Translate_core_RWLock_return_code>
ffc09170: 7c 7e 1b 78 mr r30,r3
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
ffc09174: 39 61 00 28 addi r11,r1,40
ffc09178: 7f c3 f3 78 mr r3,r30
ffc0917c: 4b ff 8c b4 b ffc01e30 <_restgpr_28_x>
ffc09180 <pthread_rwlock_timedwrlock>:
int pthread_rwlock_timedwrlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc09180: 94 21 ff d8 stwu r1,-40(r1)
ffc09184: 7c 08 02 a6 mflr r0
ffc09188: bf 81 00 18 stmw r28,24(r1)
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
ffc0918c: 7c 7c 1b 79 mr. r28,r3
return EINVAL;
ffc09190: 3b c0 00 16 li r30,22
int pthread_rwlock_timedwrlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
ffc09194: 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 )
ffc09198: 41 82 00 a4 beq- ffc0923c <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 );
ffc0919c: 7c 83 23 78 mr r3,r4
ffc091a0: 38 81 00 0c addi r4,r1,12
ffc091a4: 48 00 6b c9 bl ffc0fd6c <_POSIX_Absolute_timeout_to_ticks>
ffc091a8: 80 9c 00 00 lwz r4,0(r28)
ffc091ac: 7c 7d 1b 78 mr r29,r3
ffc091b0: 3c 60 00 00 lis r3,0
ffc091b4: 38 63 2d ac addi r3,r3,11692
ffc091b8: 38 a1 00 08 addi r5,r1,8
ffc091bc: 48 00 2d 61 bl ffc0bf1c <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
ffc091c0: 80 01 00 08 lwz r0,8(r1)
ffc091c4: 2f 80 00 00 cmpwi cr7,r0,0
ffc091c8: 40 9e 00 74 bne- cr7,ffc0923c <pthread_rwlock_timedwrlock+0xbc>
(pthread_rwlock_t *__rwlock, _CONST struct timespec *__abstime));
int _EXFUN(pthread_rwlock_unlock,(pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_wrlock,(pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_trywrlock,(pthread_rwlock_t *__rwlock));
int _EXFUN(pthread_rwlock_timedwrlock,
ffc091cc: 6b bf 00 03 xori r31,r29,3
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
ffc091d0: 80 9c 00 00 lwz r4,0(r28)
ffc091d4: 7f ff 00 34 cntlzw r31,r31
ffc091d8: 80 c1 00 0c lwz r6,12(r1)
ffc091dc: 57 ff d9 7e rlwinm r31,r31,27,5,31
ffc091e0: 38 63 00 10 addi r3,r3,16
ffc091e4: 7f e5 fb 78 mr r5,r31
ffc091e8: 38 e0 00 00 li r7,0
ffc091ec: 48 00 1f b5 bl ffc0b1a0 <_CORE_RWLock_Obtain_for_writing>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
ffc091f0: 48 00 3a 25 bl ffc0cc14 <_Thread_Enable_dispatch>
if ( !do_wait &&
ffc091f4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc091f8: 40 9e 00 30 bne- cr7,ffc09228 <pthread_rwlock_timedwrlock+0xa8>
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
ffc091fc: 3d 20 00 00 lis r9,0
ffc09200: 81 29 30 f0 lwz r9,12528(r9)
ticks,
NULL
);
_Thread_Enable_dispatch();
if ( !do_wait &&
ffc09204: 80 09 00 34 lwz r0,52(r9)
ffc09208: 2f 80 00 02 cmpwi cr7,r0,2
ffc0920c: 40 be 00 1c bne+ cr7,ffc09228 <pthread_rwlock_timedwrlock+0xa8>
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID )
ffc09210: 2f 9d 00 00 cmpwi cr7,r29,0
ffc09214: 41 9e 00 28 beq- cr7,ffc0923c <pthread_rwlock_timedwrlock+0xbc><== NEVER TAKEN
return EINVAL;
if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST ||
ffc09218: 3b bd ff ff addi r29,r29,-1
ffc0921c: 2b 9d 00 01 cmplwi cr7,r29,1
status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW )
return ETIMEDOUT;
ffc09220: 3b c0 00 74 li r30,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 ||
ffc09224: 40 9d 00 18 ble- cr7,ffc0923c <pthread_rwlock_timedwrlock+0xbc><== 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
ffc09228: 3d 20 00 00 lis r9,0
ffc0922c: 81 29 30 f0 lwz r9,12528(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(
ffc09230: 80 69 00 34 lwz r3,52(r9)
ffc09234: 48 00 00 15 bl ffc09248 <_POSIX_RWLock_Translate_core_RWLock_return_code>
ffc09238: 7c 7e 1b 78 mr r30,r3
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
ffc0923c: 39 61 00 28 addi r11,r1,40
ffc09240: 7f c3 f3 78 mr r3,r30
ffc09244: 4b ff 8b ec b ffc01e30 <_restgpr_28_x>
ffc09a14 <pthread_rwlockattr_setpshared>:
int pthread_rwlockattr_setpshared(
pthread_rwlockattr_t *attr,
int pshared
)
{
if ( !attr )
ffc09a14: 2c 03 00 00 cmpwi r3,0
return EINVAL;
ffc09a18: 38 00 00 16 li r0,22
int pthread_rwlockattr_setpshared(
pthread_rwlockattr_t *attr,
int pshared
)
{
if ( !attr )
ffc09a1c: 41 82 00 20 beq- ffc09a3c <pthread_rwlockattr_setpshared+0x28>
return EINVAL;
if ( !attr->is_initialized )
ffc09a20: 81 23 00 00 lwz r9,0(r3)
ffc09a24: 2f 89 00 00 cmpwi cr7,r9,0
ffc09a28: 41 9e 00 14 beq- cr7,ffc09a3c <pthread_rwlockattr_setpshared+0x28>
return EINVAL;
switch ( pshared ) {
ffc09a2c: 2b 84 00 01 cmplwi cr7,r4,1
ffc09a30: 41 9d 00 0c bgt- cr7,ffc09a3c <pthread_rwlockattr_setpshared+0x28><== NEVER TAKEN
case PTHREAD_PROCESS_SHARED:
case PTHREAD_PROCESS_PRIVATE:
attr->process_shared = pshared;
ffc09a34: 90 83 00 04 stw r4,4(r3)
return 0;
ffc09a38: 38 00 00 00 li r0,0
default:
return EINVAL;
}
}
ffc09a3c: 7c 03 03 78 mr r3,r0
ffc09a40: 4e 80 00 20 blr
ffc0ab40 <pthread_setschedparam>:
int pthread_setschedparam(
pthread_t thread,
int policy,
struct sched_param *param
)
{
ffc0ab40: 94 21 ff d0 stwu r1,-48(r1)
ffc0ab44: 7c 08 02 a6 mflr r0
ffc0ab48: bf 61 00 1c stmw r27,28(r1)
int rc;
/*
* Check all the parameters
*/
if ( !param )
ffc0ab4c: 7c bd 2b 79 mr. r29,r5
int pthread_setschedparam(
pthread_t thread,
int policy,
struct sched_param *param
)
{
ffc0ab50: 7c 7c 1b 78 mr r28,r3
ffc0ab54: 90 01 00 34 stw r0,52(r1)
ffc0ab58: 7c 9f 23 78 mr r31,r4
/*
* Check all the parameters
*/
if ( !param )
return EINVAL;
ffc0ab5c: 3b c0 00 16 li r30,22
int rc;
/*
* Check all the parameters
*/
if ( !param )
ffc0ab60: 41 82 00 f0 beq- ffc0ac50 <pthread_setschedparam+0x110>
return EINVAL;
rc = _POSIX_Thread_Translate_sched_param(
ffc0ab64: 7c 83 23 78 mr r3,r4
ffc0ab68: 38 a1 00 08 addi r5,r1,8
ffc0ab6c: 7f a4 eb 78 mr r4,r29
ffc0ab70: 38 c1 00 0c addi r6,r1,12
ffc0ab74: 48 00 63 c9 bl ffc10f3c <_POSIX_Thread_Translate_sched_param>
policy,
param,
&budget_algorithm,
&budget_callout
);
if ( rc )
ffc0ab78: 7c 7e 1b 79 mr. r30,r3
ffc0ab7c: 40 82 00 d4 bne- ffc0ac50 <pthread_setschedparam+0x110>
ffc0ab80: 3c 60 00 00 lis r3,0
ffc0ab84: 38 63 2e 4c addi r3,r3,11852
ffc0ab88: 7f 84 e3 78 mr r4,r28
ffc0ab8c: 38 a1 00 10 addi r5,r1,16
ffc0ab90: 48 00 22 bd bl ffc0ce4c <_Objects_Get>
/*
* Actually change the scheduling policy and parameters
*/
the_thread = _POSIX_Threads_Get( thread, &location );
switch ( location ) {
ffc0ab94: 80 01 00 10 lwz r0,16(r1)
ffc0ab98: 7c 7b 1b 78 mr r27,r3
ffc0ab9c: 2f 80 00 00 cmpwi cr7,r0,0
ffc0aba0: 40 9e 00 ac bne- cr7,ffc0ac4c <pthread_setschedparam+0x10c>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc0aba4: 83 83 01 34 lwz r28,308(r3)
if ( api->schedpolicy == SCHED_SPORADIC )
ffc0aba8: 80 1c 00 84 lwz r0,132(r28)
ffc0abac: 2f 80 00 04 cmpwi cr7,r0,4
ffc0abb0: 40 be 00 0c bne+ cr7,ffc0abbc <pthread_setschedparam+0x7c>
(void) _Watchdog_Remove( &api->Sporadic_timer );
ffc0abb4: 38 7c 00 a8 addi r3,r28,168
ffc0abb8: 48 00 43 dd bl ffc0ef94 <_Watchdog_Remove>
api->schedpolicy = policy;
api->schedparam = *param;
the_thread->budget_algorithm = budget_algorithm;
the_thread->budget_callout = budget_callout;
switch ( api->schedpolicy ) {
ffc0abbc: 2f 9f 00 00 cmpwi cr7,r31,0
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
if ( api->schedpolicy == SCHED_SPORADIC )
(void) _Watchdog_Remove( &api->Sporadic_timer );
api->schedpolicy = policy;
ffc0abc0: 93 fc 00 84 stw r31,132(r28)
api->schedparam = *param;
ffc0abc4: 38 9c 00 88 addi r4,r28,136
the_thread->budget_algorithm = budget_algorithm;
ffc0abc8: 80 01 00 08 lwz r0,8(r1)
if ( api->schedpolicy == SCHED_SPORADIC )
(void) _Watchdog_Remove( &api->Sporadic_timer );
api->schedpolicy = policy;
api->schedparam = *param;
ffc0abcc: 7c bd e4 aa lswi r5,r29,28
ffc0abd0: 7c a4 e5 aa stswi r5,r4,28
the_thread->budget_algorithm = budget_algorithm;
ffc0abd4: 90 1b 00 7c stw r0,124(r27)
the_thread->budget_callout = budget_callout;
ffc0abd8: 80 01 00 0c lwz r0,12(r1)
ffc0abdc: 90 1b 00 80 stw r0,128(r27)
switch ( api->schedpolicy ) {
ffc0abe0: 41 9c 00 64 blt- cr7,ffc0ac44 <pthread_setschedparam+0x104><== NEVER TAKEN
ffc0abe4: 2f 9f 00 02 cmpwi cr7,r31,2
ffc0abe8: 40 9d 00 10 ble- cr7,ffc0abf8 <pthread_setschedparam+0xb8>
ffc0abec: 2f 9f 00 04 cmpwi cr7,r31,4
ffc0abf0: 40 be 00 54 bne+ cr7,ffc0ac44 <pthread_setschedparam+0x104><== NEVER TAKEN
ffc0abf4: 48 00 00 34 b ffc0ac28 <pthread_setschedparam+0xe8>
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0abf8: 3d 20 00 00 lis r9,0
ffc0abfc: 80 09 28 08 lwz r0,10248(r9)
ffc0ac00: 3d 20 00 00 lis r9,0
ffc0ac04: 88 89 27 14 lbz r4,10004(r9)
the_thread->real_priority =
_POSIX_Priority_To_core( api->schedparam.sched_priority );
_Thread_Change_priority(
ffc0ac08: 7f 63 db 78 mr r3,r27
switch ( api->schedpolicy ) {
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc0ac0c: 90 1b 00 78 stw r0,120(r27)
the_thread->real_priority =
_POSIX_Priority_To_core( api->schedparam.sched_priority );
_Thread_Change_priority(
ffc0ac10: 38 a0 00 01 li r5,1
ffc0ac14: 80 1c 00 88 lwz r0,136(r28)
ffc0ac18: 7c 80 20 50 subf r4,r0,r4
case SCHED_OTHER:
case SCHED_FIFO:
case SCHED_RR:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
the_thread->real_priority =
ffc0ac1c: 90 9b 00 18 stw r4,24(r27)
_POSIX_Priority_To_core( api->schedparam.sched_priority );
_Thread_Change_priority(
ffc0ac20: 48 00 29 bd bl ffc0d5dc <_Thread_Change_priority>
the_thread,
the_thread->real_priority,
true
);
break;
ffc0ac24: 48 00 00 20 b ffc0ac44 <pthread_setschedparam+0x104>
case SCHED_SPORADIC:
api->ss_high_priority = api->schedparam.sched_priority;
ffc0ac28: 80 1c 00 88 lwz r0,136(r28)
_Watchdog_Remove( &api->Sporadic_timer );
ffc0ac2c: 38 7c 00 a8 addi r3,r28,168
true
);
break;
case SCHED_SPORADIC:
api->ss_high_priority = api->schedparam.sched_priority;
ffc0ac30: 90 1c 00 a4 stw r0,164(r28)
_Watchdog_Remove( &api->Sporadic_timer );
ffc0ac34: 48 00 43 61 bl ffc0ef94 <_Watchdog_Remove>
_POSIX_Threads_Sporadic_budget_TSR( 0, the_thread );
ffc0ac38: 38 60 00 00 li r3,0
ffc0ac3c: 7f 64 db 78 mr r4,r27
ffc0ac40: 4b ff fd b9 bl ffc0a9f8 <_POSIX_Threads_Sporadic_budget_TSR>
break;
}
_Thread_Enable_dispatch();
ffc0ac44: 48 00 2f 01 bl ffc0db44 <_Thread_Enable_dispatch>
return 0;
ffc0ac48: 48 00 00 08 b ffc0ac50 <pthread_setschedparam+0x110>
#endif
case OBJECTS_ERROR:
break;
}
return ESRCH;
ffc0ac4c: 3b c0 00 03 li r30,3
}
ffc0ac50: 39 61 00 30 addi r11,r1,48
ffc0ac54: 7f c3 f3 78 mr r3,r30
ffc0ac58: 4b ff 7f 24 b ffc02b7c <_restgpr_27_x>
ffc07f50 <pthread_testcancel>:
*
* 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183
*/
void pthread_testcancel( void )
{
ffc07f50: 7c 08 02 a6 mflr r0
ffc07f54: 7c 2b 0b 78 mr r11,r1
ffc07f58: 94 21 ff f0 stwu r1,-16(r1)
* 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() )
ffc07f5c: 3d 20 00 00 lis r9,0
ffc07f60: 39 29 30 e4 addi r9,r9,12516
*
* 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183
*/
void pthread_testcancel( void )
{
ffc07f64: 90 01 00 14 stw r0,20(r1)
ffc07f68: 48 00 e5 05 bl ffc1646c <_savegpr_31>
* 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() )
ffc07f6c: 80 09 00 08 lwz r0,8(r9)
ffc07f70: 2f 80 00 00 cmpwi cr7,r0,0
ffc07f74: 40 9e 00 58 bne- cr7,ffc07fcc <pthread_testcancel+0x7c> <== NEVER TAKEN
ffc07f78: 3d 60 00 00 lis r11,0
return;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
ffc07f7c: 81 29 00 0c lwz r9,12(r9)
ffc07f80: 81 4b 27 b0 lwz r10,10160(r11)
ffc07f84: 81 29 01 34 lwz r9,308(r9)
ffc07f88: 38 0a 00 01 addi r0,r10,1
ffc07f8c: 90 0b 27 b0 stw r0,10160(r11)
_Thread_Disable_dispatch();
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
ffc07f90: 80 09 00 d8 lwz r0,216(r9)
*/
void pthread_testcancel( void )
{
POSIX_API_Control *thread_support;
bool cancel = false;
ffc07f94: 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 &&
ffc07f98: 2f 80 00 00 cmpwi cr7,r0,0
ffc07f9c: 40 9e 00 14 bne- cr7,ffc07fb0 <pthread_testcancel+0x60> <== NEVER TAKEN
/* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */
int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate));
int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype));
void _EXFUN(pthread_testcancel, (void));
ffc07fa0: 80 09 00 e0 lwz r0,224(r9)
ffc07fa4: 7c 00 00 34 cntlzw r0,r0
ffc07fa8: 54 00 d9 7e rlwinm r0,r0,27,5,31
ffc07fac: 68 1f 00 01 xori r31,r0,1
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
ffc07fb0: 48 00 2e 2d bl ffc0addc <_Thread_Enable_dispatch>
if ( cancel )
ffc07fb4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc07fb8: 41 be 00 14 beq+ cr7,ffc07fcc <pthread_testcancel+0x7c>
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
ffc07fbc: 3d 20 00 00 lis r9,0
ffc07fc0: 80 69 30 f0 lwz r3,12528(r9)
ffc07fc4: 38 80 ff ff li r4,-1
ffc07fc8: 48 00 63 25 bl ffc0e2ec <_POSIX_Thread_Exit>
}
ffc07fcc: 39 61 00 10 addi r11,r1,16
ffc07fd0: 48 00 e4 e8 b ffc164b8 <_restgpr_31_x>
ffc08c98 <rtems_aio_enqueue>:
* errno - otherwise
*/
int
rtems_aio_enqueue (rtems_aio_request *req)
{
ffc08c98: 94 21 ff a8 stwu r1,-88(r1)
ffc08c9c: 7c 08 02 a6 mflr r0
ffc08ca0: bf 21 00 3c stmw r25,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);
ffc08ca4: 3f e0 00 00 lis r31,0
ffc08ca8: 3b ff 2c 08 addi r31,r31,11272
* errno - otherwise
*/
int
rtems_aio_enqueue (rtems_aio_request *req)
{
ffc08cac: 7c 7d 1b 78 mr r29,r3
ffc08cb0: 90 01 00 5c stw r0,92(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);
ffc08cb4: 7f e3 fb 78 mr r3,r31
ffc08cb8: 48 00 0a 49 bl ffc09700 <pthread_mutex_lock>
if (result != 0) {
ffc08cbc: 7c 7e 1b 79 mr. r30,r3
ffc08cc0: 41 a2 00 10 beq+ ffc08cd0 <rtems_aio_enqueue+0x38> <== ALWAYS TAKEN
free (req);
ffc08cc4: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED
ffc08cc8: 4b ff c4 0d bl ffc050d4 <free> <== NOT EXECUTED
return result;
ffc08ccc: 48 00 01 dc b ffc08ea8 <rtems_aio_enqueue+0x210> <== NOT EXECUTED
}
/* _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);
ffc08cd0: 48 00 13 19 bl ffc09fe8 <pthread_self>
ffc08cd4: 38 81 00 0c addi r4,r1,12
ffc08cd8: 38 a1 00 10 addi r5,r1,16
ffc08cdc: 48 00 0e a9 bl ffc09b84 <pthread_getschedparam>
req->caller_thread = pthread_self ();
ffc08ce0: 48 00 13 09 bl ffc09fe8 <pthread_self>
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
ffc08ce4: 81 3d 00 14 lwz r9,20(r29)
ffc08ce8: 81 61 00 10 lwz r11,16(r1)
ffc08cec: 80 09 00 18 lwz r0,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 ();
ffc08cf0: 90 7d 00 10 stw r3,16(r29)
req->priority = param.sched_priority - req->aiocbp->aio_reqprio;
ffc08cf4: 7c 00 58 50 subf r0,r0,r11
ffc08cf8: 90 1d 00 0c stw r0,12(r29)
req->policy = policy;
ffc08cfc: 80 01 00 0c lwz r0,12(r1)
ffc08d00: 90 1d 00 08 stw r0,8(r29)
req->aiocbp->error_code = EINPROGRESS;
ffc08d04: 38 00 00 77 li r0,119
ffc08d08: 90 09 00 34 stw r0,52(r9)
req->aiocbp->return_value = 0;
if ((aio_request_queue.idle_threads == 0) &&
ffc08d0c: 80 1f 00 68 lwz r0,104(r31)
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;
ffc08d10: 93 c9 00 38 stw r30,56(r9)
if ((aio_request_queue.idle_threads == 0) &&
ffc08d14: 2f 80 00 00 cmpwi cr7,r0,0
ffc08d18: 40 9e 00 c8 bne- cr7,ffc08de0 <rtems_aio_enqueue+0x148>
ffc08d1c: 80 1f 00 64 lwz r0,100(r31)
ffc08d20: 2f 80 00 04 cmpwi cr7,r0,4
ffc08d24: 41 bd 00 bc bgt+ cr7,ffc08de0 <rtems_aio_enqueue+0x148>
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);
ffc08d28: 80 89 00 00 lwz r4,0(r9)
ffc08d2c: 38 7f 00 48 addi r3,r31,72
ffc08d30: 38 a0 00 01 li r5,1
ffc08d34: 4b ff fa f9 bl ffc0882c <rtems_aio_search_fd>
if (r_chain->new_fd == 1) {
ffc08d38: 80 03 00 18 lwz r0,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);
ffc08d3c: 7c 7c 1b 78 mr r28,r3
ffc08d40: 3b 23 00 08 addi r25,r3,8
if (r_chain->new_fd == 1) {
ffc08d44: 2f 80 00 01 cmpwi cr7,r0,1
ffc08d48: 3b 63 00 1c addi r27,r3,28
ffc08d4c: 3b 43 00 20 addi r26,r3,32
ffc08d50: 40 be 00 6c bne+ cr7,ffc08dbc <rtems_aio_enqueue+0x124>
RTEMS_INLINE_ROUTINE void _Chain_Prepend(
Chain_Control *the_chain,
Chain_Node *the_node
)
{
_Chain_Insert(_Chain_Head(the_chain), the_node);
ffc08d54: 7f a4 eb 78 mr r4,r29
ffc08d58: 7f 23 cb 78 mr r3,r25
ffc08d5c: 48 00 26 1d bl ffc0b378 <_Chain_Insert>
rtems_chain_prepend (&r_chain->perfd, &req->next_prio);
r_chain->new_fd = 0;
ffc08d60: 93 dc 00 18 stw r30,24(r28)
pthread_mutex_init (&r_chain->mutex, NULL);
ffc08d64: 38 80 00 00 li r4,0
ffc08d68: 7f 63 db 78 mr r3,r27
ffc08d6c: 48 00 08 35 bl ffc095a0 <pthread_mutex_init>
pthread_cond_init (&r_chain->cond, NULL);
ffc08d70: 38 80 00 00 li r4,0
ffc08d74: 7f 43 d3 78 mr r3,r26
ffc08d78: 48 00 03 dd bl ffc09154 <pthread_cond_init>
AIO_printf ("New thread \n");
result = pthread_create (&thid, &aio_request_queue.attr,
ffc08d7c: 3c a0 ff c1 lis r5,-63
ffc08d80: 38 61 00 08 addi r3,r1,8
ffc08d84: 38 9f 00 08 addi r4,r31,8
ffc08d88: 38 a5 88 f4 addi r5,r5,-30476
ffc08d8c: 7f 86 e3 78 mr r6,r28
ffc08d90: 48 00 0b bd bl ffc0994c <pthread_create>
rtems_aio_handle, (void *) r_chain);
if (result != 0) {
ffc08d94: 7c 7d 1b 79 mr. r29,r3
ffc08d98: 41 a2 00 14 beq+ ffc08dac <rtems_aio_enqueue+0x114> <== ALWAYS TAKEN
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08d9c: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08da0: 48 00 0a 05 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
return result;
ffc08da4: 7f be eb 78 mr r30,r29 <== NOT EXECUTED
ffc08da8: 48 00 01 00 b ffc08ea8 <rtems_aio_enqueue+0x210> <== NOT EXECUTED
}
++aio_request_queue.active_threads;
ffc08dac: 81 3f 00 64 lwz r9,100(r31)
ffc08db0: 38 09 00 01 addi r0,r9,1
ffc08db4: 90 1f 00 64 stw r0,100(r31)
ffc08db8: 48 00 00 e4 b ffc08e9c <rtems_aio_enqueue+0x204>
}
else {
/* put request in the fd chain it belongs to */
pthread_mutex_lock (&r_chain->mutex);
ffc08dbc: 7f 63 db 78 mr r3,r27
ffc08dc0: 48 00 09 41 bl ffc09700 <pthread_mutex_lock>
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc08dc4: 7f 23 cb 78 mr r3,r25
ffc08dc8: 7f a4 eb 78 mr r4,r29
ffc08dcc: 4b ff fd 91 bl ffc08b5c <rtems_aio_insert_prio>
pthread_cond_signal (&r_chain->cond);
ffc08dd0: 7f 43 d3 78 mr r3,r26
ffc08dd4: 48 00 04 45 bl ffc09218 <pthread_cond_signal>
pthread_mutex_unlock (&r_chain->mutex);
ffc08dd8: 7f 63 db 78 mr r3,r27
ffc08ddc: 48 00 00 48 b ffc08e24 <rtems_aio_enqueue+0x18c>
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,
ffc08de0: 3f e0 00 00 lis r31,0
ffc08de4: 80 89 00 00 lwz r4,0(r9)
ffc08de8: 3b ff 2c 50 addi r31,r31,11344
ffc08dec: 7f e3 fb 78 mr r3,r31
ffc08df0: 38 a0 00 00 li r5,0
ffc08df4: 4b ff fa 39 bl ffc0882c <rtems_aio_search_fd>
req->aiocbp->aio_fildes, 0);
if (r_chain != NULL)
ffc08df8: 7c 7c 1b 79 mr. r28,r3
ffc08dfc: 41 82 00 30 beq- ffc08e2c <rtems_aio_enqueue+0x194> <== ALWAYS TAKEN
{
pthread_mutex_lock (&r_chain->mutex);
ffc08e00: 3b fc 00 1c addi r31,r28,28 <== NOT EXECUTED
ffc08e04: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08e08: 48 00 08 f9 bl ffc09700 <pthread_mutex_lock> <== NOT EXECUTED
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc08e0c: 38 7c 00 08 addi r3,r28,8 <== NOT EXECUTED
ffc08e10: 7f a4 eb 78 mr r4,r29 <== NOT EXECUTED
ffc08e14: 4b ff fd 49 bl ffc08b5c <rtems_aio_insert_prio> <== NOT EXECUTED
pthread_cond_signal (&r_chain->cond);
ffc08e18: 38 7c 00 20 addi r3,r28,32 <== NOT EXECUTED
ffc08e1c: 48 00 03 fd bl ffc09218 <pthread_cond_signal> <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
ffc08e20: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08e24: 48 00 09 81 bl ffc097a4 <pthread_mutex_unlock>
ffc08e28: 48 00 00 74 b ffc08e9c <rtems_aio_enqueue+0x204>
} else {
/* or to the idle chain */
chain = &aio_request_queue.idle_req;
r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1);
ffc08e2c: 81 3d 00 14 lwz r9,20(r29)
ffc08e30: 38 7f 00 0c addi r3,r31,12
ffc08e34: 38 a0 00 01 li r5,1
ffc08e38: 80 89 00 00 lwz r4,0(r9)
ffc08e3c: 4b ff f9 f1 bl ffc0882c <rtems_aio_search_fd>
if (r_chain->new_fd == 1) {
ffc08e40: 80 03 00 18 lwz r0,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);
ffc08e44: 7c 7b 1b 78 mr r27,r3
ffc08e48: 38 63 00 08 addi r3,r3,8
if (r_chain->new_fd == 1) {
ffc08e4c: 2f 80 00 01 cmpwi cr7,r0,1
ffc08e50: 40 be 00 44 bne+ cr7,ffc08e94 <rtems_aio_enqueue+0x1fc>
ffc08e54: 7f a4 eb 78 mr r4,r29
ffc08e58: 48 00 25 21 bl ffc0b378 <_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;
ffc08e5c: 93 9b 00 18 stw r28,24(r27)
pthread_mutex_init (&r_chain->mutex, NULL);
ffc08e60: 38 80 00 00 li r4,0
ffc08e64: 38 7b 00 1c addi r3,r27,28
ffc08e68: 48 00 07 39 bl ffc095a0 <pthread_mutex_init>
pthread_cond_init (&r_chain->cond, NULL);
ffc08e6c: 38 80 00 00 li r4,0
ffc08e70: 38 7b 00 20 addi r3,r27,32
ffc08e74: 48 00 02 e1 bl ffc09154 <pthread_cond_init>
pthread_cond_signal (&aio_request_queue.new_req);
ffc08e78: 38 7f ff bc addi r3,r31,-68
++aio_request_queue.idle_threads;
ffc08e7c: 3b ff ff b8 addi r31,r31,-72
AIO_printf (" New chain on waiting queue \n ");
rtems_chain_prepend (&r_chain->perfd, &req->next_prio);
r_chain->new_fd = 0;
pthread_mutex_init (&r_chain->mutex, NULL);
pthread_cond_init (&r_chain->cond, NULL);
pthread_cond_signal (&aio_request_queue.new_req);
ffc08e80: 48 00 03 99 bl ffc09218 <pthread_cond_signal>
++aio_request_queue.idle_threads;
ffc08e84: 81 3f 00 68 lwz r9,104(r31)
ffc08e88: 38 09 00 01 addi r0,r9,1
ffc08e8c: 90 1f 00 68 stw r0,104(r31)
ffc08e90: 48 00 00 0c b ffc08e9c <rtems_aio_enqueue+0x204>
} else
/* just insert the request in the existing fd chain */
rtems_aio_insert_prio (&r_chain->perfd, req);
ffc08e94: 7f a4 eb 78 mr r4,r29
ffc08e98: 4b ff fc c5 bl ffc08b5c <rtems_aio_insert_prio>
}
}
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08e9c: 3c 60 00 00 lis r3,0
ffc08ea0: 38 63 2c 08 addi r3,r3,11272
ffc08ea4: 48 00 09 01 bl ffc097a4 <pthread_mutex_unlock>
return 0;
}
ffc08ea8: 39 61 00 58 addi r11,r1,88
ffc08eac: 7f c3 f3 78 mr r3,r30
ffc08eb0: 4b ff 7c 70 b ffc00b20 <_restgpr_25_x>
ffc088f4 <rtems_aio_handle>:
* NULL - if error
*/
static void *
rtems_aio_handle (void *arg)
{
ffc088f4: 94 21 ff 98 stwu r1,-104(r1) <== NOT EXECUTED
ffc088f8: 7c 08 02 a6 mflr r0 <== NOT EXECUTED
ffc088fc: be 81 00 38 stmw r20,56(r1) <== NOT EXECUTED
The fd chain is already unlocked */
struct timespec timeout;
pthread_mutex_unlock (&r_chain->mutex);
pthread_mutex_lock (&aio_request_queue.mutex);
ffc08900: 3f e0 00 00 lis r31,0 <== NOT EXECUTED
ffc08904: 3b ff 2c 08 addi r31,r31,11272 <== NOT EXECUTED
* NULL - if error
*/
static void *
rtems_aio_handle (void *arg)
{
ffc08908: 90 01 00 6c stw r0,108(r1) <== NOT EXECUTED
ffc0890c: 7c 7e 1b 78 mr r30,r3 <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08910: 3b a1 00 0c addi r29,r1,12 <== NOT EXECUTED
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)) {
ffc08914: 3a ff 00 58 addi r23,r31,88 <== NOT EXECUTED
++aio_request_queue.idle_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08918: 3b 1f 00 04 addi r24,r31,4 <== NOT EXECUTED
/* Otherwise move this chain to the working chain and
start the loop all over again */
--aio_request_queue.idle_threads;
node = rtems_chain_first (&aio_request_queue.idle_req);
rtems_chain_extract (node);
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc0891c: 3b 3f 00 48 addi r25,r31,72 <== NOT EXECUTED
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);
ffc08920: 3b 81 00 14 addi r28,r1,20 <== NOT EXECUTED
ffc08924: 3b 41 00 08 addi r26,r1,8 <== NOT EXECUTED
default:
result = -1;
}
if (result == -1) {
req->aiocbp->return_value = -1;
ffc08928: 3b 60 ff ff li r27,-1 <== NOT EXECUTED
/* 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);
ffc0892c: 3a be 00 1c addi r21,r30,28 <== NOT EXECUTED
ffc08930: 7e a3 ab 78 mr r3,r21 <== NOT EXECUTED
ffc08934: 48 00 0d cd bl ffc09700 <pthread_mutex_lock> <== NOT EXECUTED
if (result != 0)
ffc08938: 7c 74 1b 79 mr. r20,r3 <== NOT EXECUTED
ffc0893c: 40 82 02 14 bne- ffc08b50 <rtems_aio_handle+0x25c> <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08940: 82 de 00 08 lwz r22,8(r30) <== NOT EXECUTED
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
const Chain_Control *the_chain
)
{
return _Chain_Immutable_first( the_chain )
== _Chain_Immutable_tail( the_chain );
ffc08944: 38 1e 00 0c addi r0,r30,12 <== NOT EXECUTED
/* 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)) {
ffc08948: 7f 96 00 00 cmpw cr7,r22,r0 <== NOT EXECUTED
ffc0894c: 41 9e 00 d0 beq- cr7,ffc08a1c <rtems_aio_handle+0x128> <== NOT EXECUTED
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);
ffc08950: 48 00 16 99 bl ffc09fe8 <pthread_self> <== NOT EXECUTED
ffc08954: 7f 44 d3 78 mr r4,r26 <== NOT EXECUTED
ffc08958: 7f 85 e3 78 mr r5,r28 <== NOT EXECUTED
ffc0895c: 48 00 12 29 bl ffc09b84 <pthread_getschedparam> <== NOT EXECUTED
param.sched_priority = req->priority;
ffc08960: 80 16 00 0c lwz r0,12(r22) <== NOT EXECUTED
ffc08964: 90 01 00 14 stw r0,20(r1) <== NOT EXECUTED
pthread_setschedparam (pthread_self(), req->policy, ¶m);
ffc08968: 48 00 16 81 bl ffc09fe8 <pthread_self> <== NOT EXECUTED
ffc0896c: 7f 85 e3 78 mr r5,r28 <== NOT EXECUTED
ffc08970: 80 96 00 08 lwz r4,8(r22) <== NOT EXECUTED
ffc08974: 48 00 16 85 bl ffc09ff8 <pthread_setschedparam> <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE void rtems_chain_extract(
rtems_chain_node *the_node
)
{
_Chain_Extract( the_node );
ffc08978: 7e c3 b3 78 mr r3,r22 <== NOT EXECUTED
ffc0897c: 48 00 29 95 bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
rtems_chain_extract (node);
pthread_mutex_unlock (&r_chain->mutex);
ffc08980: 7e a3 ab 78 mr r3,r21 <== NOT EXECUTED
ffc08984: 48 00 0e 21 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
switch (req->aiocbp->aio_lio_opcode) {
ffc08988: 81 36 00 14 lwz r9,20(r22) <== NOT EXECUTED
ffc0898c: 80 09 00 30 lwz r0,48(r9) <== NOT EXECUTED
ffc08990: 2f 80 00 02 cmpwi cr7,r0,2 <== NOT EXECUTED
ffc08994: 41 9e 00 30 beq- cr7,ffc089c4 <rtems_aio_handle+0xd0> <== NOT EXECUTED
ffc08998: 2f 80 00 03 cmpwi cr7,r0,3 <== NOT EXECUTED
ffc0899c: 41 9e 00 44 beq- cr7,ffc089e0 <rtems_aio_handle+0xec> <== NOT EXECUTED
ffc089a0: 2f 80 00 01 cmpwi cr7,r0,1 <== NOT EXECUTED
ffc089a4: 40 be 00 4c bne+ cr7,ffc089f0 <rtems_aio_handle+0xfc> <== NOT EXECUTED
case LIO_READ:
result = pread (req->aiocbp->aio_fildes,
ffc089a8: 80 69 00 00 lwz r3,0(r9) <== NOT EXECUTED
ffc089ac: 80 89 00 10 lwz r4,16(r9) <== NOT EXECUTED
ffc089b0: 80 a9 00 14 lwz r5,20(r9) <== NOT EXECUTED
ffc089b4: 80 e9 00 08 lwz r7,8(r9) <== NOT EXECUTED
ffc089b8: 81 09 00 0c lwz r8,12(r9) <== NOT EXECUTED
ffc089bc: 48 00 b8 3d bl ffc141f8 <pread> <== NOT EXECUTED
(void *) req->aiocbp->aio_buf,
req->aiocbp->aio_nbytes, req->aiocbp->aio_offset);
break;
ffc089c0: 48 00 00 28 b ffc089e8 <rtems_aio_handle+0xf4> <== NOT EXECUTED
case LIO_WRITE:
result = pwrite (req->aiocbp->aio_fildes,
ffc089c4: 80 69 00 00 lwz r3,0(r9) <== NOT EXECUTED
ffc089c8: 80 89 00 10 lwz r4,16(r9) <== NOT EXECUTED
ffc089cc: 80 a9 00 14 lwz r5,20(r9) <== NOT EXECUTED
ffc089d0: 80 e9 00 08 lwz r7,8(r9) <== NOT EXECUTED
ffc089d4: 81 09 00 0c lwz r8,12(r9) <== NOT EXECUTED
ffc089d8: 48 00 b9 51 bl ffc14328 <pwrite> <== NOT EXECUTED
(void *) req->aiocbp->aio_buf,
req->aiocbp->aio_nbytes, req->aiocbp->aio_offset);
break;
ffc089dc: 48 00 00 0c b ffc089e8 <rtems_aio_handle+0xf4> <== NOT EXECUTED
case LIO_SYNC:
result = fsync (req->aiocbp->aio_fildes);
ffc089e0: 80 69 00 00 lwz r3,0(r9) <== NOT EXECUTED
ffc089e4: 48 00 70 d9 bl ffc0fabc <fsync> <== NOT EXECUTED
break;
default:
result = -1;
}
if (result == -1) {
ffc089e8: 2f 83 ff ff cmpwi cr7,r3,-1 <== NOT EXECUTED
ffc089ec: 40 be 00 1c bne+ cr7,ffc08a08 <rtems_aio_handle+0x114> <== NOT EXECUTED
req->aiocbp->return_value = -1;
ffc089f0: 82 d6 00 14 lwz r22,20(r22) <== NOT EXECUTED
ffc089f4: 93 76 00 38 stw r27,56(r22) <== NOT EXECUTED
req->aiocbp->error_code = errno;
ffc089f8: 48 00 a8 a5 bl ffc1329c <__errno> <== NOT EXECUTED
ffc089fc: 80 03 00 00 lwz r0,0(r3) <== NOT EXECUTED
ffc08a00: 90 16 00 34 stw r0,52(r22) <== NOT EXECUTED
ffc08a04: 4b ff ff 28 b ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
} else {
req->aiocbp->return_value = result;
ffc08a08: 81 36 00 14 lwz r9,20(r22) <== NOT EXECUTED
req->aiocbp->error_code = 0;
ffc08a0c: 38 00 00 00 li r0,0 <== NOT EXECUTED
}
if (result == -1) {
req->aiocbp->return_value = -1;
req->aiocbp->error_code = errno;
} else {
req->aiocbp->return_value = result;
ffc08a10: 90 69 00 38 stw r3,56(r9) <== NOT EXECUTED
req->aiocbp->error_code = 0;
ffc08a14: 90 09 00 34 stw r0,52(r9) <== NOT EXECUTED
ffc08a18: 4b ff ff 14 b ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
wait for a signal on chain, this will unlock the queue.
The fd chain is already unlocked */
struct timespec timeout;
pthread_mutex_unlock (&r_chain->mutex);
ffc08a1c: 7e a3 ab 78 mr r3,r21 <== NOT EXECUTED
ffc08a20: 48 00 0d 85 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
pthread_mutex_lock (&aio_request_queue.mutex);
ffc08a24: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08a28: 48 00 0c d9 bl ffc09700 <pthread_mutex_lock> <== NOT EXECUTED
if (rtems_chain_is_empty (chain))
ffc08a2c: 80 1e 00 08 lwz r0,8(r30) <== NOT EXECUTED
ffc08a30: 7f 80 b0 00 cmpw cr7,r0,r22 <== NOT EXECUTED
ffc08a34: 40 9e fe f8 bne+ cr7,ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
{
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08a38: 7f a4 eb 78 mr r4,r29 <== NOT EXECUTED
ffc08a3c: 38 60 00 01 li r3,1 <== NOT EXECUTED
ffc08a40: 48 00 05 b5 bl ffc08ff4 <clock_gettime> <== NOT EXECUTED
timeout.tv_sec += 3;
ffc08a44: 81 21 00 0c lwz r9,12(r1) <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a48: 3a de 00 20 addi r22,r30,32 <== NOT EXECUTED
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
ffc08a4c: 92 81 00 10 stw r20,16(r1) <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08a50: 38 09 00 03 addi r0,r9,3 <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a54: 7e c3 b3 78 mr r3,r22 <== NOT EXECUTED
pthread_mutex_unlock (&r_chain->mutex);
pthread_mutex_lock (&aio_request_queue.mutex);
if (rtems_chain_is_empty (chain))
{
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08a58: 90 01 00 0c stw r0,12(r1) <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&r_chain->cond,
ffc08a5c: 7f e4 fb 78 mr r4,r31 <== NOT EXECUTED
ffc08a60: 7f a5 eb 78 mr r5,r29 <== NOT EXECUTED
ffc08a64: 48 00 08 51 bl ffc092b4 <pthread_cond_timedwait> <== NOT EXECUTED
&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) {
ffc08a68: 2f 83 00 74 cmpwi cr7,r3,116 <== NOT EXECUTED
ffc08a6c: 40 9e fe c0 bne+ cr7,ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
ffc08a70: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc08a74: 48 00 28 9d bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
rtems_chain_extract (&r_chain->next_fd);
pthread_mutex_destroy (&r_chain->mutex);
ffc08a78: 7e a3 ab 78 mr r3,r21 <== NOT EXECUTED
ffc08a7c: 48 00 09 b9 bl ffc09434 <pthread_mutex_destroy> <== NOT EXECUTED
pthread_cond_destroy (&r_chain->cond);
ffc08a80: 7e c3 b3 78 mr r3,r22 <== NOT EXECUTED
ffc08a84: 48 00 05 e9 bl ffc0906c <pthread_cond_destroy> <== NOT EXECUTED
free (r_chain);
ffc08a88: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED
ffc08a8c: 4b ff c6 49 bl ffc050d4 <free> <== NOT EXECUTED
/* 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)) {
ffc08a90: 80 1f 00 54 lwz r0,84(r31) <== NOT EXECUTED
ffc08a94: 7f 80 b8 00 cmpw cr7,r0,r23 <== NOT EXECUTED
ffc08a98: 40 be 00 ac bne+ cr7,ffc08b44 <rtems_aio_handle+0x250> <== NOT EXECUTED
++aio_request_queue.idle_threads;
ffc08a9c: 81 3f 00 68 lwz r9,104(r31) <== NOT EXECUTED
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08aa0: 7f a4 eb 78 mr r4,r29 <== NOT EXECUTED
ffc08aa4: 38 60 00 01 li r3,1 <== NOT EXECUTED
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)) {
++aio_request_queue.idle_threads;
ffc08aa8: 38 09 00 01 addi r0,r9,1 <== NOT EXECUTED
ffc08aac: 90 1f 00 68 stw r0,104(r31) <== NOT EXECUTED
clock_gettime (CLOCK_REALTIME, &timeout);
ffc08ab0: 48 00 05 45 bl ffc08ff4 <clock_gettime> <== NOT EXECUTED
timeout.tv_sec += 3;
ffc08ab4: 81 21 00 0c lwz r9,12(r1) <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08ab8: 7f 03 c3 78 mr r3,r24 <== NOT EXECUTED
signal. The thread now becomes idle. */
if (rtems_chain_is_empty (&aio_request_queue.idle_req)) {
++aio_request_queue.idle_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
timeout.tv_nsec = 0;
ffc08abc: 92 81 00 10 stw r20,16(r1) <== NOT EXECUTED
/* 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_request_queue.idle_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08ac0: 38 09 00 03 addi r0,r9,3 <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08ac4: 7f e4 fb 78 mr r4,r31 <== NOT EXECUTED
/* 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_request_queue.idle_threads;
clock_gettime (CLOCK_REALTIME, &timeout);
timeout.tv_sec += 3;
ffc08ac8: 90 01 00 0c stw r0,12(r1) <== NOT EXECUTED
timeout.tv_nsec = 0;
result = pthread_cond_timedwait (&aio_request_queue.new_req,
ffc08acc: 7f a5 eb 78 mr r5,r29 <== NOT EXECUTED
ffc08ad0: 48 00 07 e5 bl ffc092b4 <pthread_cond_timedwait> <== NOT EXECUTED
&aio_request_queue.mutex,
&timeout);
/* If no new fd chain was added in the idle requests
then this thread is finished */
if (result == ETIMEDOUT) {
ffc08ad4: 2f 83 00 74 cmpwi cr7,r3,116 <== NOT EXECUTED
ffc08ad8: 40 be 00 10 bne+ cr7,ffc08ae8 <rtems_aio_handle+0x1f4> <== NOT EXECUTED
pthread_mutex_unlock (&aio_request_queue.mutex);
ffc08adc: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08ae0: 48 00 0c c5 bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
return NULL;
ffc08ae4: 48 00 00 6c b ffc08b50 <rtems_aio_handle+0x25c> <== NOT EXECUTED
}
/* Otherwise move this chain to the working chain and
start the loop all over again */
--aio_request_queue.idle_threads;
ffc08ae8: 81 3f 00 68 lwz r9,104(r31) <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08aec: 82 df 00 54 lwz r22,84(r31) <== NOT EXECUTED
return NULL;
}
/* Otherwise move this chain to the working chain and
start the loop all over again */
--aio_request_queue.idle_threads;
ffc08af0: 38 09 ff ff addi r0,r9,-1 <== NOT EXECUTED
ffc08af4: 90 1f 00 68 stw r0,104(r31) <== NOT EXECUTED
ffc08af8: 7e c3 b3 78 mr r3,r22 <== NOT EXECUTED
ffc08afc: 48 00 28 15 bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
node = rtems_chain_first (&aio_request_queue.idle_req);
rtems_chain_extract (node);
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc08b00: 80 96 00 14 lwz r4,20(r22) <== NOT EXECUTED
ffc08b04: 38 a0 00 01 li r5,1 <== NOT EXECUTED
ffc08b08: 7f 23 cb 78 mr r3,r25 <== NOT EXECUTED
ffc08b0c: 4b ff fd 21 bl ffc0882c <rtems_aio_search_fd> <== NOT EXECUTED
((rtems_aio_request_chain *)node)->fildes,
1);
r_chain->new_fd = 0;
pthread_mutex_init (&r_chain->mutex, NULL);
ffc08b10: 38 80 00 00 li r4,0 <== NOT EXECUTED
node = rtems_chain_first (&aio_request_queue.idle_req);
rtems_chain_extract (node);
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
((rtems_aio_request_chain *)node)->fildes,
1);
r_chain->new_fd = 0;
ffc08b14: 92 83 00 18 stw r20,24(r3) <== NOT EXECUTED
/* Otherwise move this chain to the working chain and
start the loop all over again */
--aio_request_queue.idle_threads;
node = rtems_chain_first (&aio_request_queue.idle_req);
rtems_chain_extract (node);
r_chain = rtems_aio_search_fd (&aio_request_queue.work_req,
ffc08b18: 7c 7e 1b 78 mr r30,r3 <== NOT EXECUTED
((rtems_aio_request_chain *)node)->fildes,
1);
r_chain->new_fd = 0;
pthread_mutex_init (&r_chain->mutex, NULL);
ffc08b1c: 38 63 00 1c addi r3,r3,28 <== NOT EXECUTED
ffc08b20: 48 00 0a 81 bl ffc095a0 <pthread_mutex_init> <== NOT EXECUTED
pthread_cond_init (&r_chain->cond, NULL);
ffc08b24: 38 7e 00 20 addi r3,r30,32 <== NOT EXECUTED
ffc08b28: 38 80 00 00 li r4,0 <== NOT EXECUTED
ffc08b2c: 48 00 06 29 bl ffc09154 <pthread_cond_init> <== NOT EXECUTED
r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd;
ffc08b30: 38 76 00 08 addi r3,r22,8 <== NOT EXECUTED
ffc08b34: 39 3e 00 08 addi r9,r30,8 <== NOT EXECUTED
ffc08b38: 7c a3 64 aa lswi r5,r3,12 <== NOT EXECUTED
ffc08b3c: 7c a9 65 aa stswi r5,r9,12 <== NOT EXECUTED
ffc08b40: 4b ff fd ec b ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
}
else
/* 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);
ffc08b44: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08b48: 48 00 0c 5d bl ffc097a4 <pthread_mutex_unlock> <== NOT EXECUTED
ffc08b4c: 4b ff fd e0 b ffc0892c <rtems_aio_handle+0x38> <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08b50: 39 61 00 68 addi r11,r1,104 <== NOT EXECUTED
ffc08b54: 38 60 00 00 li r3,0 <== NOT EXECUTED
ffc08b58: 4b ff 7f b4 b ffc00b0c <_restgpr_20_x> <== NOT EXECUTED
ffc08748 <rtems_aio_init>:
* 0 - if initialization succeeded
*/
int
rtems_aio_init (void)
{
ffc08748: 94 21 ff f0 stwu r1,-16(r1)
ffc0874c: 7c 08 02 a6 mflr r0
ffc08750: bf c1 00 08 stmw r30,8(r1)
int result = 0;
result = pthread_attr_init (&aio_request_queue.attr);
ffc08754: 3f e0 00 00 lis r31,0
ffc08758: 3b ff 2c 10 addi r31,r31,11280
ffc0875c: 7f e3 fb 78 mr r3,r31
* 0 - if initialization succeeded
*/
int
rtems_aio_init (void)
{
ffc08760: 90 01 00 14 stw r0,20(r1)
int result = 0;
result = pthread_attr_init (&aio_request_queue.attr);
ffc08764: 48 00 11 79 bl ffc098dc <pthread_attr_init>
if (result != 0)
ffc08768: 7c 7e 1b 79 mr. r30,r3
ffc0876c: 40 a2 00 b4 bne+ ffc08820 <rtems_aio_init+0xd8> <== NEVER TAKEN
return result;
result =
ffc08770: 7f e3 fb 78 mr r3,r31
ffc08774: 38 80 00 00 li r4,0
ffc08778: 48 00 11 a5 bl ffc0991c <pthread_attr_setdetachstate>
pthread_attr_setdetachstate (&aio_request_queue.attr,
PTHREAD_CREATE_DETACHED);
if (result != 0)
ffc0877c: 2f 83 00 00 cmpwi cr7,r3,0
ffc08780: 41 be 00 0c beq+ cr7,ffc0878c <rtems_aio_init+0x44> <== ALWAYS TAKEN
pthread_attr_destroy (&aio_request_queue.attr);
ffc08784: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08788: 48 00 11 2d bl ffc098b4 <pthread_attr_destroy> <== NOT EXECUTED
result = pthread_mutex_init (&aio_request_queue.mutex, NULL);
ffc0878c: 3f e0 00 00 lis r31,0
ffc08790: 3b ff 2c 08 addi r31,r31,11272
ffc08794: 7f e3 fb 78 mr r3,r31
ffc08798: 38 80 00 00 li r4,0
ffc0879c: 48 00 0e 05 bl ffc095a0 <pthread_mutex_init>
if (result != 0)
ffc087a0: 2f 83 00 00 cmpwi cr7,r3,0
ffc087a4: 41 be 00 0c beq+ cr7,ffc087b0 <rtems_aio_init+0x68> <== ALWAYS TAKEN
pthread_attr_destroy (&aio_request_queue.attr);
ffc087a8: 38 7f 00 08 addi r3,r31,8 <== NOT EXECUTED
ffc087ac: 48 00 11 09 bl ffc098b4 <pthread_attr_destroy> <== NOT EXECUTED
result = pthread_cond_init (&aio_request_queue.new_req, NULL);
ffc087b0: 3f e0 00 00 lis r31,0
ffc087b4: 3b ff 2c 0c addi r31,r31,11276
ffc087b8: 7f e3 fb 78 mr r3,r31
ffc087bc: 38 80 00 00 li r4,0
ffc087c0: 48 00 09 95 bl ffc09154 <pthread_cond_init>
if (result != 0) {
ffc087c4: 7c 7e 1b 79 mr. r30,r3
ffc087c8: 41 a2 00 14 beq+ ffc087dc <rtems_aio_init+0x94> <== ALWAYS TAKEN
pthread_mutex_destroy (&aio_request_queue.mutex);
ffc087cc: 38 7f ff fc addi r3,r31,-4 <== NOT EXECUTED
ffc087d0: 48 00 0c 65 bl ffc09434 <pthread_mutex_destroy> <== NOT EXECUTED
pthread_attr_destroy (&aio_request_queue.attr);
ffc087d4: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED
ffc087d8: 48 00 10 dd bl ffc098b4 <pthread_attr_destroy> <== NOT EXECUTED
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc087dc: 3d 20 00 00 lis r9,0
ffc087e0: 39 29 2c 08 addi r9,r9,11272
ffc087e4: 38 09 00 4c addi r0,r9,76
head->previous = NULL;
tail->previous = head;
ffc087e8: 39 69 00 48 addi r11,r9,72
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc087ec: 90 09 00 48 stw r0,72(r9)
head->previous = NULL;
ffc087f0: 38 00 00 00 li r0,0
tail->previous = head;
ffc087f4: 91 69 00 50 stw r11,80(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc087f8: 39 69 00 58 addi r11,r9,88
head->previous = NULL;
ffc087fc: 90 09 00 4c stw r0,76(r9)
)
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
ffc08800: 91 69 00 54 stw r11,84(r9)
head->previous = NULL;
tail->previous = head;
ffc08804: 39 69 00 54 addi r11,r9,84
{
Chain_Node *head = _Chain_Head( the_chain );
Chain_Node *tail = _Chain_Tail( the_chain );
head->next = tail;
head->previous = NULL;
ffc08808: 90 09 00 58 stw r0,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;
ffc0880c: 90 09 00 64 stw r0,100(r9)
aio_request_queue.idle_threads = 0;
ffc08810: 90 09 00 68 stw r0,104(r9)
aio_request_queue.initialized = AIO_QUEUE_INITIALIZED;
ffc08814: 60 00 b0 0b ori r0,r0,45067
tail->previous = head;
ffc08818: 91 69 00 5c stw r11,92(r9)
ffc0881c: 90 09 00 60 stw r0,96(r9)
return result;
}
ffc08820: 39 61 00 10 addi r11,r1,16
ffc08824: 7f c3 f3 78 mr r3,r30
ffc08828: 4b ff 83 0c b ffc00b34 <_restgpr_30_x>
ffc08b5c <rtems_aio_insert_prio>:
* NONE
*/
void
rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req)
{
ffc08b5c: 94 21 ff f8 stwu r1,-8(r1)
ffc08b60: 7c 08 02 a6 mflr r0
ffc08b64: 7c 8b 23 78 mr r11,r4
ffc08b68: 90 01 00 0c stw r0,12(r1)
ffc08b6c: 38 03 00 04 addi r0,r3,4
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08b70: 81 23 00 00 lwz r9,0(r3)
rtems_chain_node *node;
AIO_printf ("FD exists \n");
node = rtems_chain_first (chain);
if (rtems_chain_is_empty (chain)) {
ffc08b74: 7f 89 00 00 cmpw cr7,r9,r0
ffc08b78: 41 9e 00 3c beq- cr7,ffc08bb4 <rtems_aio_insert_prio+0x58><== NEVER TAKEN
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;
ffc08b7c: 81 49 00 14 lwz r10,20(r9)
while (req->aiocbp->aio_reqprio > prio &&
ffc08b80: 81 04 00 14 lwz r8,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;
ffc08b84: 81 4a 00 18 lwz r10,24(r10)
while (req->aiocbp->aio_reqprio > prio &&
ffc08b88: 81 08 00 18 lwz r8,24(r8)
ffc08b8c: 48 00 00 10 b ffc08b9c <rtems_aio_insert_prio+0x40>
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08b90: 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;
ffc08b94: 81 49 00 14 lwz r10,20(r9) <== NOT EXECUTED
ffc08b98: 81 4a 00 18 lwz r10,24(r10) <== 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 &&
ffc08b9c: 7f 88 50 00 cmpw cr7,r8,r10
ffc08ba0: 40 9d 00 0c ble- cr7,ffc08bac <rtems_aio_insert_prio+0x50><== ALWAYS TAKEN
ffc08ba4: 7f 89 00 00 cmpw cr7,r9,r0
ffc08ba8: 40 9e ff e8 bne+ cr7,ffc08b90 <rtems_aio_insert_prio+0x34><== NOT EXECUTED
RTEMS_INLINE_ROUTINE void rtems_chain_insert(
rtems_chain_node *after_node,
rtems_chain_node *the_node
)
{
_Chain_Insert( after_node, the_node );
ffc08bac: 80 69 00 04 lwz r3,4(r9)
ffc08bb0: 7d 64 5b 78 mr r4,r11
ffc08bb4: 48 00 27 c5 bl ffc0b378 <_Chain_Insert>
}
rtems_chain_insert (node->previous, &req->next_prio);
}
}
ffc08bb8: 80 01 00 0c lwz r0,12(r1)
ffc08bbc: 38 21 00 08 addi r1,r1,8
ffc08bc0: 7c 08 03 a6 mtlr r0
ffc08bc4: 4e 80 00 20 blr
ffc08bc8 <rtems_aio_remove_fd>:
* Output parameters:
* NONE
*/
void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain)
{
ffc08bc8: 94 21 ff e8 stwu r1,-24(r1) <== NOT EXECUTED
ffc08bcc: 7d 80 00 26 mfcr r12 <== NOT EXECUTED
ffc08bd0: 7c 08 02 a6 mflr r0 <== NOT EXECUTED
ffc08bd4: bf a1 00 0c stmw r29,12(r1) <== NOT EXECUTED
while (!rtems_chain_is_tail (chain, node))
{
rtems_chain_extract (node);
rtems_aio_request *req = (rtems_aio_request *) node;
req->aiocbp->error_code = ECANCELED;
ffc08bd8: 3b a0 00 8c li r29,140 <== NOT EXECUTED
req->aiocbp->return_value = -1;
ffc08bdc: 3b c0 ff ff li r30,-1 <== NOT EXECUTED
* Output parameters:
* NONE
*/
void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain)
{
ffc08be0: 90 01 00 1c stw r0,28(r1) <== NOT EXECUTED
ffc08be4: 91 81 00 08 stw r12,8(r1) <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08be8: 83 e3 00 08 lwz r31,8(r3) <== NOT EXECUTED
RTEMS_INLINE_ROUTINE bool _Chain_Is_tail(
Chain_Control *the_chain,
const Chain_Node *the_node
)
{
return (the_node == _Chain_Tail(the_chain));
ffc08bec: 38 63 00 0c addi r3,r3,12 <== NOT EXECUTED
rtems_chain_node *node;
chain = &r_chain->perfd;
node = rtems_chain_first (chain);
while (!rtems_chain_is_tail (chain, node))
ffc08bf0: 7e 1f 18 00 cmpw cr4,r31,r3 <== NOT EXECUTED
ffc08bf4: 48 00 00 20 b ffc08c14 <rtems_aio_remove_fd+0x4c> <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE void rtems_chain_extract(
rtems_chain_node *the_node
)
{
_Chain_Extract( the_node );
ffc08bf8: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08bfc: 48 00 27 15 bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
{
rtems_chain_extract (node);
rtems_aio_request *req = (rtems_aio_request *) node;
req->aiocbp->error_code = ECANCELED;
ffc08c00: 81 3f 00 14 lwz r9,20(r31) <== NOT EXECUTED
req->aiocbp->return_value = -1;
free (req);
ffc08c04: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
while (!rtems_chain_is_tail (chain, node))
{
rtems_chain_extract (node);
rtems_aio_request *req = (rtems_aio_request *) node;
req->aiocbp->error_code = ECANCELED;
ffc08c08: 93 a9 00 34 stw r29,52(r9) <== NOT EXECUTED
req->aiocbp->return_value = -1;
ffc08c0c: 93 c9 00 38 stw r30,56(r9) <== NOT EXECUTED
free (req);
ffc08c10: 4b ff c4 c5 bl ffc050d4 <free> <== NOT EXECUTED
rtems_chain_node *node;
chain = &r_chain->perfd;
node = rtems_chain_first (chain);
while (!rtems_chain_is_tail (chain, node))
ffc08c14: 40 92 ff e4 bne+ cr4,ffc08bf8 <rtems_aio_remove_fd+0x30><== NOT EXECUTED
rtems_aio_request *req = (rtems_aio_request *) node;
req->aiocbp->error_code = ECANCELED;
req->aiocbp->return_value = -1;
free (req);
}
}
ffc08c18: 81 81 00 08 lwz r12,8(r1) <== NOT EXECUTED
ffc08c1c: 39 61 00 18 addi r11,r1,24 <== NOT EXECUTED
ffc08c20: 7d 80 81 20 mtcrf 8,r12 <== NOT EXECUTED
ffc08c24: 4b ff 7f 0c b ffc00b30 <_restgpr_29_x> <== NOT EXECUTED
ffc08c28 <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)
{
ffc08c28: 7c 2b 0b 78 mr r11,r1 <== NOT EXECUTED
ffc08c2c: 7c 08 02 a6 mflr r0 <== NOT EXECUTED
ffc08c30: 94 21 ff f0 stwu r1,-16(r1) <== NOT EXECUTED
ffc08c34: 90 01 00 14 stw r0,20(r1) <== NOT EXECUTED
ffc08c38: 4b ff 7e b5 bl ffc00aec <_savegpr_31> <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08c3c: 83 e3 00 00 lwz r31,0(r3) <== NOT EXECUTED
ffc08c40: 38 63 00 04 addi r3,r3,4 <== 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) {
ffc08c44: 48 00 00 08 b ffc08c4c <rtems_aio_remove_req+0x24> <== NOT EXECUTED
}
AIO_printf ("Thread finished\n");
return NULL;
}
ffc08c48: 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) {
ffc08c4c: 7f 9f 18 00 cmpw cr7,r31,r3 <== NOT EXECUTED
ffc08c50: 41 9e 00 3c beq- cr7,ffc08c8c <rtems_aio_remove_req+0x64><== NOT EXECUTED
ffc08c54: 80 1f 00 14 lwz r0,20(r31) <== NOT EXECUTED
ffc08c58: 7f 80 20 00 cmpw cr7,r0,r4 <== NOT EXECUTED
ffc08c5c: 40 9e ff ec bne+ cr7,ffc08c48 <rtems_aio_remove_req+0x20><== NOT EXECUTED
ffc08c60: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
ffc08c64: 48 00 26 ad bl ffc0b310 <_Chain_Extract> <== NOT EXECUTED
if (rtems_chain_is_tail (chain, node))
return AIO_NOTCANCELED;
else
{
rtems_chain_extract (node);
current->aiocbp->error_code = ECANCELED;
ffc08c68: 81 3f 00 14 lwz r9,20(r31) <== NOT EXECUTED
ffc08c6c: 38 00 00 8c li r0,140 <== NOT EXECUTED
ffc08c70: 90 09 00 34 stw r0,52(r9) <== NOT EXECUTED
current->aiocbp->return_value = -1;
ffc08c74: 38 00 ff ff li r0,-1 <== NOT EXECUTED
free (current);
ffc08c78: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED
return AIO_NOTCANCELED;
else
{
rtems_chain_extract (node);
current->aiocbp->error_code = ECANCELED;
current->aiocbp->return_value = -1;
ffc08c7c: 90 09 00 38 stw r0,56(r9) <== NOT EXECUTED
free (current);
ffc08c80: 4b ff c4 55 bl ffc050d4 <free> <== NOT EXECUTED
}
return AIO_CANCELED;
ffc08c84: 38 60 00 00 li r3,0 <== NOT EXECUTED
ffc08c88: 48 00 00 08 b ffc08c90 <rtems_aio_remove_req+0x68> <== NOT EXECUTED
node = rtems_chain_next (node);
current = (rtems_aio_request *) node;
}
if (rtems_chain_is_tail (chain, node))
return AIO_NOTCANCELED;
ffc08c8c: 38 60 00 01 li r3,1 <== NOT EXECUTED
current->aiocbp->return_value = -1;
free (current);
}
return AIO_CANCELED;
}
ffc08c90: 39 61 00 10 addi r11,r1,16 <== NOT EXECUTED
ffc08c94: 4b ff 7e a4 b ffc00b38 <_restgpr_31_x> <== NOT EXECUTED
ffc087a8 <rtems_chain_append_with_notification>:
rtems_chain_control *chain,
rtems_chain_node *node,
rtems_id task,
rtems_event_set events
)
{
ffc087a8: 94 21 ff f0 stwu r1,-16(r1)
ffc087ac: 7c 08 02 a6 mflr r0
ffc087b0: bf c1 00 08 stmw r30,8(r1)
ffc087b4: 7c bf 2b 78 mr r31,r5
ffc087b8: 7c de 33 78 mr r30,r6
ffc087bc: 90 01 00 14 stw r0,20(r1)
RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check(
rtems_chain_control *chain,
rtems_chain_node *node
)
{
return _Chain_Append_with_empty_check( chain, node );
ffc087c0: 48 00 06 45 bl ffc08e04 <_Chain_Append_with_empty_check>
rtems_status_code sc = RTEMS_SUCCESSFUL;
bool was_empty = rtems_chain_append_with_empty_check( chain, node );
if ( was_empty ) {
ffc087c4: 2f 83 00 00 cmpwi cr7,r3,0
rtems_chain_node *node,
rtems_id task,
rtems_event_set events
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
ffc087c8: 38 00 00 00 li r0,0
bool was_empty = rtems_chain_append_with_empty_check( chain, node );
if ( was_empty ) {
ffc087cc: 41 be 00 14 beq+ cr7,ffc087e0 <rtems_chain_append_with_notification+0x38><== NEVER TAKEN
sc = rtems_event_send( task, events );
ffc087d0: 7f e3 fb 78 mr r3,r31
ffc087d4: 7f c4 f3 78 mr r4,r30
ffc087d8: 4b ff f4 dd bl ffc07cb4 <rtems_event_send>
ffc087dc: 7c 60 1b 78 mr r0,r3
}
return sc;
}
ffc087e0: 39 61 00 10 addi r11,r1,16
ffc087e4: 7c 03 03 78 mr r3,r0
ffc087e8: 48 00 d3 18 b ffc15b00 <_restgpr_30_x>
ffc08834 <rtems_chain_get_with_wait>:
rtems_chain_control *chain,
rtems_event_set events,
rtems_interval timeout,
rtems_chain_node **node_ptr
)
{
ffc08834: 94 21 ff d0 stwu r1,-48(r1)
ffc08838: 7c 08 02 a6 mflr r0
ffc0883c: bf 41 00 18 stmw r26,24(r1)
ffc08840: 7c 7a 1b 78 mr r26,r3
ffc08844: 7c 9b 23 78 mr r27,r4
ffc08848: 90 01 00 34 stw r0,52(r1)
ffc0884c: 7c bc 2b 78 mr r28,r5
ffc08850: 7c df 33 78 mr r31,r6
while (
sc == RTEMS_SUCCESSFUL
&& (node = rtems_chain_get( chain )) == NULL
) {
rtems_event_set out;
sc = rtems_event_receive(
ffc08854: 3b a1 00 08 addi r29,r1,8
ffc08858: 48 00 00 20 b ffc08878 <rtems_chain_get_with_wait+0x44>
ffc0885c: 7f 63 db 78 mr r3,r27
ffc08860: 38 80 00 00 li r4,0
ffc08864: 7f 85 e3 78 mr r5,r28
ffc08868: 7f a6 eb 78 mr r6,r29
ffc0886c: 4b ff f2 b1 bl ffc07b1c <rtems_event_receive>
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
rtems_chain_node *node = NULL;
while (
ffc08870: 2c 03 00 00 cmpwi r3,0
ffc08874: 40 82 00 18 bne- ffc0888c <rtems_chain_get_with_wait+0x58><== ALWAYS TAKEN
*/
RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get(
rtems_chain_control *the_chain
)
{
return _Chain_Get( the_chain );
ffc08878: 7f 43 d3 78 mr r3,r26
ffc0887c: 48 00 06 79 bl ffc08ef4 <_Chain_Get>
sc == RTEMS_SUCCESSFUL
&& (node = rtems_chain_get( chain )) == NULL
ffc08880: 7c 7e 1b 79 mr. r30,r3
ffc08884: 41 82 ff d8 beq+ ffc0885c <rtems_chain_get_with_wait+0x28>
ffc08888: 38 60 00 00 li r3,0
}
*node_ptr = node;
return sc;
}
ffc0888c: 39 61 00 30 addi r11,r1,48
timeout,
&out
);
}
*node_ptr = node;
ffc08890: 93 df 00 00 stw r30,0(r31)
return sc;
}
ffc08894: 48 00 d2 5c b ffc15af0 <_restgpr_26_x>
ffc08898 <rtems_chain_prepend_with_notification>:
rtems_chain_control *chain,
rtems_chain_node *node,
rtems_id task,
rtems_event_set events
)
{
ffc08898: 94 21 ff f0 stwu r1,-16(r1)
ffc0889c: 7c 08 02 a6 mflr r0
ffc088a0: bf c1 00 08 stmw r30,8(r1)
ffc088a4: 7c bf 2b 78 mr r31,r5
ffc088a8: 7c de 33 78 mr r30,r6
ffc088ac: 90 01 00 14 stw r0,20(r1)
RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check(
rtems_chain_control *chain,
rtems_chain_node *node
)
{
return _Chain_Prepend_with_empty_check( chain, node );
ffc088b0: 48 00 06 b1 bl ffc08f60 <_Chain_Prepend_with_empty_check>
rtems_status_code sc = RTEMS_SUCCESSFUL;
bool was_empty = rtems_chain_prepend_with_empty_check( chain, node );
if (was_empty) {
ffc088b4: 2f 83 00 00 cmpwi cr7,r3,0
rtems_chain_node *node,
rtems_id task,
rtems_event_set events
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
ffc088b8: 38 00 00 00 li r0,0
bool was_empty = rtems_chain_prepend_with_empty_check( chain, node );
if (was_empty) {
ffc088bc: 41 be 00 14 beq+ cr7,ffc088d0 <rtems_chain_prepend_with_notification+0x38><== NEVER TAKEN
sc = rtems_event_send( task, events );
ffc088c0: 7f e3 fb 78 mr r3,r31
ffc088c4: 7f c4 f3 78 mr r4,r30
ffc088c8: 4b ff f3 ed bl ffc07cb4 <rtems_event_send>
ffc088cc: 7c 60 1b 78 mr r0,r3
}
return sc;
}
ffc088d0: 39 61 00 10 addi r11,r1,16
ffc088d4: 7c 03 03 78 mr r3,r0
ffc088d8: 48 00 d2 28 b ffc15b00 <_restgpr_30_x>
ffc09388 <rtems_io_register_driver>:
rtems_status_code rtems_io_register_driver(
rtems_device_major_number major,
const rtems_driver_address_table *driver_table,
rtems_device_major_number *registered_major
)
{
ffc09388: 7c 08 02 a6 mflr r0
ffc0938c: 7c 2b 0b 78 mr r11,r1
ffc09390: 94 21 ff f0 stwu r1,-16(r1)
rtems_device_major_number major_limit = _IO_Number_of_drivers;
ffc09394: 3d 20 00 00 lis r9,0
rtems_status_code rtems_io_register_driver(
rtems_device_major_number major,
const rtems_driver_address_table *driver_table,
rtems_device_major_number *registered_major
)
{
ffc09398: 90 01 00 14 stw r0,20(r1)
ffc0939c: 48 00 fe 81 bl ffc1921c <_savegpr_31>
ffc093a0: 7c 7f 1b 78 mr r31,r3
rtems_device_major_number major_limit = _IO_Number_of_drivers;
ffc093a4: 80 09 27 e0 lwz r0,10208(r9)
if ( rtems_interrupt_is_in_progress() )
ffc093a8: 3d 20 00 00 lis r9,0
ffc093ac: 81 29 31 8c lwz r9,12684(r9)
return RTEMS_CALLED_FROM_ISR;
ffc093b0: 38 60 00 12 li r3,18
rtems_device_major_number *registered_major
)
{
rtems_device_major_number major_limit = _IO_Number_of_drivers;
if ( rtems_interrupt_is_in_progress() )
ffc093b4: 2f 89 00 00 cmpwi cr7,r9,0
ffc093b8: 40 9e 01 14 bne- cr7,ffc094cc <rtems_io_register_driver+0x144>
return RTEMS_CALLED_FROM_ISR;
if ( registered_major == NULL )
ffc093bc: 2f 85 00 00 cmpwi cr7,r5,0
return RTEMS_INVALID_ADDRESS;
ffc093c0: 38 60 00 09 li r3,9
rtems_device_major_number major_limit = _IO_Number_of_drivers;
if ( rtems_interrupt_is_in_progress() )
return RTEMS_CALLED_FROM_ISR;
if ( registered_major == NULL )
ffc093c4: 41 9e 01 08 beq- cr7,ffc094cc <rtems_io_register_driver+0x144>
return RTEMS_INVALID_ADDRESS;
/* Set it to an invalid value */
*registered_major = major_limit;
if ( driver_table == NULL )
ffc093c8: 2f 84 00 00 cmpwi cr7,r4,0
if ( registered_major == NULL )
return RTEMS_INVALID_ADDRESS;
/* Set it to an invalid value */
*registered_major = major_limit;
ffc093cc: 90 05 00 00 stw r0,0(r5)
if ( driver_table == NULL )
ffc093d0: 41 9e 00 fc beq- cr7,ffc094cc <rtems_io_register_driver+0x144>
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
ffc093d4: 81 24 00 00 lwz r9,0(r4)
ffc093d8: 2f 89 00 00 cmpwi cr7,r9,0
ffc093dc: 40 be 00 f8 bne+ cr7,ffc094d4 <rtems_io_register_driver+0x14c>
ffc093e0: 81 24 00 04 lwz r9,4(r4)
ffc093e4: 2f 89 00 00 cmpwi cr7,r9,0
ffc093e8: 40 be 00 ec bne+ cr7,ffc094d4 <rtems_io_register_driver+0x14c>
ffc093ec: 48 00 00 e0 b ffc094cc <rtems_io_register_driver+0x144>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc093f0: 3d 20 00 00 lis r9,0
ffc093f4: 81 69 27 88 lwz r11,10120(r9)
ffc093f8: 38 0b 00 01 addi r0,r11,1
ffc093fc: 90 09 27 88 stw r0,10120(r9)
if ( major >= major_limit )
return RTEMS_INVALID_NUMBER;
_Thread_Disable_dispatch();
if ( major == 0 ) {
ffc09400: 2f 9f 00 00 cmpwi cr7,r31,0
ffc09404: 3d 20 00 00 lis r9,0
ffc09408: 40 9e 00 58 bne- cr7,ffc09460 <rtems_io_register_driver+0xd8>
static rtems_status_code rtems_io_obtain_major_number(
rtems_device_major_number *major
)
{
rtems_device_major_number n = _IO_Number_of_drivers;
ffc0940c: 3d 60 00 00 lis r11,0
ffc09410: 81 29 27 e4 lwz r9,10212(r9)
ffc09414: 81 6b 27 e0 lwz r11,10208(r11)
ffc09418: 2f 8b 00 00 cmpwi cr7,r11,0
ffc0941c: 38 0b 00 01 addi r0,r11,1
ffc09420: 40 be 00 28 bne+ cr7,ffc09448 <rtems_io_register_driver+0xc0><== ALWAYS TAKEN
ffc09424: 38 00 00 01 li r0,1 <== NOT EXECUTED
ffc09428: 48 00 00 20 b ffc09448 <rtems_io_register_driver+0xc0><== NOT EXECUTED
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
ffc0942c: 81 49 00 00 lwz r10,0(r9)
ffc09430: 2f 8a 00 00 cmpwi cr7,r10,0
ffc09434: 40 be 00 b0 bne+ cr7,ffc094e4 <rtems_io_register_driver+0x15c>
ffc09438: 81 49 00 04 lwz r10,4(r9)
ffc0943c: 2f 8a 00 00 cmpwi cr7,r10,0
ffc09440: 40 be 00 a4 bne+ cr7,ffc094e4 <rtems_io_register_driver+0x15c>
ffc09444: 48 00 00 0c b ffc09450 <rtems_io_register_driver+0xc8>
rtems_device_major_number n = _IO_Number_of_drivers;
rtems_device_major_number m = 0;
/* major is error checked by caller */
for ( m = 0; m < n; ++m ) {
ffc09448: 34 00 ff ff addic. r0,r0,-1
ffc0944c: 40 82 ff e0 bne+ ffc0942c <rtems_io_register_driver+0xa4>
}
/* Assigns invalid value in case of failure */
*major = m;
if ( m != n )
ffc09450: 7f 9f 58 00 cmpw cr7,r31,r11
if ( rtems_io_is_empty_table( table ) )
break;
}
/* Assigns invalid value in case of failure */
*major = m;
ffc09454: 93 e5 00 00 stw r31,0(r5)
if ( m != n )
ffc09458: 40 be 00 48 bne+ cr7,ffc094a0 <rtems_io_register_driver+0x118>
ffc0945c: 48 00 00 94 b ffc094f0 <rtems_io_register_driver+0x168>
_Thread_Enable_dispatch();
return sc;
}
major = *registered_major;
} else {
rtems_driver_address_table *const table = _IO_Driver_address_table + major;
ffc09460: 1c 1f 00 18 mulli r0,r31,24
ffc09464: 81 29 27 e4 lwz r9,10212(r9)
ffc09468: 7d 69 02 14 add r11,r9,r0
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
ffc0946c: 7d 29 00 2e lwzx r9,r9,r0
ffc09470: 38 00 00 00 li r0,0
ffc09474: 2f 89 00 00 cmpwi cr7,r9,0
ffc09478: 40 be 00 10 bne+ cr7,ffc09488 <rtems_io_register_driver+0x100>
return RTEMS_SUCCESSFUL;
return RTEMS_TOO_MANY;
}
rtems_status_code rtems_io_register_driver(
ffc0947c: 80 0b 00 04 lwz r0,4(r11)
ffc09480: 7c 00 00 34 cntlzw r0,r0
ffc09484: 54 00 d9 7e rlwinm r0,r0,27,5,31
}
major = *registered_major;
} else {
rtems_driver_address_table *const table = _IO_Driver_address_table + major;
if ( !rtems_io_is_empty_table( table ) ) {
ffc09488: 2f 80 00 00 cmpwi cr7,r0,0
ffc0948c: 40 9e 00 10 bne- cr7,ffc0949c <rtems_io_register_driver+0x114>
_Thread_Enable_dispatch();
ffc09490: 48 00 20 31 bl ffc0b4c0 <_Thread_Enable_dispatch>
return RTEMS_RESOURCE_IN_USE;
ffc09494: 38 60 00 0c li r3,12
ffc09498: 48 00 00 34 b ffc094cc <rtems_io_register_driver+0x144>
}
*registered_major = major;
ffc0949c: 93 e5 00 00 stw r31,0(r5)
}
_IO_Driver_address_table [major] = *driver_table;
ffc094a0: 3d 20 00 00 lis r9,0
ffc094a4: 81 69 27 e4 lwz r11,10212(r9)
ffc094a8: 1c 1f 00 18 mulli r0,r31,24
ffc094ac: 7d 6b 02 14 add r11,r11,r0
ffc094b0: 7c a4 c4 aa lswi r5,r4,24
ffc094b4: 7c ab c5 aa stswi r5,r11,24
_Thread_Enable_dispatch();
ffc094b8: 48 00 20 09 bl ffc0b4c0 <_Thread_Enable_dispatch>
return rtems_io_initialize( major, 0, NULL );
ffc094bc: 7f e3 fb 78 mr r3,r31
ffc094c0: 38 80 00 00 li r4,0
ffc094c4: 38 a0 00 00 li r5,0
ffc094c8: 48 00 88 31 bl ffc11cf8 <rtems_io_initialize>
}
ffc094cc: 39 61 00 10 addi r11,r1,16
ffc094d0: 48 00 fd 98 b ffc19268 <_restgpr_31_x>
return RTEMS_INVALID_ADDRESS;
if ( rtems_io_is_empty_table( driver_table ) )
return RTEMS_INVALID_ADDRESS;
if ( major >= major_limit )
ffc094d4: 7f 9f 00 40 cmplw cr7,r31,r0
return RTEMS_INVALID_NUMBER;
ffc094d8: 38 60 00 0a li r3,10
return RTEMS_INVALID_ADDRESS;
if ( rtems_io_is_empty_table( driver_table ) )
return RTEMS_INVALID_ADDRESS;
if ( major >= major_limit )
ffc094dc: 41 9c ff 14 blt+ cr7,ffc093f0 <rtems_io_register_driver+0x68>
ffc094e0: 4b ff ff ec b ffc094cc <rtems_io_register_driver+0x144>
rtems_device_major_number n = _IO_Number_of_drivers;
rtems_device_major_number m = 0;
/* major is error checked by caller */
for ( m = 0; m < n; ++m ) {
ffc094e4: 3b ff 00 01 addi r31,r31,1
ffc094e8: 39 29 00 18 addi r9,r9,24
ffc094ec: 4b ff ff 5c b ffc09448 <rtems_io_register_driver+0xc0>
if ( major == 0 ) {
rtems_status_code sc = rtems_io_obtain_major_number( registered_major );
if ( sc != RTEMS_SUCCESSFUL ) {
_Thread_Enable_dispatch();
ffc094f0: 48 00 1f d1 bl ffc0b4c0 <_Thread_Enable_dispatch>
*major = m;
if ( m != n )
return RTEMS_SUCCESSFUL;
return RTEMS_TOO_MANY;
ffc094f4: 38 60 00 05 li r3,5
if ( major == 0 ) {
rtems_status_code sc = rtems_io_obtain_major_number( registered_major );
if ( sc != RTEMS_SUCCESSFUL ) {
_Thread_Enable_dispatch();
return sc;
ffc094f8: 4b ff ff d4 b ffc094cc <rtems_io_register_driver+0x144>
ffc0ad74 <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)
{
ffc0ad74: 94 21 ff e0 stwu r1,-32(r1)
ffc0ad78: 7c 08 02 a6 mflr r0
ffc0ad7c: bf 61 00 0c stmw r27,12(r1)
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
ffc0ad80: 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)
{
ffc0ad84: 90 01 00 24 stw r0,36(r1)
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
ffc0ad88: 41 82 00 5c beq- ffc0ade4 <rtems_iterate_over_all_threads+0x70><== NEVER TAKEN
ffc0ad8c: 3f e0 00 01 lis r31,1
ffc0ad90: 3b ff aa 00 addi r31,r31,-22016
#endif
#include <rtems/system.h>
#include <rtems/score/thread.h>
void rtems_iterate_over_all_threads(rtems_per_thread_routine routine)
ffc0ad94: 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 ];
ffc0ad98: 85 3f 00 04 lwzu r9,4(r31)
if ( !information )
ffc0ad9c: 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 ];
ffc0ada0: 83 a9 00 04 lwz r29,4(r9)
if ( !information )
ffc0ada4: 2f 9d 00 00 cmpwi cr7,r29,0
ffc0ada8: 40 be 00 28 bne+ cr7,ffc0add0 <rtems_iterate_over_all_threads+0x5c>
ffc0adac: 48 00 00 30 b ffc0addc <rtems_iterate_over_all_threads+0x68>
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
the_thread = (Thread_Control *)information->local_table[ i ];
ffc0adb0: 81 3d 00 1c lwz r9,28(r29)
ffc0adb4: 57 c0 10 3a rlwinm r0,r30,2,0,29
ffc0adb8: 7c 69 00 2e lwzx r3,r9,r0
if ( !the_thread )
ffc0adbc: 2f 83 00 00 cmpwi cr7,r3,0
ffc0adc0: 41 9e 00 0c beq- cr7,ffc0adcc <rtems_iterate_over_all_threads+0x58>
continue;
(*routine)(the_thread);
ffc0adc4: 7f 69 03 a6 mtctr r27
ffc0adc8: 4e 80 04 21 bctrl
information = _Objects_Information_table[ api_index ][ 1 ];
if ( !information )
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
ffc0adcc: 3b de 00 01 addi r30,r30,1
ffc0add0: a0 1d 00 10 lhz r0,16(r29)
ffc0add4: 7f 9e 00 40 cmplw cr7,r30,r0
ffc0add8: 40 9d ff d8 ble+ cr7,ffc0adb0 <rtems_iterate_over_all_threads+0x3c>
Objects_Information *information;
if ( !routine )
return;
for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) {
ffc0addc: 7f 9f e0 00 cmpw cr7,r31,r28
ffc0ade0: 40 9e ff b8 bne+ cr7,ffc0ad98 <rtems_iterate_over_all_threads+0x24>
(*routine)(the_thread);
}
}
}
ffc0ade4: 39 61 00 20 addi r11,r1,32
ffc0ade8: 4b ff 65 58 b ffc01340 <_restgpr_27_x>
ffc1664c <rtems_partition_create>:
uint32_t length,
uint32_t buffer_size,
rtems_attribute attribute_set,
rtems_id *id
)
{
ffc1664c: 94 21 ff d0 stwu r1,-48(r1)
ffc16650: 7c 08 02 a6 mflr r0
ffc16654: bf 21 00 14 stmw r25,20(r1)
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
ffc16658: 7c 7b 1b 79 mr. r27,r3
uint32_t length,
uint32_t buffer_size,
rtems_attribute attribute_set,
rtems_id *id
)
{
ffc1665c: 7c bf 2b 78 mr r31,r5
ffc16660: 90 01 00 34 stw r0,52(r1)
ffc16664: 7c fa 3b 78 mr r26,r7
ffc16668: 7d 1d 43 78 mr r29,r8
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
return RTEMS_INVALID_NAME;
ffc1666c: 38 00 00 03 li r0,3
rtems_id *id
)
{
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
ffc16670: 41 82 00 cc beq- ffc1673c <rtems_partition_create+0xf0>
return RTEMS_INVALID_NAME;
if ( !starting_address )
ffc16674: 2f 84 00 00 cmpwi cr7,r4,0
return RTEMS_INVALID_ADDRESS;
ffc16678: 38 00 00 09 li r0,9
register Partition_Control *the_partition;
if ( !rtems_is_name_valid( name ) )
return RTEMS_INVALID_NAME;
if ( !starting_address )
ffc1667c: 41 9e 00 c0 beq- cr7,ffc1673c <rtems_partition_create+0xf0>
return RTEMS_INVALID_ADDRESS;
if ( !id )
ffc16680: 2f 88 00 00 cmpwi cr7,r8,0
ffc16684: 41 9e 00 b8 beq- cr7,ffc1673c <rtems_partition_create+0xf0><== NEVER TAKEN
return RTEMS_INVALID_ADDRESS;
if ( length == 0 || buffer_size == 0 || length < buffer_size ||
ffc16688: 2f 85 00 00 cmpwi cr7,r5,0
!_Partition_Is_buffer_size_aligned( buffer_size ) )
return RTEMS_INVALID_SIZE;
ffc1668c: 38 00 00 08 li r0,8
return RTEMS_INVALID_ADDRESS;
if ( !id )
return RTEMS_INVALID_ADDRESS;
if ( length == 0 || buffer_size == 0 || length < buffer_size ||
ffc16690: 41 9e 00 ac beq- cr7,ffc1673c <rtems_partition_create+0xf0>
ffc16694: 2f 86 00 00 cmpwi cr7,r6,0
ffc16698: 41 9e 00 a4 beq- cr7,ffc1673c <rtems_partition_create+0xf0>
ffc1669c: 7f 85 30 40 cmplw cr7,r5,r6
ffc166a0: 41 9c 00 9c blt- cr7,ffc1673c <rtems_partition_create+0xf0>
ffc166a4: 70 c9 00 07 andi. r9,r6,7
ffc166a8: 40 82 00 94 bne- ffc1673c <rtems_partition_create+0xf0>
!_Partition_Is_buffer_size_aligned( buffer_size ) )
return RTEMS_INVALID_SIZE;
if ( !_Addresses_Is_aligned( starting_address ) )
ffc166ac: 70 99 00 07 andi. r25,r4,7
return RTEMS_INVALID_ADDRESS;
ffc166b0: 38 00 00 09 li r0,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 ) )
ffc166b4: 40 a2 00 88 bne+ ffc1673c <rtems_partition_create+0xf0>
ffc166b8: 3d 20 00 00 lis r9,0
ffc166bc: 81 69 28 84 lwz r11,10372(r9)
ffc166c0: 38 0b 00 01 addi r0,r11,1
ffc166c4: 90 09 28 84 stw r0,10372(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 );
ffc166c8: 3f 80 00 00 lis r28,0
ffc166cc: 90 81 00 08 stw r4,8(r1)
ffc166d0: 3b 9c 6e c0 addi r28,r28,28352
ffc166d4: 7f 83 e3 78 mr r3,r28
ffc166d8: 90 c1 00 0c stw r6,12(r1)
ffc166dc: 48 00 4e d1 bl ffc1b5ac <_Objects_Allocate>
_Thread_Disable_dispatch(); /* prevents deletion */
the_partition = _Partition_Allocate();
if ( !the_partition ) {
ffc166e0: 7c 7e 1b 79 mr. r30,r3
ffc166e4: 80 81 00 08 lwz r4,8(r1)
ffc166e8: 80 c1 00 0c lwz r6,12(r1)
ffc166ec: 40 a2 00 10 bne+ ffc166fc <rtems_partition_create+0xb0>
_Thread_Enable_dispatch();
ffc166f0: 48 00 61 11 bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_TOO_MANY;
ffc166f4: 38 00 00 05 li r0,5
ffc166f8: 48 00 00 44 b ffc1673c <rtems_partition_create+0xf0>
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,
ffc166fc: 7c bf 33 96 divwu r5,r31,r6
_Thread_Enable_dispatch();
return RTEMS_TOO_MANY;
}
#endif
the_partition->starting_address = starting_address;
ffc16700: 90 9e 00 10 stw r4,16(r30)
the_partition->length = length;
the_partition->buffer_size = buffer_size;
ffc16704: 90 de 00 18 stw r6,24(r30)
return RTEMS_TOO_MANY;
}
#endif
the_partition->starting_address = starting_address;
the_partition->length = length;
ffc16708: 93 fe 00 14 stw r31,20(r30)
the_partition->buffer_size = buffer_size;
the_partition->attribute_set = attribute_set;
ffc1670c: 93 5e 00 1c stw r26,28(r30)
the_partition->number_of_used_blocks = 0;
ffc16710: 93 3e 00 20 stw r25,32(r30)
_Chain_Initialize( &the_partition->Memory, starting_address,
ffc16714: 38 7e 00 24 addi r3,r30,36
ffc16718: 48 00 35 7d bl ffc19c94 <_Chain_Initialize>
Objects_Name name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc1671c: 80 1e 00 08 lwz r0,8(r30)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc16720: 81 7c 00 1c lwz r11,28(r28)
ffc16724: 54 09 13 ba rlwinm r9,r0,2,14,29
ffc16728: 7f cb 49 2e stwx r30,r11,r9
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
ffc1672c: 93 7e 00 0c stw r27,12(r30)
&_Partition_Information,
&the_partition->Object,
(Objects_Name) name
);
*id = the_partition->Object.id;
ffc16730: 90 1d 00 00 stw r0,0(r29)
name,
0 /* Not used */
);
#endif
_Thread_Enable_dispatch();
ffc16734: 48 00 60 cd bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc16738: 38 00 00 00 li r0,0
}
ffc1673c: 39 61 00 30 addi r11,r1,48
ffc16740: 7c 03 03 78 mr r3,r0
ffc16744: 4b ff 7b 60 b ffc0e2a4 <_restgpr_25_x>
ffc16894 <rtems_partition_return_buffer>:
rtems_status_code rtems_partition_return_buffer(
rtems_id id,
void *buffer
)
{
ffc16894: 94 21 ff e0 stwu r1,-32(r1)
ffc16898: 7c 08 02 a6 mflr r0
ffc1689c: 90 01 00 24 stw r0,36(r1)
ffc168a0: 7c 60 1b 78 mr r0,r3
Objects_Id id,
Objects_Locations *location
)
{
return (Partition_Control *)
_Objects_Get( &_Partition_Information, id, location );
ffc168a4: 3c 60 00 00 lis r3,0
ffc168a8: bf c1 00 18 stmw r30,24(r1)
ffc168ac: 38 63 6e c0 addi r3,r3,28352
ffc168b0: 7c 9f 23 78 mr r31,r4
ffc168b4: 38 a1 00 08 addi r5,r1,8
ffc168b8: 7c 04 03 78 mr r4,r0
ffc168bc: 48 00 52 4d bl ffc1bb08 <_Objects_Get>
register Partition_Control *the_partition;
Objects_Locations location;
the_partition = _Partition_Get( id, &location );
switch ( location ) {
ffc168c0: 80 01 00 08 lwz r0,8(r1)
ffc168c4: 7c 7e 1b 78 mr r30,r3
ffc168c8: 2f 80 00 00 cmpwi cr7,r0,0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc168cc: 38 60 00 04 li r3,4
{
register Partition_Control *the_partition;
Objects_Locations location;
the_partition = _Partition_Get( id, &location );
switch ( location ) {
ffc168d0: 40 9e 00 58 bne- cr7,ffc16928 <rtems_partition_return_buffer+0x94>
)
{
void *starting;
void *ending;
starting = the_partition->starting_address;
ffc168d4: 80 1e 00 10 lwz r0,16(r30)
ending = _Addresses_Add_offset( starting, the_partition->length );
ffc168d8: 81 3e 00 14 lwz r9,20(r30)
const void *address,
const void *base,
const void *limit
)
{
return (address >= base && address <= limit);
ffc168dc: 7f 9f 00 40 cmplw cr7,r31,r0
ffc168e0: 41 9c 00 50 blt- cr7,ffc16930 <rtems_partition_return_buffer+0x9c>
RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset (
const void *base,
uintptr_t offset
)
{
return (void *)((uintptr_t)base + offset);
ffc168e4: 7d 20 4a 14 add r9,r0,r9
const void *address,
const void *base,
const void *limit
)
{
return (address >= base && address <= limit);
ffc168e8: 7f 9f 48 40 cmplw cr7,r31,r9
ffc168ec: 41 9d 00 44 bgt- cr7,ffc16930 <rtems_partition_return_buffer+0x9c><== NEVER TAKEN
offset = (uint32_t) _Addresses_Subtract(
the_buffer,
the_partition->starting_address
);
return ((offset % the_partition->buffer_size) == 0);
ffc168f0: 81 3e 00 18 lwz r9,24(r30)
RTEMS_INLINE_ROUTINE int32_t _Addresses_Subtract (
const void *left,
const void *right
)
{
return (int32_t) ((const char *) left - (const char *) right);
ffc168f4: 7c 00 f8 50 subf r0,r0,r31
ffc168f8: 7d 60 4b 96 divwu r11,r0,r9
ffc168fc: 7d 2b 49 d6 mullw r9,r11,r9
starting = the_partition->starting_address;
ending = _Addresses_Add_offset( starting, the_partition->length );
return (
_Addresses_Is_in_range( the_buffer, starting, ending ) &&
ffc16900: 7f 80 48 00 cmpw cr7,r0,r9
ffc16904: 40 9e 00 2c bne- cr7,ffc16930 <rtems_partition_return_buffer+0x9c>
RTEMS_INLINE_ROUTINE void _Partition_Free_buffer (
Partition_Control *the_partition,
Chain_Node *the_buffer
)
{
_Chain_Append( &the_partition->Memory, the_buffer );
ffc16908: 38 7e 00 24 addi r3,r30,36
ffc1690c: 7f e4 fb 78 mr r4,r31
ffc16910: 48 00 32 ed bl ffc19bfc <_Chain_Append>
case OBJECTS_LOCAL:
if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) {
_Partition_Free_buffer( the_partition, buffer );
the_partition->number_of_used_blocks -= 1;
ffc16914: 81 3e 00 20 lwz r9,32(r30)
ffc16918: 38 09 ff ff addi r0,r9,-1
ffc1691c: 90 1e 00 20 stw r0,32(r30)
_Thread_Enable_dispatch();
ffc16920: 48 00 5e e1 bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc16924: 38 60 00 00 li r3,0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
ffc16928: 39 61 00 20 addi r11,r1,32
ffc1692c: 4b ff 79 8c b ffc0e2b8 <_restgpr_30_x>
_Partition_Free_buffer( the_partition, buffer );
the_partition->number_of_used_blocks -= 1;
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
_Thread_Enable_dispatch();
ffc16930: 48 00 5e d1 bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_INVALID_ADDRESS;
ffc16934: 38 60 00 09 li r3,9
ffc16938: 4b ff ff f0 b ffc16928 <rtems_partition_return_buffer+0x94>
ffc08d98 <rtems_rate_monotonic_period>:
rtems_status_code rtems_rate_monotonic_period(
rtems_id id,
rtems_interval length
)
{
ffc08d98: 94 21 ff d8 stwu r1,-40(r1)
ffc08d9c: 7c 08 02 a6 mflr r0
ffc08da0: bf 81 00 18 stmw r28,24(r1)
ffc08da4: 7c 7e 1b 78 mr r30,r3
Objects_Id id,
Objects_Locations *location
)
{
return (Rate_monotonic_Control *)
_Objects_Get( &_Rate_monotonic_Information, id, location );
ffc08da8: 3c 60 00 00 lis r3,0
ffc08dac: 7c 9f 23 78 mr r31,r4
ffc08db0: 90 01 00 2c stw r0,44(r1)
ffc08db4: 38 63 2c 38 addi r3,r3,11320
ffc08db8: 7f c4 f3 78 mr r4,r30
ffc08dbc: 38 a1 00 08 addi r5,r1,8
ffc08dc0: 48 00 26 31 bl ffc0b3f0 <_Objects_Get>
rtems_rate_monotonic_period_states local_state;
ISR_Level level;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
ffc08dc4: 80 01 00 08 lwz r0,8(r1)
ffc08dc8: 7c 7d 1b 78 mr r29,r3
ffc08dcc: 2f 80 00 00 cmpwi cr7,r0,0
ffc08dd0: 40 9e 01 70 bne- cr7,ffc08f40 <rtems_rate_monotonic_period+0x1a8>
case OBJECTS_LOCAL:
if ( !_Thread_Is_executing( the_period->owner ) ) {
ffc08dd4: 3d 60 00 00 lis r11,0
ffc08dd8: 81 23 00 40 lwz r9,64(r3)
ffc08ddc: 80 0b 32 10 lwz r0,12816(r11)
ffc08de0: 7f 89 00 00 cmpw cr7,r9,r0
ffc08de4: 41 9e 00 10 beq- cr7,ffc08df4 <rtems_rate_monotonic_period+0x5c>
_Thread_Enable_dispatch();
ffc08de8: 48 00 33 01 bl ffc0c0e8 <_Thread_Enable_dispatch>
return RTEMS_NOT_OWNER_OF_RESOURCE;
ffc08dec: 3b c0 00 17 li r30,23
ffc08df0: 48 00 01 54 b ffc08f44 <rtems_rate_monotonic_period+0x1ac>
}
if ( length == RTEMS_PERIOD_STATUS ) {
ffc08df4: 2f 9f 00 00 cmpwi cr7,r31,0
ffc08df8: 40 9e 00 2c bne- cr7,ffc08e24 <rtems_rate_monotonic_period+0x8c>
switch ( the_period->state ) {
ffc08dfc: 80 03 00 38 lwz r0,56(r3)
ffc08e00: 3b c0 00 00 li r30,0
ffc08e04: 2b 80 00 04 cmplwi cr7,r0,4
ffc08e08: 41 9d 00 14 bgt- cr7,ffc08e1c <rtems_rate_monotonic_period+0x84><== NEVER TAKEN
ffc08e0c: 3d 20 ff c2 lis r9,-62
ffc08e10: 54 00 10 3a rlwinm r0,r0,2,0,29
ffc08e14: 39 29 ee 00 addi r9,r9,-4608
ffc08e18: 7f c9 00 2e lwzx r30,r9,r0
case RATE_MONOTONIC_ACTIVE:
default: /* unreached -- only to remove warnings */
return_value = RTEMS_SUCCESSFUL;
break;
}
_Thread_Enable_dispatch();
ffc08e1c: 48 00 32 cd bl ffc0c0e8 <_Thread_Enable_dispatch>
return( return_value );
ffc08e20: 48 00 01 24 b ffc08f44 <rtems_rate_monotonic_period+0x1ac>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc08e24: 7f 80 00 a6 mfmsr r28
ffc08e28: 7c 10 42 a6 mfsprg r0,0
ffc08e2c: 7f 80 00 78 andc r0,r28,r0
ffc08e30: 7c 00 01 24 mtmsr r0
}
_ISR_Disable( level );
if ( the_period->state == RATE_MONOTONIC_INACTIVE ) {
ffc08e34: 80 03 00 38 lwz r0,56(r3)
ffc08e38: 2f 80 00 00 cmpwi cr7,r0,0
ffc08e3c: 40 be 00 4c bne+ cr7,ffc08e88 <rtems_rate_monotonic_period+0xf0>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc08e40: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
/*
* Baseline statistics information for the beginning of a period.
*/
_Rate_monotonic_Initiate_statistics( the_period );
ffc08e44: 4b ff fd cd bl ffc08c10 <_Rate_monotonic_Initiate_statistics>
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc08e48: 38 00 00 02 li r0,2
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
ffc08e4c: 3d 20 ff c1 lis r9,-63
ffc08e50: 90 1d 00 38 stw r0,56(r29)
ffc08e54: 39 29 92 4c addi r9,r9,-28084
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc08e58: 38 00 00 00 li r0,0
the_watchdog->routine = routine;
ffc08e5c: 91 3d 00 2c stw r9,44(r29)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc08e60: 3c 60 00 00 lis r3,0
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc08e64: 90 1d 00 18 stw r0,24(r29)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc08e68: 38 63 2e 28 addi r3,r3,11816
ffc08e6c: 38 9d 00 10 addi r4,r29,16
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
ffc08e70: 93 dd 00 30 stw r30,48(r29)
the_watchdog->user_data = user_data;
ffc08e74: 90 1d 00 34 stw r0,52(r29)
_Rate_monotonic_Timeout,
id,
NULL
);
the_period->next_length = length;
ffc08e78: 93 fd 00 3c stw r31,60(r29)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc08e7c: 93 fd 00 1c stw r31,28(r29)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc08e80: 48 00 44 89 bl ffc0d308 <_Watchdog_Insert>
ffc08e84: 48 00 00 70 b ffc08ef4 <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 ) {
ffc08e88: 2f 80 00 02 cmpwi cr7,r0,2
ffc08e8c: 40 be 00 74 bne+ cr7,ffc08f00 <rtems_rate_monotonic_period+0x168>
/*
* Update statistics from the concluding period.
*/
_Rate_monotonic_Update_statistics( the_period );
ffc08e90: 4b ff fe 01 bl ffc08c90 <_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;
ffc08e94: 38 00 00 01 li r0,1
ffc08e98: 90 1d 00 38 stw r0,56(r29)
the_period->next_length = length;
ffc08e9c: 93 fd 00 3c stw r31,60(r29)
ffc08ea0: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
_Thread_Executing->Wait.id = the_period->Object.id;
ffc08ea4: 3d 20 00 00 lis r9,0
ffc08ea8: 80 1d 00 08 lwz r0,8(r29)
ffc08eac: 80 69 32 10 lwz r3,12816(r9)
_Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc08eb0: 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;
ffc08eb4: 90 03 00 20 stw r0,32(r3)
_Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc08eb8: 48 00 3b c1 bl ffc0ca78 <_Thread_Set_state>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc08ebc: 7d 20 00 a6 mfmsr r9
ffc08ec0: 7c 10 42 a6 mfsprg r0,0
ffc08ec4: 7d 20 00 78 andc r0,r9,r0
ffc08ec8: 7c 00 01 24 mtmsr r0
* 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;
ffc08ecc: 39 60 00 02 li r11,2
/*
* Did the watchdog timer expire while we were actually blocking
* on it?
*/
_ISR_Disable( level );
local_state = the_period->state;
ffc08ed0: 80 1d 00 38 lwz r0,56(r29)
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc08ed4: 91 7d 00 38 stw r11,56(r29)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc08ed8: 7d 20 01 24 mtmsr r9
/*
* 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 )
ffc08edc: 2f 80 00 03 cmpwi cr7,r0,3
ffc08ee0: 40 be 00 14 bne+ cr7,ffc08ef4 <rtems_rate_monotonic_period+0x15c><== ALWAYS TAKEN
_Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
ffc08ee4: 3d 20 00 00 lis r9,0 <== NOT EXECUTED
ffc08ee8: 80 69 32 10 lwz r3,12816(r9) <== NOT EXECUTED
ffc08eec: 38 80 40 00 li r4,16384 <== NOT EXECUTED
ffc08ef0: 48 00 2e 1d bl ffc0bd0c <_Thread_Clear_state> <== NOT EXECUTED
_Thread_Enable_dispatch();
ffc08ef4: 48 00 31 f5 bl ffc0c0e8 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc08ef8: 3b c0 00 00 li r30,0
ffc08efc: 48 00 00 48 b ffc08f44 <rtems_rate_monotonic_period+0x1ac>
}
if ( the_period->state == RATE_MONOTONIC_EXPIRED ) {
ffc08f00: 2f 80 00 04 cmpwi cr7,r0,4
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc08f04: 3b c0 00 04 li r30,4
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
if ( the_period->state == RATE_MONOTONIC_EXPIRED ) {
ffc08f08: 40 be 00 3c bne+ cr7,ffc08f44 <rtems_rate_monotonic_period+0x1ac><== NEVER TAKEN
/*
* Update statistics from the concluding period
*/
_Rate_monotonic_Update_statistics( the_period );
ffc08f0c: 4b ff fd 85 bl ffc08c90 <_Rate_monotonic_Update_statistics>
ffc08f10: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc08f14: 38 00 00 02 li r0,2
the_period->next_length = length;
ffc08f18: 93 fd 00 3c stw r31,60(r29)
ffc08f1c: 3c 60 00 00 lis r3,0
*/
_Rate_monotonic_Update_statistics( the_period );
_ISR_Enable( level );
the_period->state = RATE_MONOTONIC_ACTIVE;
ffc08f20: 90 1d 00 38 stw r0,56(r29)
ffc08f24: 38 63 2e 28 addi r3,r3,11816
ffc08f28: 38 9d 00 10 addi r4,r29,16
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc08f2c: 93 fd 00 1c stw r31,28(r29)
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
return RTEMS_TIMEOUT;
ffc08f30: 3b c0 00 06 li r30,6
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc08f34: 48 00 43 d5 bl ffc0d308 <_Watchdog_Insert>
the_period->state = RATE_MONOTONIC_ACTIVE;
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
ffc08f38: 48 00 31 b1 bl ffc0c0e8 <_Thread_Enable_dispatch>
return RTEMS_TIMEOUT;
ffc08f3c: 48 00 00 08 b ffc08f44 <rtems_rate_monotonic_period+0x1ac>
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc08f40: 3b c0 00 04 li r30,4
}
ffc08f44: 39 61 00 28 addi r11,r1,40
ffc08f48: 7f c3 f3 78 mr r3,r30
ffc08f4c: 4b ff 82 74 b ffc011c0 <_restgpr_28_x>
ffc08f50 <rtems_rate_monotonic_report_statistics_with_plugin>:
*/
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
ffc08f50: 94 21 ff 58 stwu r1,-168(r1)
ffc08f54: 7c 08 02 a6 mflr r0
ffc08f58: 90 01 00 ac stw r0,172(r1)
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
ffc08f5c: 7c 80 23 79 mr. r0,r4
*/
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
ffc08f60: be 41 00 70 stmw r18,112(r1)
ffc08f64: 7c 7f 1b 78 mr r31,r3
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
ffc08f68: 90 01 00 68 stw r0,104(r1)
ffc08f6c: 41 82 01 fc beq- ffc09168 <rtems_rate_monotonic_report_statistics_with_plugin+0x218><== NEVER TAKEN
return;
(*print)( context, "Period information by period\n" );
ffc08f70: 3c 80 ff c2 lis r4,-62
ffc08f74: 7c 09 03 a6 mtctr r0
ffc08f78: 38 84 ee 14 addi r4,r4,-4588
/*
* 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 ;
ffc08f7c: 3e 60 00 00 lis r19,0
rtems_object_get_name( the_status.owner, sizeof(name), name );
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc08f80: 3e c0 ff c2 lis r22,-62
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,
ffc08f84: 3f 00 ff c2 lis r24,-62
char name[5];
if ( !print )
return;
(*print)( context, "Period information by period\n" );
ffc08f88: 4c c6 31 82 crclr 4*cr1+eq
ffc08f8c: 4e 80 04 21 bctrl
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
(*print)( context, "--- CPU times are in seconds ---\n" );
ffc08f90: 80 01 00 68 lwz r0,104(r1)
ffc08f94: 3c 80 ff c2 lis r4,-62
ffc08f98: 7c 09 03 a6 mtctr r0
ffc08f9c: 38 84 ee 32 addi r4,r4,-4558
ffc08fa0: 7f e3 fb 78 mr r3,r31
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,
ffc08fa4: 3f 40 ff c2 lis r26,-62
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
(*print)( context, "\n" );
ffc08fa8: 3e 40 ff c2 lis r18,-62
* 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++ ) {
status = rtems_rate_monotonic_get_statistics( id, &the_stats );
ffc08fac: 3a 81 00 30 addi r20,r1,48
if ( !print )
return;
(*print)( context, "Period information by period\n" );
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
(*print)( context, "--- CPU times are in seconds ---\n" );
ffc08fb0: 4c c6 31 82 crclr 4*cr1+eq
ffc08fb4: 4e 80 04 21 bctrl
(*print)( context, "--- Wall times are in seconds ---\n" );
ffc08fb8: 80 01 00 68 lwz r0,104(r1)
ffc08fbc: 3c 80 ff c2 lis r4,-62
ffc08fc0: 7c 09 03 a6 mtctr r0
ffc08fc4: 38 84 ee 54 addi r4,r4,-4524
ffc08fc8: 7f e3 fb 78 mr r3,r31
#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 );
ffc08fcc: 3a a1 00 18 addi r21,r1,24
#endif
rtems_object_get_name( the_status.owner, sizeof(name), name );
ffc08fd0: 3b 61 00 08 addi r27,r1,8
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc08fd4: 3a d6 ef 0e addi r22,r22,-4338
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" );
ffc08fd8: 4c c6 31 82 crclr 4*cr1+eq
ffc08fdc: 4e 80 04 21 bctrl
Be sure to test the various cases.
(*print)( context,"\
1234567890123456789012345678901234567890123456789012345678901234567890123456789\
\n");
*/
(*print)( context, " ID OWNER COUNT MISSED "
ffc08fe0: 80 01 00 68 lwz r0,104(r1)
ffc08fe4: 3c 80 ff c2 lis r4,-62
ffc08fe8: 7c 09 03 a6 mtctr r0
ffc08fec: 38 84 ee 77 addi r4,r4,-4489
ffc08ff0: 7f e3 fb 78 mr r3,r31
{
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
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;
ffc08ff4: 3a e1 00 48 addi r23,r1,72
_Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average );
ffc08ff8: 3b 81 00 10 addi r28,r1,16
(*print)( context,
ffc08ffc: 3b 18 ef 25 addi r24,r24,-4315
Be sure to test the various cases.
(*print)( context,"\
1234567890123456789012345678901234567890123456789012345678901234567890123456789\
\n");
*/
(*print)( context, " ID OWNER COUNT MISSED "
ffc09000: 4c c6 31 82 crclr 4*cr1+eq
ffc09004: 4e 80 04 21 bctrl
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
" "
#endif
" WALL TIME\n"
);
(*print)( context, " "
ffc09008: 80 01 00 68 lwz r0,104(r1)
ffc0900c: 3c 80 ff c2 lis r4,-62
ffc09010: 7f e3 fb 78 mr r3,r31
ffc09014: 7c 09 03 a6 mtctr r0
ffc09018: 38 84 ee c2 addi r4,r4,-4414
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,
ffc0901c: 3b c0 03 e8 li r30,1000
{
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
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;
ffc09020: 3b 21 00 60 addi r25,r1,96
_Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average);
(*print)( context,
ffc09024: 3b 5a ef 44 addi r26,r26,-4284
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
" "
#endif
" WALL TIME\n"
);
(*print)( context, " "
ffc09028: 4c c6 31 82 crclr 4*cr1+eq
ffc0902c: 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 ;
ffc09030: 39 33 2c 38 addi r9,r19,11320
ffc09034: 83 a9 00 08 lwz r29,8(r9)
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
(*print)( context, "\n" );
ffc09038: 3a 52 ed b2 addi r18,r18,-4686
/*
* 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 ;
ffc0903c: 48 00 01 1c b ffc09158 <rtems_rate_monotonic_report_statistics_with_plugin+0x208>
id <= _Rate_monotonic_Information.maximum_id ;
id++ ) {
status = rtems_rate_monotonic_get_statistics( id, &the_stats );
ffc09040: 7f a3 eb 78 mr r3,r29
ffc09044: 7e 84 a3 78 mr r4,r20
ffc09048: 48 00 68 f9 bl ffc0f940 <rtems_rate_monotonic_get_statistics>
if ( status != RTEMS_SUCCESSFUL )
ffc0904c: 2f 83 00 00 cmpwi cr7,r3,0
ffc09050: 40 be 01 04 bne+ cr7,ffc09154 <rtems_rate_monotonic_report_statistics_with_plugin+0x204>
#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 );
ffc09054: 7e a4 ab 78 mr r4,r21
ffc09058: 7f a3 eb 78 mr r3,r29
ffc0905c: 48 00 69 b1 bl ffc0fa0c <rtems_rate_monotonic_get_status>
#endif
rtems_object_get_name( the_status.owner, sizeof(name), name );
ffc09060: 80 61 00 18 lwz r3,24(r1)
ffc09064: 38 80 00 05 li r4,5
ffc09068: 7f 65 db 78 mr r5,r27
ffc0906c: 48 00 02 a1 bl ffc0930c <rtems_object_get_name>
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
ffc09070: 80 01 00 68 lwz r0,104(r1)
ffc09074: 7e c4 b3 78 mr r4,r22
ffc09078: 80 e1 00 30 lwz r7,48(r1)
ffc0907c: 7f e3 fb 78 mr r3,r31
ffc09080: 81 01 00 34 lwz r8,52(r1)
ffc09084: 7f a5 eb 78 mr r5,r29
ffc09088: 7c 09 03 a6 mtctr r0
ffc0908c: 7f 66 db 78 mr r6,r27
ffc09090: 4c c6 31 82 crclr 4*cr1+eq
ffc09094: 4e 80 04 21 bctrl
);
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
ffc09098: 80 81 00 30 lwz r4,48(r1)
ffc0909c: 2f 84 00 00 cmpwi cr7,r4,0
ffc090a0: 40 9e 00 20 bne- cr7,ffc090c0 <rtems_rate_monotonic_report_statistics_with_plugin+0x170>
(*print)( context, "\n" );
ffc090a4: 80 01 00 68 lwz r0,104(r1)
ffc090a8: 7f e3 fb 78 mr r3,r31
ffc090ac: 7e 44 93 78 mr r4,r18
ffc090b0: 7c 09 03 a6 mtctr r0
ffc090b4: 4c c6 31 82 crclr 4*cr1+eq
ffc090b8: 4e 80 04 21 bctrl
continue;
ffc090bc: 48 00 00 98 b ffc09154 <rtems_rate_monotonic_report_statistics_with_plugin+0x204>
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 );
ffc090c0: 7e e3 bb 78 mr r3,r23
ffc090c4: 7f 85 e3 78 mr r5,r28
ffc090c8: 48 00 3d b9 bl ffc0ce80 <_Timespec_Divide_by_integer>
(*print)( context,
ffc090cc: 80 01 00 68 lwz r0,104(r1)
ffc090d0: 80 c1 00 3c lwz r6,60(r1)
ffc090d4: 7f 04 c3 78 mr r4,r24
ffc090d8: 81 01 00 44 lwz r8,68(r1)
ffc090dc: 7c 09 03 a6 mtctr r0
ffc090e0: 81 41 00 14 lwz r10,20(r1)
ffc090e4: 7c c6 f3 d6 divw r6,r6,r30
ffc090e8: 80 e1 00 40 lwz r7,64(r1)
ffc090ec: 81 21 00 10 lwz r9,16(r1)
ffc090f0: 80 a1 00 38 lwz r5,56(r1)
ffc090f4: 7d 08 f3 d6 divw r8,r8,r30
ffc090f8: 7d 4a f3 d6 divw r10,r10,r30
ffc090fc: 7f e3 fb 78 mr r3,r31
ffc09100: 4c c6 31 82 crclr 4*cr1+eq
ffc09104: 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);
ffc09108: 80 81 00 30 lwz r4,48(r1)
ffc0910c: 7f 23 cb 78 mr r3,r25
ffc09110: 7f 85 e3 78 mr r5,r28
ffc09114: 48 00 3d 6d bl ffc0ce80 <_Timespec_Divide_by_integer>
(*print)( context,
ffc09118: 80 c1 00 54 lwz r6,84(r1)
ffc0911c: 81 01 00 5c lwz r8,92(r1)
ffc09120: 7f e3 fb 78 mr r3,r31
ffc09124: 81 41 00 14 lwz r10,20(r1)
ffc09128: 7f 44 d3 78 mr r4,r26
ffc0912c: 80 01 00 68 lwz r0,104(r1)
ffc09130: 7c c6 f3 d6 divw r6,r6,r30
ffc09134: 80 a1 00 50 lwz r5,80(r1)
ffc09138: 80 e1 00 58 lwz r7,88(r1)
ffc0913c: 7c 09 03 a6 mtctr r0
ffc09140: 81 21 00 10 lwz r9,16(r1)
ffc09144: 7d 08 f3 d6 divw r8,r8,r30
ffc09148: 7d 4a f3 d6 divw r10,r10,r30
ffc0914c: 4c c6 31 82 crclr 4*cr1+eq
ffc09150: 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++ ) {
ffc09154: 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 ;
ffc09158: 39 33 2c 38 addi r9,r19,11320
/*
* 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 ;
ffc0915c: 80 09 00 0c lwz r0,12(r9)
ffc09160: 7f 9d 00 40 cmplw cr7,r29,r0
ffc09164: 40 9d fe dc ble+ cr7,ffc09040 <rtems_rate_monotonic_report_statistics_with_plugin+0xf0>
the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall
);
#endif
}
}
}
ffc09168: 39 61 00 a8 addi r11,r1,168
ffc0916c: 4b ff 80 2c b ffc01198 <_restgpr_18_x>
ffc17d7c <rtems_signal_send>:
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
ffc17d7c: 7c 2b 0b 78 mr r11,r1
ffc17d80: 94 21 ff e0 stwu r1,-32(r1)
ffc17d84: 7c 08 02 a6 mflr r0
ffc17d88: 48 01 96 51 bl ffc313d8 <_savegpr_31>
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
ffc17d8c: 7c 9f 23 79 mr. r31,r4
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
ffc17d90: 90 01 00 24 stw r0,36(r1)
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
return RTEMS_INVALID_NUMBER;
ffc17d94: 38 00 00 0a li r0,10
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
ffc17d98: 41 82 00 bc beq- ffc17e54 <rtems_signal_send+0xd8>
return RTEMS_INVALID_NUMBER;
the_thread = _Thread_Get( id, &location );
ffc17d9c: 38 81 00 08 addi r4,r1,8
ffc17da0: 48 00 4a 81 bl ffc1c820 <_Thread_Get>
switch ( location ) {
ffc17da4: 80 01 00 08 lwz r0,8(r1)
ffc17da8: 2f 80 00 00 cmpwi cr7,r0,0
ffc17dac: 40 9e 00 a4 bne- cr7,ffc17e50 <rtems_signal_send+0xd4>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
ffc17db0: 81 23 01 30 lwz r9,304(r3)
asr = &api->Signal;
if ( ! _ASR_Is_null_handler( asr->handler ) ) {
ffc17db4: 80 09 00 0c lwz r0,12(r9)
ffc17db8: 2f 80 00 00 cmpwi cr7,r0,0
ffc17dbc: 41 9e 00 88 beq- cr7,ffc17e44 <rtems_signal_send+0xc8>
if ( asr->is_enabled ) {
ffc17dc0: 88 09 00 08 lbz r0,8(r9)
ffc17dc4: 2f 80 00 00 cmpwi cr7,r0,0
ffc17dc8: 41 9e 00 50 beq- cr7,ffc17e18 <rtems_signal_send+0x9c>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc17dcc: 7c 00 00 a6 mfmsr r0
ffc17dd0: 7d 70 42 a6 mfsprg r11,0
ffc17dd4: 7c 0b 58 78 andc r11,r0,r11
ffc17dd8: 7d 60 01 24 mtmsr r11
)
{
ISR_Level _level;
_ISR_Disable( _level );
*signal_set |= signals;
ffc17ddc: 81 69 00 14 lwz r11,20(r9)
ffc17de0: 7d 7f fb 78 or r31,r11,r31
ffc17de4: 93 e9 00 14 stw r31,20(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc17de8: 7c 00 01 24 mtmsr r0
_ASR_Post_signals( signal_set, &asr->signals_posted );
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
ffc17dec: 3d 20 00 00 lis r9,0
ffc17df0: 39 29 75 04 addi r9,r9,29956
ffc17df4: 80 09 00 08 lwz r0,8(r9)
ffc17df8: 2f 80 00 00 cmpwi cr7,r0,0
ffc17dfc: 41 9e 00 3c beq- cr7,ffc17e38 <rtems_signal_send+0xbc>
ffc17e00: 80 09 00 0c lwz r0,12(r9)
ffc17e04: 7f 83 00 00 cmpw cr7,r3,r0
ffc17e08: 40 be 00 30 bne+ cr7,ffc17e38 <rtems_signal_send+0xbc> <== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc17e0c: 38 00 00 01 li r0,1
ffc17e10: 98 09 00 18 stb r0,24(r9)
ffc17e14: 48 00 00 24 b ffc17e38 <rtems_signal_send+0xbc>
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc17e18: 7c 00 00 a6 mfmsr r0
ffc17e1c: 7d 70 42 a6 mfsprg r11,0
ffc17e20: 7c 0b 58 78 andc r11,r0,r11
ffc17e24: 7d 60 01 24 mtmsr r11
ffc17e28: 81 69 00 18 lwz r11,24(r9)
ffc17e2c: 7d 7f fb 78 or r31,r11,r31
ffc17e30: 93 e9 00 18 stw r31,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc17e34: 7c 00 01 24 mtmsr r0
} else {
_ASR_Post_signals( signal_set, &asr->signals_pending );
}
_Thread_Enable_dispatch();
ffc17e38: 48 00 49 c9 bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc17e3c: 38 00 00 00 li r0,0
ffc17e40: 48 00 00 14 b ffc17e54 <rtems_signal_send+0xd8>
}
_Thread_Enable_dispatch();
ffc17e44: 48 00 49 bd bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_NOT_DEFINED;
ffc17e48: 38 00 00 0b li r0,11
ffc17e4c: 48 00 00 08 b ffc17e54 <rtems_signal_send+0xd8>
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc17e50: 38 00 00 04 li r0,4
}
ffc17e54: 39 61 00 20 addi r11,r1,32
ffc17e58: 7c 03 03 78 mr r3,r0
ffc17e5c: 4b ff 64 60 b ffc0e2bc <_restgpr_31_x>
ffc117fc <rtems_task_mode>:
ASR_Information *asr;
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
ffc117fc: 2c 05 00 00 cmpwi r5,0
rtems_status_code rtems_task_mode(
rtems_mode mode_set,
rtems_mode mask,
rtems_mode *previous_mode_set
)
{
ffc11800: 7c 08 02 a6 mflr r0
ffc11804: 94 21 ff f8 stwu r1,-8(r1)
ffc11808: 90 01 00 0c stw r0,12(r1)
ffc1180c: 7c 60 1b 78 mr r0,r3
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
ffc11810: 38 60 00 09 li r3,9
ASR_Information *asr;
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
ffc11814: 41 82 01 8c beq- ffc119a0 <rtems_task_mode+0x1a4>
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
ffc11818: 3d 20 00 00 lis r9,0
ffc1181c: 81 69 31 90 lwz r11,12688(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 )
ffc11820: 81 0b 00 7c lwz r8,124(r11)
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
ffc11824: 89 4b 00 74 lbz r10,116(r11)
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
ffc11828: 2f 88 00 00 cmpwi cr7,r8,0
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
ffc1182c: 81 2b 01 30 lwz r9,304(r11)
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
ffc11830: 7d 4a 00 34 cntlzw r10,r10
ffc11834: 55 4a d9 7e rlwinm r10,r10,27,5,31
ffc11838: 55 4a 40 2e rlwinm r10,r10,8,0,23
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
ffc1183c: 41 9e 00 08 beq- cr7,ffc11844 <rtems_task_mode+0x48>
old_mode |= RTEMS_NO_TIMESLICE;
else
old_mode |= RTEMS_TIMESLICE;
ffc11840: 61 4a 02 00 ori r10,r10,512
old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR;
ffc11844: 89 09 00 08 lbz r8,8(r9)
ffc11848: 7d 08 00 34 cntlzw r8,r8
ffc1184c: 55 08 d9 7e rlwinm r8,r8,27,5,31
ffc11850: 55 08 50 2a rlwinm r8,r8,10,0,21
ffc11854: 7d 08 53 78 or r8,r8,r10
#ifndef ASM
static inline uint32_t _CPU_ISR_Get_level( void )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc11858: 39 40 00 00 li r10,0
ffc1185c: 7d 40 00 a6 mfmsr r10
if (msr & MSR_EE) return 0;
ffc11860: 71 47 80 00 andi. r7,r10,32768
ffc11864: 7c e0 00 26 mfcr r7
ffc11868: 54 e7 1f fe rlwinm r7,r7,3,31,31
old_mode |= _ISR_Get_level();
ffc1186c: 7d 0a 3b 78 or r10,r8,r7
*previous_mode_set = old_mode;
ffc11870: 91 45 00 00 stw r10,0(r5)
/*
* These are generic thread scheduling characteristics.
*/
if ( mask & RTEMS_PREEMPT_MASK )
ffc11874: 70 8a 01 00 andi. r10,r4,256
ffc11878: 41 82 00 14 beq- ffc1188c <rtems_task_mode+0x90>
executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false;
ffc1187c: 70 07 01 00 andi. r7,r0,256
ffc11880: 7d 40 00 26 mfcr r10
ffc11884: 55 4a 1f fe rlwinm r10,r10,3,31,31
ffc11888: 99 4b 00 74 stb r10,116(r11)
if ( mask & RTEMS_TIMESLICE_MASK ) {
ffc1188c: 70 8a 02 00 andi. r10,r4,512
ffc11890: 41 82 00 28 beq- ffc118b8 <rtems_task_mode+0xbc>
if ( _Modes_Is_timeslice(mode_set) ) {
ffc11894: 70 0a 02 00 andi. r10,r0,512
ffc11898: 41 82 00 1c beq- ffc118b4 <rtems_task_mode+0xb8>
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
ffc1189c: 39 40 00 01 li r10,1
ffc118a0: 91 4b 00 7c stw r10,124(r11)
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
ffc118a4: 3d 40 00 00 lis r10,0
ffc118a8: 81 4a 27 84 lwz r10,10116(r10)
ffc118ac: 91 4b 00 78 stw r10,120(r11)
ffc118b0: 48 00 00 08 b ffc118b8 <rtems_task_mode+0xbc>
} else
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
ffc118b4: 91 4b 00 7c stw r10,124(r11)
}
/*
* Set the new interrupt level
*/
if ( mask & RTEMS_INTERRUPT_MASK )
ffc118b8: 70 8b 00 01 andi. r11,r4,1
ffc118bc: 41 82 00 2c beq- ffc118e8 <rtems_task_mode+0xec>
}
static inline void _CPU_ISR_Set_level( uint32_t level )
{
register unsigned int msr;
_CPU_MSR_GET(msr);
ffc118c0: 39 60 00 00 li r11,0
ffc118c4: 7d 60 00 a6 mfmsr r11
if (!(level & CPU_MODES_INTERRUPT_MASK)) {
ffc118c8: 70 07 00 01 andi. r7,r0,1
ffc118cc: 40 82 00 10 bne- ffc118dc <rtems_task_mode+0xe0>
static inline uint32_t ppc_interrupt_get_disable_mask( void )
{
uint32_t mask;
asm volatile (
ffc118d0: 7d 50 42 a6 mfsprg r10,0
msr |= ppc_interrupt_get_disable_mask();
ffc118d4: 7d 4b 5b 78 or r11,r10,r11
ffc118d8: 48 00 00 0c b ffc118e4 <rtems_task_mode+0xe8>
ffc118dc: 7d 50 42 a6 mfsprg r10,0
}
else {
msr &= ~ppc_interrupt_get_disable_mask();
ffc118e0: 7d 6b 50 78 andc r11,r11,r10
}
_CPU_MSR_SET(msr);
ffc118e4: 7d 60 01 24 mtmsr r11
* This is specific to the RTEMS API
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
ffc118e8: 70 8a 04 00 andi. r10,r4,1024
/*
* This is specific to the RTEMS API
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
ffc118ec: 39 60 00 00 li r11,0
if ( mask & RTEMS_ASR_MASK ) {
ffc118f0: 41 82 00 58 beq- ffc11948 <rtems_task_mode+0x14c>
* Output:
* *previous_mode_set - previous mode set
* always return RTEMS_SUCCESSFUL;
*/
rtems_status_code rtems_task_mode(
ffc118f4: 70 07 04 00 andi. r7,r0,1024
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true;
if ( is_asr_enabled != asr->is_enabled ) {
ffc118f8: 89 49 00 08 lbz r10,8(r9)
* Output:
* *previous_mode_set - previous mode set
* always return RTEMS_SUCCESSFUL;
*/
rtems_status_code rtems_task_mode(
ffc118fc: 7c 00 00 26 mfcr r0
ffc11900: 54 00 1f fe rlwinm r0,r0,3,31,31
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true;
if ( is_asr_enabled != asr->is_enabled ) {
ffc11904: 7f 8a 00 00 cmpw cr7,r10,r0
ffc11908: 41 9e 00 40 beq- cr7,ffc11948 <rtems_task_mode+0x14c>
asr->is_enabled = is_asr_enabled;
ffc1190c: 98 09 00 08 stb r0,8(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc11910: 7c 00 00 a6 mfmsr r0
ffc11914: 7d 70 42 a6 mfsprg r11,0
ffc11918: 7c 0b 58 78 andc r11,r0,r11
ffc1191c: 7d 60 01 24 mtmsr r11
{
rtems_signal_set _signals;
ISR_Level _level;
_ISR_Disable( _level );
_signals = information->signals_pending;
ffc11920: 81 69 00 18 lwz r11,24(r9)
information->signals_pending = information->signals_posted;
ffc11924: 81 49 00 14 lwz r10,20(r9)
information->signals_posted = _signals;
ffc11928: 91 69 00 14 stw r11,20(r9)
rtems_signal_set _signals;
ISR_Level _level;
_ISR_Disable( _level );
_signals = information->signals_pending;
information->signals_pending = information->signals_posted;
ffc1192c: 91 49 00 18 stw r10,24(r9)
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc11930: 7c 00 01 24 mtmsr r0
_ASR_Swap_signals( asr );
if ( _ASR_Are_signals_pending( asr ) ) {
ffc11934: 80 09 00 14 lwz r0,20(r9)
needs_asr_dispatching = true;
ffc11938: 39 60 00 01 li r11,1
if ( mask & RTEMS_ASR_MASK ) {
is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true;
if ( is_asr_enabled != asr->is_enabled ) {
asr->is_enabled = is_asr_enabled;
_ASR_Swap_signals( asr );
if ( _ASR_Are_signals_pending( asr ) ) {
ffc1193c: 2f 80 00 00 cmpwi cr7,r0,0
ffc11940: 40 9e 00 08 bne- cr7,ffc11948 <rtems_task_mode+0x14c>
/*
* This is specific to the RTEMS API
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
ffc11944: 39 60 00 00 li r11,0
needs_asr_dispatching = true;
}
}
}
if ( _System_state_Is_up( _System_state_Get() ) ) {
ffc11948: 3d 20 00 00 lis r9,0
ffc1194c: 80 09 27 cc lwz r0,10188(r9)
if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) )
_Thread_Dispatch();
}
return RTEMS_SUCCESSFUL;
ffc11950: 38 60 00 00 li r3,0
needs_asr_dispatching = true;
}
}
}
if ( _System_state_Is_up( _System_state_Get() ) ) {
ffc11954: 2f 80 00 03 cmpwi cr7,r0,3
ffc11958: 40 be 00 48 bne+ cr7,ffc119a0 <rtems_task_mode+0x1a4> <== NEVER TAKEN
{
Thread_Control *executing;
executing = _Thread_Executing;
if ( are_signals_pending ||
ffc1195c: 2f 8b 00 00 cmpwi cr7,r11,0
bool are_signals_pending
)
{
Thread_Control *executing;
executing = _Thread_Executing;
ffc11960: 3d 40 00 00 lis r10,0
ffc11964: 39 4a 31 84 addi r10,r10,12676
ffc11968: 81 2a 00 0c lwz r9,12(r10)
if ( are_signals_pending ||
ffc1196c: 40 9e 00 1c bne- cr7,ffc11988 <rtems_task_mode+0x18c>
ffc11970: 80 0a 00 10 lwz r0,16(r10)
ffc11974: 7f 89 00 00 cmpw cr7,r9,r0
ffc11978: 41 9e 00 28 beq- cr7,ffc119a0 <rtems_task_mode+0x1a4>
(!_Thread_Is_heir( executing ) && executing->is_preemptible) ) {
ffc1197c: 88 09 00 74 lbz r0,116(r9)
ffc11980: 2f 80 00 00 cmpwi cr7,r0,0
ffc11984: 41 9e 00 1c beq- cr7,ffc119a0 <rtems_task_mode+0x1a4> <== NEVER TAKEN
_Thread_Dispatch_necessary = true;
ffc11988: 3d 20 00 00 lis r9,0
ffc1198c: 38 00 00 01 li r0,1
ffc11990: 39 29 31 84 addi r9,r9,12676
ffc11994: 98 09 00 18 stb r0,24(r9)
if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) )
_Thread_Dispatch();
ffc11998: 4b ff 99 d1 bl ffc0b368 <_Thread_Dispatch>
}
return RTEMS_SUCCESSFUL;
ffc1199c: 38 60 00 00 li r3,0
}
ffc119a0: 80 01 00 0c lwz r0,12(r1)
ffc119a4: 38 21 00 08 addi r1,r1,8
ffc119a8: 7c 08 03 a6 mtlr r0
ffc119ac: 4e 80 00 20 blr
ffc0c670 <rtems_task_set_priority>:
rtems_status_code rtems_task_set_priority(
rtems_id id,
rtems_task_priority new_priority,
rtems_task_priority *old_priority
)
{
ffc0c670: 94 21 ff e0 stwu r1,-32(r1)
ffc0c674: 7c 08 02 a6 mflr r0
ffc0c678: bf c1 00 18 stmw r30,24(r1)
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0c67c: 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
)
{
ffc0c680: 7c be 2b 78 mr r30,r5
ffc0c684: 90 01 00 24 stw r0,36(r1)
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0c688: 41 82 00 18 beq- ffc0c6a0 <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 ) );
ffc0c68c: 3d 20 00 00 lis r9,0
ffc0c690: 89 29 26 ec lbz r9,9964(r9)
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
ffc0c694: 38 00 00 13 li r0,19
)
{
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
ffc0c698: 7f 9f 48 40 cmplw cr7,r31,r9
ffc0c69c: 41 9d 00 6c bgt- cr7,ffc0c708 <rtems_task_set_priority+0x98>
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
ffc0c6a0: 2f 9e 00 00 cmpwi cr7,r30,0
return RTEMS_INVALID_ADDRESS;
ffc0c6a4: 38 00 00 09 li r0,9
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
ffc0c6a8: 41 9e 00 60 beq- cr7,ffc0c708 <rtems_task_set_priority+0x98>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get( id, &location );
ffc0c6ac: 38 81 00 08 addi r4,r1,8
ffc0c6b0: 48 00 25 c9 bl ffc0ec78 <_Thread_Get>
switch ( location ) {
ffc0c6b4: 80 01 00 08 lwz r0,8(r1)
ffc0c6b8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0c6bc: 40 9e 00 48 bne- cr7,ffc0c704 <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 ) {
ffc0c6c0: 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;
ffc0c6c4: 80 03 00 14 lwz r0,20(r3)
ffc0c6c8: 90 1e 00 00 stw r0,0(r30)
if ( new_priority != RTEMS_CURRENT_PRIORITY ) {
ffc0c6cc: 41 9e 00 2c beq- cr7,ffc0c6f8 <rtems_task_set_priority+0x88>
the_thread->real_priority = new_priority;
if ( the_thread->resource_count == 0 ||
ffc0c6d0: 80 03 00 1c lwz r0,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;
ffc0c6d4: 93 e3 00 18 stw r31,24(r3)
if ( the_thread->resource_count == 0 ||
ffc0c6d8: 2f 80 00 00 cmpwi cr7,r0,0
ffc0c6dc: 41 9e 00 10 beq- cr7,ffc0c6ec <rtems_task_set_priority+0x7c>
ffc0c6e0: 80 03 00 14 lwz r0,20(r3)
ffc0c6e4: 7f 80 f8 40 cmplw cr7,r0,r31
ffc0c6e8: 40 9d 00 10 ble- cr7,ffc0c6f8 <rtems_task_set_priority+0x88><== ALWAYS TAKEN
the_thread->current_priority > new_priority )
_Thread_Change_priority( the_thread, new_priority, false );
ffc0c6ec: 7f e4 fb 78 mr r4,r31
ffc0c6f0: 38 a0 00 00 li r5,0
ffc0c6f4: 48 00 1f fd bl ffc0e6f0 <_Thread_Change_priority>
}
_Thread_Enable_dispatch();
ffc0c6f8: 48 00 25 61 bl ffc0ec58 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc0c6fc: 38 00 00 00 li r0,0
ffc0c700: 48 00 00 08 b ffc0c708 <rtems_task_set_priority+0x98>
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc0c704: 38 00 00 04 li r0,4
}
ffc0c708: 39 61 00 20 addi r11,r1,32
ffc0c70c: 7c 03 03 78 mr r3,r0
ffc0c710: 4b ff 4a 10 b ffc01120 <_restgpr_30_x>
ffc18858 <rtems_timer_cancel>:
*/
rtems_status_code rtems_timer_cancel(
rtems_id id
)
{
ffc18858: 94 21 ff e8 stwu r1,-24(r1)
ffc1885c: 7c 08 02 a6 mflr r0
ffc18860: 7c 64 1b 78 mr r4,r3
Objects_Id id,
Objects_Locations *location
)
{
return (Timer_Control *)
_Objects_Get( &_Timer_Information, id, location );
ffc18864: 3c 60 00 00 lis r3,0
ffc18868: 90 01 00 1c stw r0,28(r1)
ffc1886c: 38 63 79 3c addi r3,r3,31036
ffc18870: 38 a1 00 08 addi r5,r1,8
ffc18874: 48 00 32 95 bl ffc1bb08 <_Objects_Get>
Timer_Control *the_timer;
Objects_Locations location;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
ffc18878: 80 01 00 08 lwz r0,8(r1)
ffc1887c: 2f 80 00 00 cmpwi cr7,r0,0
ffc18880: 40 9e 00 24 bne- cr7,ffc188a4 <rtems_timer_cancel+0x4c>
case OBJECTS_LOCAL:
if ( !_Timer_Is_dormant_class( the_timer->the_class ) )
ffc18884: 80 03 00 38 lwz r0,56(r3)
ffc18888: 2f 80 00 04 cmpwi cr7,r0,4
ffc1888c: 41 9e 00 0c beq- cr7,ffc18898 <rtems_timer_cancel+0x40> <== NEVER TAKEN
(void) _Watchdog_Remove( &the_timer->Ticker );
ffc18890: 38 63 00 10 addi r3,r3,16
ffc18894: 48 00 55 21 bl ffc1ddb4 <_Watchdog_Remove>
_Thread_Enable_dispatch();
ffc18898: 48 00 3f 69 bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc1889c: 38 60 00 00 li r3,0
ffc188a0: 48 00 00 08 b ffc188a8 <rtems_timer_cancel+0x50>
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc188a4: 38 60 00 04 li r3,4
}
ffc188a8: 80 01 00 1c lwz r0,28(r1)
ffc188ac: 38 21 00 18 addi r1,r1,24
ffc188b0: 7c 08 03 a6 mtlr r0
ffc188b4: 4e 80 00 20 blr
ffc18dd8 <rtems_timer_server_fire_when>:
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
ffc18dd8: 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;
ffc18ddc: 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
)
{
ffc18de0: 7c 08 02 a6 mflr r0
ffc18de4: bf 01 00 18 stmw r24,24(r1)
ffc18de8: 7c 7f 1b 78 mr r31,r3
ffc18dec: 7c 9c 23 78 mr r28,r4
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
ffc18df0: 83 a9 28 e4 lwz r29,10468(r9)
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
ffc18df4: 7c be 2b 78 mr r30,r5
ffc18df8: 90 01 00 3c stw r0,60(r1)
ffc18dfc: 7c da 33 78 mr r26,r6
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
ffc18e00: 2f 9d 00 00 cmpwi cr7,r29,0
return RTEMS_INCORRECT_STATE;
ffc18e04: 3b 20 00 0e li r25,14
Timer_Control *the_timer;
Objects_Locations location;
rtems_interval seconds;
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
ffc18e08: 41 9e 00 c8 beq- cr7,ffc18ed0 <rtems_timer_server_fire_when+0xf8>
return RTEMS_INCORRECT_STATE;
if ( !_TOD_Is_set )
ffc18e0c: 3d 20 00 00 lis r9,0
ffc18e10: 88 09 28 88 lbz r0,10376(r9)
return RTEMS_NOT_DEFINED;
ffc18e14: 3b 20 00 0b li r25,11
Timer_server_Control *timer_server = _Timer_server;
if ( !timer_server )
return RTEMS_INCORRECT_STATE;
if ( !_TOD_Is_set )
ffc18e18: 2f 80 00 00 cmpwi cr7,r0,0
ffc18e1c: 41 9e 00 b4 beq- cr7,ffc18ed0 <rtems_timer_server_fire_when+0xf8><== NEVER TAKEN
return RTEMS_NOT_DEFINED;
if ( !routine )
ffc18e20: 2f 85 00 00 cmpwi cr7,r5,0
return RTEMS_INVALID_ADDRESS;
ffc18e24: 3b 20 00 09 li r25,9
return RTEMS_INCORRECT_STATE;
if ( !_TOD_Is_set )
return RTEMS_NOT_DEFINED;
if ( !routine )
ffc18e28: 41 9e 00 a8 beq- cr7,ffc18ed0 <rtems_timer_server_fire_when+0xf8>
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
ffc18e2c: 7c 83 23 78 mr r3,r4
ffc18e30: 4b ff cc 5d bl ffc15a8c <_TOD_Validate>
return RTEMS_INVALID_CLOCK;
ffc18e34: 3b 20 00 14 li r25,20
return RTEMS_NOT_DEFINED;
if ( !routine )
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
ffc18e38: 2f 83 00 00 cmpwi cr7,r3,0
ffc18e3c: 41 9e 00 94 beq- cr7,ffc18ed0 <rtems_timer_server_fire_when+0xf8>
return RTEMS_INVALID_CLOCK;
seconds = _TOD_To_seconds( wall_time );
ffc18e40: 7f 83 e3 78 mr r3,r28
if ( seconds <= _TOD_Seconds_since_epoch() )
ffc18e44: 3f 60 00 00 lis r27,0
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
return RTEMS_INVALID_CLOCK;
seconds = _TOD_To_seconds( wall_time );
ffc18e48: 4b ff cb b9 bl ffc15a00 <_TOD_To_seconds>
if ( seconds <= _TOD_Seconds_since_epoch() )
ffc18e4c: 80 1b 28 9c lwz r0,10396(r27)
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
return RTEMS_INVALID_CLOCK;
seconds = _TOD_To_seconds( wall_time );
ffc18e50: 7c 7c 1b 78 mr r28,r3
if ( seconds <= _TOD_Seconds_since_epoch() )
ffc18e54: 7f 83 00 40 cmplw cr7,r3,r0
ffc18e58: 40 9d 00 78 ble- cr7,ffc18ed0 <rtems_timer_server_fire_when+0xf8>
ffc18e5c: 3c 60 00 00 lis r3,0
ffc18e60: 38 63 79 3c addi r3,r3,31036
ffc18e64: 7f e4 fb 78 mr r4,r31
ffc18e68: 38 a1 00 08 addi r5,r1,8
ffc18e6c: 48 00 2c 9d bl ffc1bb08 <_Objects_Get>
return RTEMS_INVALID_CLOCK;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
ffc18e70: 83 01 00 08 lwz r24,8(r1)
ffc18e74: 7c 79 1b 78 mr r25,r3
ffc18e78: 2f 98 00 00 cmpwi cr7,r24,0
ffc18e7c: 40 9e 00 50 bne- cr7,ffc18ecc <rtems_timer_server_fire_when+0xf4>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
ffc18e80: 38 63 00 10 addi r3,r3,16
ffc18e84: 48 00 4f 31 bl ffc1ddb4 <_Watchdog_Remove>
the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK;
ffc18e88: 38 00 00 03 li r0,3
ffc18e8c: 90 19 00 38 stw r0,56(r25)
_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 );
ffc18e90: 7f 24 cb 78 mr r4,r25
ffc18e94: 7f a3 eb 78 mr r3,r29
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();
ffc18e98: 80 1b 28 9c lwz r0,10396(r27)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc18e9c: 93 19 00 18 stw r24,24(r25)
ffc18ea0: 7f 80 e0 50 subf r28,r0,r28
(*timer_server->schedule_operation)( timer_server, the_timer );
ffc18ea4: 80 1d 00 04 lwz r0,4(r29)
the_watchdog->routine = routine;
ffc18ea8: 93 d9 00 2c stw r30,44(r25)
ffc18eac: 7c 09 03 a6 mtctr r0
the_watchdog->id = id;
ffc18eb0: 93 f9 00 30 stw r31,48(r25)
the_watchdog->user_data = user_data;
ffc18eb4: 93 59 00 34 stw r26,52(r25)
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();
ffc18eb8: 93 99 00 1c stw r28,28(r25)
(*timer_server->schedule_operation)( timer_server, the_timer );
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
ffc18ebc: 3b 20 00 00 li r25,0
(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();
(*timer_server->schedule_operation)( timer_server, the_timer );
ffc18ec0: 4e 80 04 21 bctrl
_Thread_Enable_dispatch();
ffc18ec4: 48 00 39 3d bl ffc1c800 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
ffc18ec8: 48 00 00 08 b ffc18ed0 <rtems_timer_server_fire_when+0xf8>
#endif
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
ffc18ecc: 3b 20 00 04 li r25,4
}
ffc18ed0: 39 61 00 38 addi r11,r1,56
ffc18ed4: 7f 23 cb 78 mr r3,r25
ffc18ed8: 4b ff 53 c8 b ffc0e2a0 <_restgpr_24_x>
ffc08424 <sched_get_priority_max>:
int sched_get_priority_max(
int policy
)
{
switch ( policy ) {
ffc08424: 2b 83 00 04 cmplwi cr7,r3,4
#include <rtems/posix/priority.h>
int sched_get_priority_max(
int policy
)
{
ffc08428: 94 21 ff f8 stwu r1,-8(r1)
ffc0842c: 7c 08 02 a6 mflr r0
ffc08430: 90 01 00 0c stw r0,12(r1)
switch ( policy ) {
ffc08434: 41 9d 00 14 bgt- cr7,ffc08448 <sched_get_priority_max+0x24>
ffc08438: 38 00 00 01 li r0,1
ffc0843c: 7c 03 18 30 slw r3,r0,r3
ffc08440: 70 60 00 17 andi. r0,r3,23
ffc08444: 40 82 00 18 bne- ffc0845c <sched_get_priority_max+0x38> <== ALWAYS TAKEN
case SCHED_RR:
case SCHED_SPORADIC:
break;
default:
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08448: 48 00 8f 61 bl ffc113a8 <__errno>
ffc0844c: 38 00 00 16 li r0,22
ffc08450: 90 03 00 00 stw r0,0(r3)
ffc08454: 38 60 ff ff li r3,-1
ffc08458: 48 00 00 10 b ffc08468 <sched_get_priority_max+0x44>
}
return POSIX_SCHEDULER_MAXIMUM_PRIORITY;
ffc0845c: 3d 20 00 00 lis r9,0
ffc08460: 88 69 26 d4 lbz r3,9940(r9)
ffc08464: 38 63 ff ff addi r3,r3,-1
}
ffc08468: 80 01 00 0c lwz r0,12(r1)
ffc0846c: 38 21 00 08 addi r1,r1,8
ffc08470: 7c 08 03 a6 mtlr r0
ffc08474: 4e 80 00 20 blr
ffc08478 <sched_get_priority_min>:
int sched_get_priority_min(
int policy
)
{
switch ( policy ) {
ffc08478: 2b 83 00 04 cmplwi cr7,r3,4
#include <rtems/posix/priority.h>
int sched_get_priority_min(
int policy
)
{
ffc0847c: 94 21 ff f8 stwu r1,-8(r1)
ffc08480: 7c 08 02 a6 mflr r0
ffc08484: 90 01 00 0c stw r0,12(r1)
switch ( policy ) {
ffc08488: 41 9d 00 18 bgt- cr7,ffc084a0 <sched_get_priority_min+0x28>
ffc0848c: 38 00 00 01 li r0,1
ffc08490: 7c 00 18 30 slw r0,r0,r3
ffc08494: 70 09 00 17 andi. r9,r0,23
default:
rtems_set_errno_and_return_minus_one( EINVAL );
}
return POSIX_SCHEDULER_MINIMUM_PRIORITY;
ffc08498: 38 60 00 01 li r3,1
int sched_get_priority_min(
int policy
)
{
switch ( policy ) {
ffc0849c: 40 82 00 14 bne- ffc084b0 <sched_get_priority_min+0x38> <== ALWAYS TAKEN
case SCHED_RR:
case SCHED_SPORADIC:
break;
default:
rtems_set_errno_and_return_minus_one( EINVAL );
ffc084a0: 48 00 8f 09 bl ffc113a8 <__errno>
ffc084a4: 38 00 00 16 li r0,22
ffc084a8: 90 03 00 00 stw r0,0(r3)
ffc084ac: 38 60 ff ff li r3,-1
}
return POSIX_SCHEDULER_MINIMUM_PRIORITY;
}
ffc084b0: 80 01 00 0c lwz r0,12(r1)
ffc084b4: 38 21 00 08 addi r1,r1,8
ffc084b8: 7c 08 03 a6 mtlr r0
ffc084bc: 4e 80 00 20 blr
ffc084c0 <sched_rr_get_interval>:
int sched_rr_get_interval(
pid_t pid,
struct timespec *interval
)
{
ffc084c0: 7c 2b 0b 78 mr r11,r1
ffc084c4: 94 21 ff e8 stwu r1,-24(r1)
ffc084c8: 7c 08 02 a6 mflr r0
ffc084cc: 48 01 42 c1 bl ffc1c78c <_savegpr_31>
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid && pid != getpid() )
ffc084d0: 7c 7f 1b 79 mr. r31,r3
int sched_rr_get_interval(
pid_t pid,
struct timespec *interval
)
{
ffc084d4: 90 01 00 1c stw r0,28(r1)
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid && pid != getpid() )
ffc084d8: 41 a2 00 24 beq+ ffc084fc <sched_rr_get_interval+0x3c> <== NEVER TAKEN
ffc084dc: 90 81 00 08 stw r4,8(r1)
ffc084e0: 4b ff c8 4d bl ffc04d2c <getpid>
ffc084e4: 7f 9f 18 00 cmpw cr7,r31,r3
ffc084e8: 80 81 00 08 lwz r4,8(r1)
ffc084ec: 41 be 00 10 beq+ cr7,ffc084fc <sched_rr_get_interval+0x3c>
rtems_set_errno_and_return_minus_one( ESRCH );
ffc084f0: 48 00 8e b9 bl ffc113a8 <__errno>
ffc084f4: 38 00 00 03 li r0,3
ffc084f8: 48 00 00 14 b ffc0850c <sched_rr_get_interval+0x4c>
if ( !interval )
ffc084fc: 2f 84 00 00 cmpwi cr7,r4,0
ffc08500: 40 be 00 18 bne+ cr7,ffc08518 <sched_rr_get_interval+0x58>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08504: 48 00 8e a5 bl ffc113a8 <__errno>
ffc08508: 38 00 00 16 li r0,22
ffc0850c: 90 03 00 00 stw r0,0(r3)
ffc08510: 38 60 ff ff li r3,-1
ffc08514: 48 00 00 14 b ffc08528 <sched_rr_get_interval+0x68>
_Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval );
ffc08518: 3d 20 00 00 lis r9,0
ffc0851c: 80 69 27 b0 lwz r3,10160(r9)
ffc08520: 48 00 3d ad bl ffc0c2cc <_Timespec_From_ticks>
return 0;
ffc08524: 38 60 00 00 li r3,0
}
ffc08528: 39 61 00 18 addi r11,r1,24
ffc0852c: 4b ff 86 b8 b ffc00be4 <_restgpr_31_x>
ffc0b044 <sem_open>:
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc0b044: 3d 20 00 00 lis r9,0
int oflag,
...
/* mode_t mode, */
/* unsigned int value */
)
{
ffc0b048: 94 21 ff b8 stwu r1,-72(r1)
ffc0b04c: 7c 08 02 a6 mflr r0
ffc0b050: 81 69 27 ac lwz r11,10156(r9)
ffc0b054: 90 01 00 4c stw r0,76(r1)
ffc0b058: 38 0b 00 01 addi r0,r11,1
ffc0b05c: bf 61 00 34 stmw r27,52(r1)
ffc0b060: 7c 7f 1b 78 mr r31,r3
ffc0b064: 7c 9e 23 78 mr r30,r4
ffc0b068: 90 a1 00 28 stw r5,40(r1)
ffc0b06c: 90 c1 00 2c stw r6,44(r1)
ffc0b070: 90 09 27 ac stw r0,10156(r9)
POSIX_Semaphore_Control *the_semaphore;
Objects_Locations location;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
ffc0b074: 70 9c 02 00 andi. r28,r4,512
/* unsigned int value */
)
{
va_list arg;
mode_t mode;
unsigned int value = 0;
ffc0b078: 3b a0 00 00 li r29,0
POSIX_Semaphore_Control *the_semaphore;
Objects_Locations location;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
ffc0b07c: 41 a2 00 20 beq+ ffc0b09c <sem_open+0x58>
va_start(arg, oflag);
ffc0b080: 38 01 00 50 addi r0,r1,80
ffc0b084: 90 01 00 18 stw r0,24(r1)
ffc0b088: 39 21 00 20 addi r9,r1,32
mode = (mode_t) va_arg( arg, unsigned int );
value = va_arg( arg, unsigned int );
ffc0b08c: 38 00 00 04 li r0,4
Objects_Locations location;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
va_start(arg, oflag);
ffc0b090: 91 21 00 1c stw r9,28(r1)
mode = (mode_t) va_arg( arg, unsigned int );
value = va_arg( arg, unsigned int );
ffc0b094: 98 01 00 14 stb r0,20(r1)
ffc0b098: 83 a9 00 0c lwz r29,12(r9)
va_end(arg);
}
status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id );
ffc0b09c: 7f e3 fb 78 mr r3,r31
ffc0b0a0: 38 81 00 08 addi r4,r1,8
ffc0b0a4: 48 00 6b 0d bl ffc11bb0 <_POSIX_Semaphore_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 ) {
ffc0b0a8: 7c 7b 1b 79 mr. r27,r3
ffc0b0ac: 41 82 00 24 beq- ffc0b0d0 <sem_open+0x8c>
/*
* 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) ) ) {
ffc0b0b0: 2f 9b 00 02 cmpwi cr7,r27,2
ffc0b0b4: 40 9e 00 0c bne- cr7,ffc0b0c0 <sem_open+0x7c> <== NEVER TAKEN
ffc0b0b8: 2f 9c 00 00 cmpwi cr7,r28,0
ffc0b0bc: 40 9e 00 68 bne- cr7,ffc0b124 <sem_open+0xe0>
_Thread_Enable_dispatch();
ffc0b0c0: 48 00 31 85 bl ffc0e244 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one_cast( status, sem_t * );
ffc0b0c4: 48 00 9d 19 bl ffc14ddc <__errno>
ffc0b0c8: 93 63 00 00 stw r27,0(r3)
ffc0b0cc: 48 00 00 20 b ffc0b0ec <sem_open+0xa8>
/*
* Check for existence with creation.
*/
if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) {
ffc0b0d0: 73 de 0a 00 andi. r30,r30,2560
ffc0b0d4: 2f 9e 0a 00 cmpwi cr7,r30,2560
ffc0b0d8: 40 be 00 1c bne+ cr7,ffc0b0f4 <sem_open+0xb0>
_Thread_Enable_dispatch();
ffc0b0dc: 48 00 31 69 bl ffc0e244 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * );
ffc0b0e0: 48 00 9c fd bl ffc14ddc <__errno>
ffc0b0e4: 38 00 00 11 li r0,17
ffc0b0e8: 90 03 00 00 stw r0,0(r3)
ffc0b0ec: 38 60 ff ff li r3,-1
ffc0b0f0: 48 00 00 64 b ffc0b154 <sem_open+0x110>
ffc0b0f4: 80 81 00 08 lwz r4,8(r1)
ffc0b0f8: 3c 60 00 00 lis r3,0
ffc0b0fc: 38 a1 00 10 addi r5,r1,16
ffc0b100: 38 63 30 4c addi r3,r3,12364
ffc0b104: 48 00 23 ad bl ffc0d4b0 <_Objects_Get>
}
the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location );
the_semaphore->open_count += 1;
ffc0b108: 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( &the_semaphore_id, &location );
ffc0b10c: 90 61 00 0c stw r3,12(r1)
the_semaphore->open_count += 1;
ffc0b110: 38 09 00 01 addi r0,r9,1
ffc0b114: 90 03 00 18 stw r0,24(r3)
_Thread_Enable_dispatch();
ffc0b118: 48 00 31 2d bl ffc0e244 <_Thread_Enable_dispatch>
_Thread_Enable_dispatch();
ffc0b11c: 48 00 31 29 bl ffc0e244 <_Thread_Enable_dispatch>
goto return_id;
ffc0b120: 48 00 00 2c b ffc0b14c <sem_open+0x108>
/*
* 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(
ffc0b124: 7f e3 fb 78 mr r3,r31
ffc0b128: 38 80 00 00 li r4,0
ffc0b12c: 7f a5 eb 78 mr r5,r29
ffc0b130: 38 c1 00 0c addi r6,r1,12
ffc0b134: 48 00 69 09 bl ffc11a3c <_POSIX_Semaphore_Create_support>
ffc0b138: 7c 7f 1b 78 mr r31,r3
/*
* errno was set by Create_support, so don't set it again.
*/
_Thread_Enable_dispatch();
ffc0b13c: 48 00 31 09 bl ffc0e244 <_Thread_Enable_dispatch>
if ( status == -1 )
ffc0b140: 2f 9f ff ff cmpwi cr7,r31,-1
return SEM_FAILED;
ffc0b144: 38 60 ff ff li r3,-1
* errno was set by Create_support, so don't set it again.
*/
_Thread_Enable_dispatch();
if ( status == -1 )
ffc0b148: 41 9e 00 0c beq- cr7,ffc0b154 <sem_open+0x110>
return_id:
#if defined(RTEMS_USE_16_BIT_OBJECT)
the_semaphore->Semaphore_id = the_semaphore->Object.id;
id = &the_semaphore->Semaphore_id;
#else
id = (sem_t *)&the_semaphore->Object.id;
ffc0b14c: 80 61 00 0c lwz r3,12(r1)
ffc0b150: 38 63 00 08 addi r3,r3,8
#endif
return id;
}
ffc0b154: 39 61 00 48 addi r11,r1,72
ffc0b158: 4b ff 8c 3c b ffc03d94 <_restgpr_27_x>
ffc082bc <sigaction>:
struct sigaction *oact
)
{
ISR_Level level;
if ( oact )
ffc082bc: 7c a9 2b 79 mr. r9,r5
int sigaction(
int sig,
const struct sigaction *act,
struct sigaction *oact
)
{
ffc082c0: 94 21 ff e8 stwu r1,-24(r1)
ffc082c4: 7c 08 02 a6 mflr r0
ffc082c8: bf 81 00 08 stmw r28,8(r1)
ffc082cc: 7c 9f 23 78 mr r31,r4
ffc082d0: 90 01 00 1c stw r0,28(r1)
ISR_Level level;
if ( oact )
ffc082d4: 41 82 00 1c beq- ffc082f0 <sigaction+0x34>
*oact = _POSIX_signals_Vectors[ sig ];
ffc082d8: 1c 03 00 0c mulli r0,r3,12
ffc082dc: 3d 60 00 00 lis r11,0
ffc082e0: 39 6b 31 80 addi r11,r11,12672
ffc082e4: 7d 6b 02 14 add r11,r11,r0
ffc082e8: 7c ab 64 aa lswi r5,r11,12
ffc082ec: 7c a9 65 aa stswi r5,r9,12
if ( !sig )
ffc082f0: 2f 83 00 00 cmpwi cr7,r3,0
ffc082f4: 41 9e 00 18 beq- cr7,ffc0830c <sigaction+0x50>
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc082f8: 38 03 ff ff addi r0,r3,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
ffc082fc: 2b 80 00 1f cmplwi cr7,r0,31
ffc08300: 41 9d 00 0c bgt- cr7,ffc0830c <sigaction+0x50>
*
* NOTE: Solaris documentation claims to "silently enforce" this which
* contradicts the POSIX specification.
*/
if ( sig == SIGKILL )
ffc08304: 2f 83 00 09 cmpwi cr7,r3,9
ffc08308: 40 be 00 18 bne+ cr7,ffc08320 <sigaction+0x64>
rtems_set_errno_and_return_minus_one( EINVAL );
ffc0830c: 48 00 94 1d bl ffc11728 <__errno>
ffc08310: 38 00 00 16 li r0,22
ffc08314: 90 03 00 00 stw r0,0(r3)
ffc08318: 38 00 ff ff li r0,-1
ffc0831c: 48 00 00 6c b ffc08388 <sigaction+0xcc>
/*
* Evaluate the new action structure and set the global signal vector
* appropriately.
*/
if ( act ) {
ffc08320: 2f 9f 00 00 cmpwi cr7,r31,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;
ffc08324: 38 00 00 00 li r0,0
/*
* Evaluate the new action structure and set the global signal vector
* appropriately.
*/
if ( act ) {
ffc08328: 41 9e 00 60 beq- cr7,ffc08388 <sigaction+0xcc> <== NEVER TAKEN
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc0832c: 7f c0 00 a6 mfmsr r30
ffc08330: 7c 10 42 a6 mfsprg r0,0
ffc08334: 7f c0 00 78 andc r0,r30,r0
ffc08338: 7c 00 01 24 mtmsr r0
* 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 ) {
ffc0833c: 80 1f 00 08 lwz r0,8(r31)
ffc08340: 3f 80 00 00 lis r28,0
ffc08344: 3b 9c 31 80 addi r28,r28,12672
ffc08348: 2f 80 00 00 cmpwi cr7,r0,0
ffc0834c: 1f a3 00 0c mulli r29,r3,12
ffc08350: 40 be 00 20 bne+ cr7,ffc08370 <sigaction+0xb4>
_POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ];
ffc08354: 3d 20 ff c2 lis r9,-62
ffc08358: 39 29 fc 8c addi r9,r9,-884
ffc0835c: 7d 7c ea 14 add r11,r28,r29
ffc08360: 7d 29 ea 14 add r9,r9,r29
ffc08364: 7c a9 64 aa lswi r5,r9,12
ffc08368: 7c ab 65 aa stswi r5,r11,12
ffc0836c: 48 00 00 14 b ffc08380 <sigaction+0xc4>
} else {
_POSIX_signals_Clear_process_signals( sig );
ffc08370: 48 00 60 c5 bl ffc0e434 <_POSIX_signals_Clear_process_signals>
_POSIX_signals_Vectors[ sig ] = *act;
ffc08374: 7d 3c ea 14 add r9,r28,r29
ffc08378: 7c bf 64 aa lswi r5,r31,12
ffc0837c: 7c a9 65 aa stswi r5,r9,12
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc08380: 7f c0 01 24 mtmsr r30
* 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;
ffc08384: 38 00 00 00 li r0,0
}
ffc08388: 39 61 00 18 addi r11,r1,24
ffc0838c: 7c 03 03 78 mr r3,r0
ffc08390: 4b ff 85 a0 b ffc00930 <_restgpr_28_x>
ffc087e8 <sigtimedwait>:
int sigtimedwait(
const sigset_t *set,
siginfo_t *info,
const struct timespec *timeout
)
{
ffc087e8: 94 21 ff d0 stwu r1,-48(r1)
ffc087ec: 7c 08 02 a6 mflr r0
ffc087f0: bf 61 00 1c stmw r27,28(r1)
ISR_Level level;
/*
* Error check parameters before disabling interrupts.
*/
if ( !set )
ffc087f4: 7c 7d 1b 79 mr. r29,r3
int sigtimedwait(
const sigset_t *set,
siginfo_t *info,
const struct timespec *timeout
)
{
ffc087f8: 7c 9f 23 78 mr r31,r4
ffc087fc: 90 01 00 34 stw r0,52(r1)
ffc08800: 7c be 2b 78 mr r30,r5
ISR_Level level;
/*
* Error check parameters before disabling interrupts.
*/
if ( !set )
ffc08804: 41 82 00 2c beq- ffc08830 <sigtimedwait+0x48>
/* NOTE: This is very specifically a RELATIVE not ABSOLUTE time
* in the Open Group specification.
*/
interval = 0;
if ( timeout ) {
ffc08808: 2f 85 00 00 cmpwi cr7,r5,0
ffc0880c: 41 9e 00 30 beq- cr7,ffc0883c <sigtimedwait+0x54>
if ( !_Timespec_Is_valid( timeout ) )
ffc08810: 7c a3 2b 78 mr r3,r5
ffc08814: 48 00 3e 19 bl ffc0c62c <_Timespec_Is_valid>
ffc08818: 2f 83 00 00 cmpwi cr7,r3,0
ffc0881c: 41 9e 00 14 beq- cr7,ffc08830 <sigtimedwait+0x48>
rtems_set_errno_and_return_minus_one( EINVAL );
interval = _Timespec_To_ticks( timeout );
ffc08820: 7f c3 f3 78 mr r3,r30
ffc08824: 48 00 3e 8d bl ffc0c6b0 <_Timespec_To_ticks>
if ( !interval )
ffc08828: 7c 64 1b 79 mr. r4,r3
ffc0882c: 40 a2 00 14 bne+ ffc08840 <sigtimedwait+0x58> <== ALWAYS TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
ffc08830: 48 00 95 f5 bl ffc11e24 <__errno>
ffc08834: 38 00 00 16 li r0,22
ffc08838: 48 00 01 7c b ffc089b4 <sigtimedwait+0x1cc>
/* NOTE: This is very specifically a RELATIVE not ABSOLUTE time
* in the Open Group specification.
*/
interval = 0;
ffc0883c: 38 80 00 00 li r4,0
/*
* Initialize local variables.
*/
the_info = ( info ) ? info : &signal_information;
ffc08840: 2f 9f 00 00 cmpwi cr7,r31,0
ffc08844: 40 be 00 08 bne+ cr7,ffc0884c <sigtimedwait+0x64>
ffc08848: 3b e1 00 08 addi r31,r1,8
the_thread = _Thread_Executing;
ffc0884c: 3d 20 00 00 lis r9,0
ffc08850: 81 29 31 30 lwz r9,12592(r9)
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
ffc08854: 83 69 01 34 lwz r27,308(r9)
static inline uint32_t ppc_interrupt_disable( void )
{
uint32_t level;
uint32_t mask;
asm volatile (
ffc08858: 7f 80 00 a6 mfmsr r28
ffc0885c: 7c 10 42 a6 mfsprg r0,0
ffc08860: 7f 80 00 78 andc r0,r28,r0
ffc08864: 7c 00 01 24 mtmsr r0
*/
/* API signals pending? */
_ISR_Disable( level );
if ( *set & api->signals_pending ) {
ffc08868: 80 1d 00 00 lwz r0,0(r29)
ffc0886c: 80 7b 00 d4 lwz r3,212(r27)
ffc08870: 7c 0b 18 39 and. r11,r0,r3
ffc08874: 41 a2 00 40 beq+ ffc088b4 <sigtimedwait+0xcc>
/* XXX real info later */
the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending );
ffc08878: 4b ff ff 19 bl ffc08790 <_POSIX_signals_Get_lowest>
_POSIX_signals_Clear_signals(
ffc0887c: 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 );
ffc08880: 90 7f 00 00 stw r3,0(r31)
ffc08884: 7c 64 1b 78 mr r4,r3
_POSIX_signals_Clear_signals(
ffc08888: 38 c0 00 00 li r6,0
ffc0888c: 7f 63 db 78 mr r3,r27
ffc08890: 38 e0 00 00 li r7,0
ffc08894: 48 00 63 61 bl ffc0ebf4 <_POSIX_signals_Clear_signals>
return level;
}
static inline void ppc_interrupt_enable( uint32_t level )
{
asm volatile (
ffc08898: 7f 80 01 24 mtmsr r28
false,
false
);
_ISR_Enable( level );
the_info->si_code = SI_USER;
ffc0889c: 38 00 00 01 li r0,1
the_info->si_value.sival_int = 0;
return the_info->si_signo;
ffc088a0: 83 df 00 00 lwz r30,0(r31)
false,
false
);
_ISR_Enable( level );
the_info->si_code = SI_USER;
ffc088a4: 90 1f 00 04 stw r0,4(r31)
the_info->si_value.sival_int = 0;
ffc088a8: 38 00 00 00 li r0,0
ffc088ac: 90 1f 00 08 stw r0,8(r31)
return the_info->si_signo;
ffc088b0: 48 00 01 0c b ffc089bc <sigtimedwait+0x1d4>
}
/* Process pending signals? */
if ( *set & _POSIX_signals_Pending ) {
ffc088b4: 3d 60 00 00 lis r11,0
ffc088b8: 80 6b 28 4c lwz r3,10316(r11)
ffc088bc: 7c 0b 18 39 and. r11,r0,r3
ffc088c0: 41 a2 00 40 beq+ ffc08900 <sigtimedwait+0x118>
signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending );
ffc088c4: 4b ff fe cd bl ffc08790 <_POSIX_signals_Get_lowest>
_POSIX_signals_Clear_signals( api, signo, the_info, true, false );
ffc088c8: 7f e5 fb 78 mr r5,r31
}
/* Process pending signals? */
if ( *set & _POSIX_signals_Pending ) {
signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending );
ffc088cc: 7c 7e 1b 78 mr r30,r3
_POSIX_signals_Clear_signals( api, signo, the_info, true, false );
ffc088d0: 7f c4 f3 78 mr r4,r30
ffc088d4: 7f 63 db 78 mr r3,r27
ffc088d8: 38 c0 00 01 li r6,1
ffc088dc: 38 e0 00 00 li r7,0
ffc088e0: 48 00 63 15 bl ffc0ebf4 <_POSIX_signals_Clear_signals>
ffc088e4: 7f 80 01 24 mtmsr r28
_ISR_Enable( level );
the_info->si_signo = signo;
the_info->si_code = SI_USER;
ffc088e8: 38 00 00 01 li r0,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;
ffc088ec: 93 df 00 00 stw r30,0(r31)
the_info->si_code = SI_USER;
ffc088f0: 90 1f 00 04 stw r0,4(r31)
the_info->si_value.sival_int = 0;
ffc088f4: 38 00 00 00 li r0,0
ffc088f8: 90 1f 00 08 stw r0,8(r31)
return signo;
ffc088fc: 48 00 00 c0 b ffc089bc <sigtimedwait+0x1d4>
ffc08900: 3d 60 00 00 lis r11,0
ffc08904: 81 4b 27 fc lwz r10,10236(r11)
}
the_info->si_signo = -1;
ffc08908: 38 00 ff ff li r0,-1
ffc0890c: 90 1f 00 00 stw r0,0(r31)
ffc08910: 38 0a 00 01 addi r0,r10,1
ffc08914: 90 0b 27 fc stw r0,10236(r11)
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
the_thread->Wait.return_code = EINTR;
ffc08918: 38 00 00 04 li r0,4
ffc0891c: 90 09 00 34 stw r0,52(r9)
}
the_info->si_signo = -1;
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
ffc08920: 3d 60 00 00 lis r11,0
ffc08924: 39 6b 33 0c addi r11,r11,13068
the_thread->Wait.return_code = EINTR;
the_thread->Wait.option = *set;
ffc08928: 80 1d 00 00 lwz r0,0(r29)
}
the_info->si_signo = -1;
_Thread_Disable_dispatch();
the_thread->Wait.queue = &_POSIX_signals_Wait_queue;
ffc0892c: 91 69 00 44 stw r11,68(r9)
the_thread->Wait.return_code = EINTR;
the_thread->Wait.option = *set;
ffc08930: 90 09 00 30 stw r0,48(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;
ffc08934: 38 00 00 01 li r0,1
the_thread->Wait.return_argument = the_info;
ffc08938: 93 e9 00 28 stw r31,40(r9)
ffc0893c: 90 0b 00 30 stw r0,48(r11)
ffc08940: 7f 80 01 24 mtmsr r28
_Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue );
_ISR_Enable( level );
_Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval );
ffc08944: 3c 60 00 00 lis r3,0
ffc08948: 3c a0 ff c1 lis r5,-63
ffc0894c: 38 63 33 0c addi r3,r3,13068
ffc08950: 38 a5 c1 a4 addi r5,r5,-15964
ffc08954: 48 00 34 95 bl ffc0bde8 <_Thread_queue_Enqueue_with_handler>
_Thread_Enable_dispatch();
ffc08958: 48 00 2f 3d bl ffc0b894 <_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 );
ffc0895c: 80 9f 00 00 lwz r4,0(r31)
ffc08960: 7f 63 db 78 mr r3,r27
ffc08964: 7f e5 fb 78 mr r5,r31
ffc08968: 38 c0 00 00 li r6,0
ffc0896c: 38 e0 00 00 li r7,0
ffc08970: 48 00 62 85 bl ffc0ebf4 <_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)
ffc08974: 3d 20 00 00 lis r9,0
ffc08978: 81 29 31 30 lwz r9,12592(r9)
ffc0897c: 80 09 00 34 lwz r0,52(r9)
ffc08980: 2f 80 00 04 cmpwi cr7,r0,4
ffc08984: 40 9e 00 20 bne- cr7,ffc089a4 <sigtimedwait+0x1bc>
|| !(*set & signo_to_mask( the_info->si_signo )) ) {
ffc08988: 83 df 00 00 lwz r30,0(r31)
ffc0898c: 39 20 00 01 li r9,1
ffc08990: 38 1e ff ff addi r0,r30,-1
ffc08994: 7d 29 00 30 slw r9,r9,r0
ffc08998: 80 1d 00 00 lwz r0,0(r29)
ffc0899c: 7d 2b 00 39 and. r11,r9,r0
ffc089a0: 40 a2 00 1c bne+ ffc089bc <sigtimedwait+0x1d4>
errno = _Thread_Executing->Wait.return_code;
ffc089a4: 48 00 94 81 bl ffc11e24 <__errno>
ffc089a8: 3d 20 00 00 lis r9,0
ffc089ac: 81 29 31 30 lwz r9,12592(r9)
ffc089b0: 80 09 00 34 lwz r0,52(r9)
ffc089b4: 90 03 00 00 stw r0,0(r3)
return -1;
ffc089b8: 3b c0 ff ff li r30,-1
}
return the_info->si_signo;
}
ffc089bc: 39 61 00 30 addi r11,r1,48
ffc089c0: 7f c3 f3 78 mr r3,r30
ffc089c4: 4b ff 83 20 b ffc00ce4 <_restgpr_27_x>
ffc0adac <sigwait>:
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0adac: 7c 2b 0b 78 mr r11,r1
ffc0adb0: 94 21 ff f0 stwu r1,-16(r1)
ffc0adb4: 7c 08 02 a6 mflr r0
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0adb8: 38 a0 00 00 li r5,0
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0adbc: 4b ff 7c 4d bl ffc02a08 <_savegpr_31>
ffc0adc0: 7c 9f 23 78 mr r31,r4
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0adc4: 38 80 00 00 li r4,0
int sigwait(
const sigset_t *set,
int *sig
)
{
ffc0adc8: 90 01 00 14 stw r0,20(r1)
int status;
status = sigtimedwait( set, NULL, NULL );
ffc0adcc: 4b ff fd dd bl ffc0aba8 <sigtimedwait>
if ( status != -1 ) {
ffc0add0: 2f 83 ff ff cmpwi cr7,r3,-1
ffc0add4: 41 9e 00 18 beq- cr7,ffc0adec <sigwait+0x40>
if ( sig )
ffc0add8: 2f 9f 00 00 cmpwi cr7,r31,0
*sig = status;
return 0;
ffc0addc: 38 00 00 00 li r0,0
int status;
status = sigtimedwait( set, NULL, NULL );
if ( status != -1 ) {
if ( sig )
ffc0ade0: 41 9e 00 14 beq- cr7,ffc0adf4 <sigwait+0x48> <== NEVER TAKEN
*sig = status;
ffc0ade4: 90 7f 00 00 stw r3,0(r31)
ffc0ade8: 48 00 00 0c b ffc0adf4 <sigwait+0x48>
return 0;
}
return errno;
ffc0adec: 48 00 90 2d bl ffc13e18 <__errno>
ffc0adf0: 80 03 00 00 lwz r0,0(r3)
}
ffc0adf4: 39 61 00 10 addi r11,r1,16
ffc0adf8: 7c 03 03 78 mr r3,r0
ffc0adfc: 4b ff 7c 58 b ffc02a54 <_restgpr_31_x>
ffc07a0c <timer_create>:
timer_t *timerid
)
{
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
ffc07a0c: 2f 83 00 01 cmpwi cr7,r3,1
int timer_create(
clockid_t clock_id,
struct sigevent *evp,
timer_t *timerid
)
{
ffc07a10: 94 21 ff f0 stwu r1,-16(r1)
ffc07a14: 7c 08 02 a6 mflr r0
ffc07a18: bf c1 00 08 stmw r30,8(r1)
ffc07a1c: 7c 9f 23 78 mr r31,r4
ffc07a20: 7c be 2b 78 mr r30,r5
ffc07a24: 90 01 00 14 stw r0,20(r1)
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
ffc07a28: 40 9e 00 3c bne- cr7,ffc07a64 <timer_create+0x58>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !timerid )
ffc07a2c: 2f 85 00 00 cmpwi cr7,r5,0
ffc07a30: 41 9e 00 34 beq- cr7,ffc07a64 <timer_create+0x58>
/*
* The data of the structure evp are checked in order to verify if they
* are coherent.
*/
if (evp != NULL) {
ffc07a34: 2f 84 00 00 cmpwi cr7,r4,0
ffc07a38: 41 9e 00 38 beq- cr7,ffc07a70 <timer_create+0x64>
/* The structure has data */
if ( ( evp->sigev_notify != SIGEV_NONE ) &&
ffc07a3c: 81 24 00 00 lwz r9,0(r4)
ffc07a40: 38 09 ff ff addi r0,r9,-1
ffc07a44: 2b 80 00 01 cmplwi cr7,r0,1
ffc07a48: 41 9d 00 1c bgt- cr7,ffc07a64 <timer_create+0x58> <== NEVER TAKEN
( 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 )
ffc07a4c: 81 24 00 04 lwz r9,4(r4)
ffc07a50: 2f 89 00 00 cmpwi cr7,r9,0
ffc07a54: 41 9e 00 10 beq- cr7,ffc07a64 <timer_create+0x58> <== NEVER TAKEN
static inline bool is_valid_signo(
int signo
)
{
return ((signo) >= 1 && (signo) <= 32 );
ffc07a58: 39 29 ff ff addi r9,r9,-1
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(evp->sigev_signo) )
ffc07a5c: 2b 89 00 1f cmplwi cr7,r9,31
ffc07a60: 40 bd 00 10 ble+ cr7,ffc07a70 <timer_create+0x64> <== ALWAYS TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
ffc07a64: 48 00 99 15 bl ffc11378 <__errno>
ffc07a68: 38 00 00 16 li r0,22
ffc07a6c: 48 00 00 34 b ffc07aa0 <timer_create+0x94>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
ffc07a70: 3d 20 00 00 lis r9,0
ffc07a74: 81 69 27 f8 lwz r11,10232(r9)
ffc07a78: 38 0b 00 01 addi r0,r11,1
ffc07a7c: 90 09 27 f8 stw r0,10232(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 );
ffc07a80: 3c 60 00 00 lis r3,0
ffc07a84: 38 63 2f 0c addi r3,r3,12044
ffc07a88: 48 00 21 35 bl ffc09bbc <_Objects_Allocate>
/*
* Allocate a timer
*/
ptimer = _POSIX_Timer_Allocate();
if ( !ptimer ) {
ffc07a8c: 2c 03 00 00 cmpwi r3,0
ffc07a90: 40 a2 00 1c bne+ ffc07aac <timer_create+0xa0>
_Thread_Enable_dispatch();
ffc07a94: 48 00 33 35 bl ffc0adc8 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EAGAIN );
ffc07a98: 48 00 98 e1 bl ffc11378 <__errno>
ffc07a9c: 38 00 00 0b li r0,11
ffc07aa0: 90 03 00 00 stw r0,0(r3)
ffc07aa4: 38 60 ff ff li r3,-1
ffc07aa8: 48 00 00 88 b ffc07b30 <timer_create+0x124>
}
/* The data of the created timer are stored to use them later */
ptimer->state = POSIX_TIMER_STATE_CREATE_NEW;
ffc07aac: 38 00 00 02 li r0,2
ffc07ab0: 98 03 00 3c stb r0,60(r3)
ptimer->thread_id = _Thread_Executing->Object.id;
ffc07ab4: 3d 20 00 00 lis r9,0
if ( evp != NULL ) {
ffc07ab8: 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;
ffc07abc: 81 29 31 50 lwz r9,12624(r9)
ffc07ac0: 80 09 00 08 lwz r0,8(r9)
ffc07ac4: 90 03 00 38 stw r0,56(r3)
if ( evp != NULL ) {
ffc07ac8: 41 9e 00 1c beq- cr7,ffc07ae4 <timer_create+0xd8>
ptimer->inf.sigev_notify = evp->sigev_notify;
ffc07acc: 80 1f 00 00 lwz r0,0(r31)
ffc07ad0: 90 03 00 40 stw r0,64(r3)
ptimer->inf.sigev_signo = evp->sigev_signo;
ffc07ad4: 80 1f 00 04 lwz r0,4(r31)
ffc07ad8: 90 03 00 44 stw r0,68(r3)
ptimer->inf.sigev_value = evp->sigev_value;
ffc07adc: 80 1f 00 08 lwz r0,8(r31)
ffc07ae0: 90 03 00 48 stw r0,72(r3)
uint32_t name
)
{
_Objects_Set_local_object(
information,
_Objects_Get_index( the_object->id ),
ffc07ae4: 81 23 00 08 lwz r9,8(r3)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
ffc07ae8: 3d 60 00 00 lis r11,0
ffc07aec: 81 4b 2f 28 lwz r10,12072(r11)
}
ptimer->overrun = 0;
ffc07af0: 38 00 00 00 li r0,0
ffc07af4: 55 2b 13 ba rlwinm r11,r9,2,14,29
ffc07af8: 90 03 00 68 stw r0,104(r3)
ptimer->timer_data.it_value.tv_sec = 0;
ffc07afc: 90 03 00 5c stw r0,92(r3)
ptimer->timer_data.it_value.tv_nsec = 0;
ffc07b00: 90 03 00 60 stw r0,96(r3)
ptimer->timer_data.it_interval.tv_sec = 0;
ffc07b04: 90 03 00 54 stw r0,84(r3)
ptimer->timer_data.it_interval.tv_nsec = 0;
ffc07b08: 90 03 00 58 stw r0,88(r3)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc07b0c: 90 03 00 18 stw r0,24(r3)
the_watchdog->routine = routine;
ffc07b10: 90 03 00 2c stw r0,44(r3)
the_watchdog->id = id;
ffc07b14: 90 03 00 30 stw r0,48(r3)
the_watchdog->user_data = user_data;
ffc07b18: 90 03 00 34 stw r0,52(r3)
ffc07b1c: 7c 6a 59 2e stwx r3,r10,r11
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
ffc07b20: 90 03 00 0c stw r0,12(r3)
_Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL );
_Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0);
*timerid = ptimer->Object.id;
ffc07b24: 91 3e 00 00 stw r9,0(r30)
_Thread_Enable_dispatch();
ffc07b28: 48 00 32 a1 bl ffc0adc8 <_Thread_Enable_dispatch>
return 0;
ffc07b2c: 38 60 00 00 li r3,0
}
ffc07b30: 39 61 00 10 addi r11,r1,16
ffc07b34: 4b ff 8a ec b ffc00620 <_restgpr_30_x>
ffc07b38 <timer_settime>:
timer_t timerid,
int flags,
const struct itimerspec *value,
struct itimerspec *ovalue
)
{
ffc07b38: 94 21 ff c0 stwu r1,-64(r1)
ffc07b3c: 7c 08 02 a6 mflr r0
ffc07b40: bf 61 00 2c stmw r27,44(r1)
Objects_Locations location;
bool activated;
uint32_t initial_period;
struct itimerspec normalize;
if ( !value )
ffc07b44: 7c bd 2b 79 mr. r29,r5
timer_t timerid,
int flags,
const struct itimerspec *value,
struct itimerspec *ovalue
)
{
ffc07b48: 7c 7f 1b 78 mr r31,r3
ffc07b4c: 90 01 00 44 stw r0,68(r1)
ffc07b50: 7c 9c 23 78 mr r28,r4
ffc07b54: 7c de 33 78 mr r30,r6
Objects_Locations location;
bool activated;
uint32_t initial_period;
struct itimerspec normalize;
if ( !value )
ffc07b58: 41 82 01 68 beq- ffc07cc0 <timer_settime+0x188> <== NEVER TAKEN
/*
* 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) ) ) {
ffc07b5c: 38 7d 00 08 addi r3,r29,8
ffc07b60: 48 00 40 3d bl ffc0bb9c <_Timespec_Is_valid>
ffc07b64: 2f 83 00 00 cmpwi cr7,r3,0
ffc07b68: 41 9e 01 58 beq- cr7,ffc07cc0 <timer_settime+0x188>
rtems_set_errno_and_return_minus_one( EINVAL );
}
if ( !_Timespec_Is_valid( &(value->it_interval) ) ) {
ffc07b6c: 7f a3 eb 78 mr r3,r29
ffc07b70: 48 00 40 2d bl ffc0bb9c <_Timespec_Is_valid>
ffc07b74: 2f 83 00 00 cmpwi cr7,r3,0
ffc07b78: 41 9e 01 48 beq- cr7,ffc07cc0 <timer_settime+0x188>
rtems_set_errno_and_return_minus_one( EINVAL );
}
if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) {
ffc07b7c: 2f 9c 00 04 cmpwi cr7,r28,4
ffc07b80: 41 9e 00 0c beq- cr7,ffc07b8c <timer_settime+0x54>
ffc07b84: 2f 9c 00 00 cmpwi cr7,r28,0
ffc07b88: 40 9e 01 38 bne- cr7,ffc07cc0 <timer_settime+0x188> <== NEVER TAKEN
}
normalize = *value;
/* Convert absolute to relative time */
if (flags == TIMER_ABSTIME) {
ffc07b8c: 2f 9c 00 04 cmpwi cr7,r28,4
if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) {
rtems_set_errno_and_return_minus_one( EINVAL );
}
normalize = *value;
ffc07b90: 39 21 00 14 addi r9,r1,20
ffc07b94: 7c bd 84 aa lswi r5,r29,16
ffc07b98: 7c a9 85 aa stswi r5,r9,16
/* Convert absolute to relative time */
if (flags == TIMER_ABSTIME) {
ffc07b9c: 40 be 00 38 bne+ cr7,ffc07bd4 <timer_settime+0x9c>
struct timespec now;
_TOD_Get( &now );
ffc07ba0: 3b 81 00 0c addi r28,r1,12
ffc07ba4: 7f 83 e3 78 mr r3,r28
/* Check for seconds in the past */
if ( _Timespec_Greater_than( &now, &normalize.it_value ) )
ffc07ba8: 3b 61 00 1c addi r27,r1,28
normalize = *value;
/* Convert absolute to relative time */
if (flags == TIMER_ABSTIME) {
struct timespec now;
_TOD_Get( &now );
ffc07bac: 48 00 1a 91 bl ffc0963c <_TOD_Get>
/* Check for seconds in the past */
if ( _Timespec_Greater_than( &now, &normalize.it_value ) )
ffc07bb0: 7f 83 e3 78 mr r3,r28
ffc07bb4: 7f 64 db 78 mr r4,r27
ffc07bb8: 48 00 3f a9 bl ffc0bb60 <_Timespec_Greater_than>
ffc07bbc: 2f 83 00 00 cmpwi cr7,r3,0
ffc07bc0: 40 9e 01 00 bne- cr7,ffc07cc0 <timer_settime+0x188> <== NEVER TAKEN
rtems_set_errno_and_return_minus_one( EINVAL );
_Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value );
ffc07bc4: 7f 83 e3 78 mr r3,r28
ffc07bc8: 7f 64 db 78 mr r4,r27
ffc07bcc: 7f 65 db 78 mr r5,r27
ffc07bd0: 48 00 40 0d bl ffc0bbdc <_Timespec_Subtract>
timer_t id,
Objects_Locations *location
)
{
return (POSIX_Timer_Control *)
_Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location );
ffc07bd4: 3c 60 00 00 lis r3,0
ffc07bd8: 7f e4 fb 78 mr r4,r31
ffc07bdc: 38 63 2f 0c addi r3,r3,12044
ffc07be0: 38 a1 00 08 addi r5,r1,8
ffc07be4: 48 00 24 ed bl ffc0a0d0 <_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 ) {
ffc07be8: 80 01 00 08 lwz r0,8(r1)
ffc07bec: 7c 7f 1b 78 mr r31,r3
ffc07bf0: 2f 80 00 00 cmpwi cr7,r0,0
ffc07bf4: 40 9e 00 cc bne- cr7,ffc07cc0 <timer_settime+0x188> <== NEVER TAKEN
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 ) {
ffc07bf8: 80 01 00 1c lwz r0,28(r1)
ffc07bfc: 2f 80 00 00 cmpwi cr7,r0,0
ffc07c00: 40 9e 00 48 bne- cr7,ffc07c48 <timer_settime+0x110>
ffc07c04: 80 01 00 20 lwz r0,32(r1)
ffc07c08: 2f 80 00 00 cmpwi cr7,r0,0
ffc07c0c: 40 be 00 3c bne+ cr7,ffc07c48 <timer_settime+0x110>
/* Stop the timer */
(void) _Watchdog_Remove( &ptimer->Timer );
ffc07c10: 38 63 00 10 addi r3,r3,16
ffc07c14: 48 00 44 fd bl ffc0c110 <_Watchdog_Remove>
/* The old data of the timer are returned */
if ( ovalue )
ffc07c18: 2f 9e 00 00 cmpwi cr7,r30,0
ffc07c1c: 41 9e 00 10 beq- cr7,ffc07c2c <timer_settime+0xf4>
*ovalue = ptimer->timer_data;
ffc07c20: 39 3f 00 54 addi r9,r31,84
ffc07c24: 7c a9 84 aa lswi r5,r9,16
ffc07c28: 7c be 85 aa stswi r5,r30,16
/* The new data are set */
ptimer->timer_data = normalize;
ffc07c2c: 39 3f 00 54 addi r9,r31,84
ffc07c30: 39 61 00 14 addi r11,r1,20
/* Indicates that the timer is created and stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
ffc07c34: 38 00 00 04 li r0,4
(void) _Watchdog_Remove( &ptimer->Timer );
/* The old data of the timer are returned */
if ( ovalue )
*ovalue = ptimer->timer_data;
/* The new data are set */
ptimer->timer_data = normalize;
ffc07c38: 7c ab 84 aa lswi r5,r11,16
ffc07c3c: 7c a9 85 aa stswi r5,r9,16
/* Indicates that the timer is created and stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
ffc07c40: 98 1f 00 3c stb r0,60(r31)
ffc07c44: 48 00 00 70 b ffc07cb4 <timer_settime+0x17c>
_Thread_Enable_dispatch();
return 0;
}
/* Convert from seconds and nanoseconds to ticks */
ptimer->ticks = _Timespec_To_ticks( &value->it_interval );
ffc07c48: 7f a3 eb 78 mr r3,r29
ffc07c4c: 48 00 3f d5 bl ffc0bc20 <_Timespec_To_ticks>
ffc07c50: 90 7f 00 64 stw r3,100(r31)
initial_period = _Timespec_To_ticks( &normalize.it_value );
ffc07c54: 38 61 00 1c addi r3,r1,28
ffc07c58: 48 00 3f c9 bl ffc0bc20 <_Timespec_To_ticks>
activated = _POSIX_Timer_Insert_helper(
ffc07c5c: 80 bf 00 08 lwz r5,8(r31)
ffc07c60: 3c c0 ff c0 lis r6,-64
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 );
ffc07c64: 7c 64 1b 78 mr r4,r3
activated = _POSIX_Timer_Insert_helper(
ffc07c68: 38 c6 7c d8 addi r6,r6,31960
ffc07c6c: 38 7f 00 10 addi r3,r31,16
ffc07c70: 7f e7 fb 78 mr r7,r31
ffc07c74: 48 00 68 b9 bl ffc0e52c <_POSIX_Timer_Insert_helper>
initial_period,
ptimer->Object.id,
_POSIX_Timer_TSR,
ptimer
);
if ( !activated ) {
ffc07c78: 2f 83 00 00 cmpwi cr7,r3,0
ffc07c7c: 41 9e 00 38 beq- cr7,ffc07cb4 <timer_settime+0x17c>
/*
* The timer has been started and is running. So we return the
* old ones in "ovalue"
*/
if ( ovalue )
ffc07c80: 2f 9e 00 00 cmpwi cr7,r30,0
ffc07c84: 41 9e 00 10 beq- cr7,ffc07c94 <timer_settime+0x15c>
*ovalue = ptimer->timer_data;
ffc07c88: 39 3f 00 54 addi r9,r31,84
ffc07c8c: 7c a9 84 aa lswi r5,r9,16
ffc07c90: 7c be 85 aa stswi r5,r30,16
ptimer->timer_data = normalize;
ffc07c94: 39 3f 00 54 addi r9,r31,84
ffc07c98: 39 61 00 14 addi r11,r1,20
/* Indicate that the time is running */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
ffc07c9c: 38 00 00 03 li r0,3
* The timer has been started and is running. So we return the
* old ones in "ovalue"
*/
if ( ovalue )
*ovalue = ptimer->timer_data;
ptimer->timer_data = normalize;
ffc07ca0: 7c ab 84 aa lswi r5,r11,16
ffc07ca4: 7c a9 85 aa stswi r5,r9,16
/* Indicate that the time is running */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
_TOD_Get( &ptimer->time );
ffc07ca8: 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;
ffc07cac: 98 1f 00 3c stb r0,60(r31)
_TOD_Get( &ptimer->time );
ffc07cb0: 48 00 19 8d bl ffc0963c <_TOD_Get>
_Thread_Enable_dispatch();
ffc07cb4: 48 00 31 15 bl ffc0adc8 <_Thread_Enable_dispatch>
return 0;
ffc07cb8: 38 60 00 00 li r3,0
ffc07cbc: 48 00 00 14 b ffc07cd0 <timer_settime+0x198>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
ffc07cc0: 48 00 96 b9 bl ffc11378 <__errno>
ffc07cc4: 38 00 00 16 li r0,22
ffc07cc8: 90 03 00 00 stw r0,0(r3)
ffc07ccc: 38 60 ff ff li r3,-1
}
ffc07cd0: 39 61 00 40 addi r11,r1,64
ffc07cd4: 4b ff 89 40 b ffc00614 <_restgpr_27_x>
ffc07898 <ualarm>:
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
ffc07898: 94 21 ff d8 stwu r1,-40(r1)
ffc0789c: 7c 08 02 a6 mflr r0
ffc078a0: bf a1 00 1c stmw r29,28(r1)
/*
* Initialize the timer used to implement alarm().
*/
if ( !the_timer->routine ) {
ffc078a4: 3f a0 00 00 lis r29,0
ffc078a8: 3b bd 35 14 addi r29,r29,13588
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
ffc078ac: 90 01 00 2c stw r0,44(r1)
ffc078b0: 7c 7e 1b 78 mr r30,r3
/*
* Initialize the timer used to implement alarm().
*/
if ( !the_timer->routine ) {
ffc078b4: 80 1d 00 1c lwz r0,28(r29)
ffc078b8: 2f 80 00 00 cmpwi cr7,r0,0
ffc078bc: 40 be 00 24 bne+ cr7,ffc078e0 <ualarm+0x48>
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
ffc078c0: 3d 20 ff c0 lis r9,-64
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
ffc078c4: 90 1d 00 08 stw r0,8(r29)
the_watchdog->routine = routine;
ffc078c8: 39 29 78 50 addi r9,r9,30800
ffc078cc: 91 3d 00 1c stw r9,28(r29)
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
useconds_t remaining = 0;
ffc078d0: 3b e0 00 00 li r31,0
the_watchdog->id = id;
ffc078d4: 90 1d 00 20 stw r0,32(r29)
the_watchdog->user_data = user_data;
ffc078d8: 90 1d 00 24 stw r0,36(r29)
ffc078dc: 48 00 00 58 b ffc07934 <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 );
ffc078e0: 7f a3 eb 78 mr r3,r29
ffc078e4: 48 00 42 f9 bl ffc0bbdc <_Watchdog_Remove>
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
useconds_t remaining = 0;
ffc078e8: 3b e0 00 00 li r31,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) ) {
ffc078ec: 38 63 ff fe addi r3,r3,-2
ffc078f0: 2b 83 00 01 cmplwi cr7,r3,1
ffc078f4: 41 bd 00 40 bgt+ cr7,ffc07934 <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);
ffc078f8: 80 1d 00 0c lwz r0,12(r29)
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
ffc078fc: 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);
ffc07900: 80 7d 00 14 lwz r3,20(r29)
ffc07904: 7c 63 02 14 add r3,r3,r0
ffc07908: 80 1d 00 18 lwz r0,24(r29)
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
ffc0790c: 7c 60 18 50 subf r3,r0,r3
ffc07910: 48 00 3c b1 bl ffc0b5c0 <_Timespec_From_ticks>
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
ffc07914: 81 21 00 08 lwz r9,8(r1)
ffc07918: 3c 00 00 0f lis r0,15
remaining += tp.tv_nsec / 1000;
ffc0791c: 83 e1 00 0c lwz r31,12(r1)
ticks = the_timer->initial;
ticks -= (the_timer->stop_time - the_timer->start_time);
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
ffc07920: 60 00 42 40 ori r0,r0,16960
ffc07924: 7c 00 49 d6 mullw r0,r0,r9
remaining += tp.tv_nsec / 1000;
ffc07928: 39 20 03 e8 li r9,1000
ffc0792c: 7f ff 4b d6 divw r31,r31,r9
ffc07930: 7f ff 02 14 add r31,r31,r0
/*
* 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 ) {
ffc07934: 2f 9e 00 00 cmpwi cr7,r30,0
ffc07938: 41 be 00 50 beq+ cr7,ffc07988 <ualarm+0xf0>
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
ffc0793c: 3c 00 00 0f lis r0,15
ffc07940: 60 00 42 40 ori r0,r0,16960
ffc07944: 7d 3e 03 96 divwu r9,r30,r0
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ffc07948: 7c 09 01 d6 mullw r0,r9,r0
* 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;
ffc0794c: 91 21 00 08 stw r9,8(r1)
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ffc07950: 7f c0 f0 50 subf r30,r0,r30
ffc07954: 1f de 03 e8 mulli r30,r30,1000
ffc07958: 93 c1 00 0c stw r30,12(r1)
ticks = _Timespec_To_ticks( &tp );
ffc0795c: 3b c1 00 08 addi r30,r1,8
ffc07960: 7f c3 f3 78 mr r3,r30
ffc07964: 48 00 3c d1 bl ffc0b634 <_Timespec_To_ticks>
if ( ticks == 0 )
ticks = 1;
_Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) );
ffc07968: 7f c3 f3 78 mr r3,r30
ffc0796c: 48 00 3c c9 bl ffc0b634 <_Timespec_To_ticks>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
ffc07970: 3c 80 00 00 lis r4,0
ffc07974: 38 84 35 14 addi r4,r4,13588
ffc07978: 90 64 00 0c stw r3,12(r4)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
ffc0797c: 3c 60 00 00 lis r3,0
ffc07980: 38 63 2d 68 addi r3,r3,11624
ffc07984: 48 00 41 05 bl ffc0ba88 <_Watchdog_Insert>
}
return remaining;
}
ffc07988: 39 61 00 28 addi r11,r1,40
ffc0798c: 7f e3 fb 78 mr r3,r31
ffc07990: 4b ff 8b 68 b ffc004f8 <_restgpr_29_x>