00011ac0 <_CORE_message_queue_Broadcast>: { Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) {
11ac0: e590304c ldr r3, [r0, #76]
size_t size,
Objects_Id id,
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support,
uint32_t *count
)
{
11ac4: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr}
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
11ac8: e1520003 cmp r2, r3
size_t size,
Objects_Id id,
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support,
uint32_t *count
)
{
11acc: e1a07000 mov r7, r0 11ad0: e1a06002 mov r6, r2 11ad4: e1a08001 mov r8, r1 11ad8: e59da020 ldr sl, [sp, #32]
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
11adc: 83a00001 movhi r0, #1 ; 0x1
11ae0: 88bd85f0 pophi {r4, r5, r6, r7, r8, sl, pc}
* 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 ) {
11ae4: e5973048 ldr r3, [r7, #72] 11ae8: e3530000 cmp r3, #0 ; 0x0
*count = 0;
11aec: 13a03000 movne r3, #0 ; 0x0
* There must be no pending messages if there is a thread waiting to
* receive a message.
*/
number_broadcasted = 0;
while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
11af0: 01a05003 moveq r5, r3
* 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 ) {
*count = 0;
11af4: 158a3000 strne r3, [sl] 11af8: 11a00003 movne r0, r3
* 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 ) {
11afc: 0a000005 beq 11b18 <_CORE_message_queue_Broadcast+0x58>
11b00: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
11b04: e594002c ldr r0, [r4, #44] 11b08: eb001c55 bl 18c64 <memcpy>
buffer,
waitp->return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
11b0c: e5943028 ldr r3, [r4, #40] 11b10: e5836000 str r6, [r3]
*/
number_broadcasted = 0;
while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
waitp = &the_thread->Wait;
number_broadcasted += 1;
11b14: e2855001 add r5, r5, #1 ; 0x1
* There must be no pending messages if there is a thread waiting to
* receive a message.
*/
number_broadcasted = 0;
while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
11b18: e1a00007 mov r0, r7 11b1c: eb00092d bl 13fd8 <_Thread_queue_Dequeue> 11b20: e2504000 subs r4, r0, #0 ; 0x0 11b24: e1a01008 mov r1, r8 11b28: e1a02006 mov r2, r6
11b2c: 1afffff4 bne 11b04 <_CORE_message_queue_Broadcast+0x44>
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_message_queue_mp_support) ( the_thread, id );
#endif
}
*count = number_broadcasted;
11b30: e58a5000 str r5, [sl] 11b34: e1a00004 mov r0, r4
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; }
11b38: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc}
00017458 <_CORE_message_queue_Insert_message>:
ISR_Level level;
bool notify = false;
the_message->priority = submit_type;
switch ( submit_type ) {
17458: e3520102 cmp r2, #-2147483648 ; 0x80000000
void _CORE_message_queue_Insert_message(
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Buffer_control *the_message,
CORE_message_queue_Submit_types submit_type
)
{
1745c: e92d4030 push {r4, r5, lr}
ISR_Level level;
bool notify = false;
the_message->priority = submit_type;
17460: e5812008 str r2, [r1, #8]
void _CORE_message_queue_Insert_message(
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Buffer_control *the_message,
CORE_message_queue_Submit_types submit_type
)
{
17464: e1a05001 mov r5, r1 17468: e1a04000 mov r4, r0
ISR_Level level;
bool notify = false;
the_message->priority = submit_type;
switch ( submit_type ) {
1746c: 0a000012 beq 174bc <_CORE_message_queue_Insert_message+0x64>
17470: e3720106 cmn r2, #-2147483647 ; 0x80000001 17474: e280c054 add ip, r0, #84 ; 0x54
CORE_message_queue_Buffer_control *this_message;
Chain_Node *the_node;
Chain_Control *the_header;
the_header = &the_message_queue->Pending_messages;
the_node = the_header->first;
17478: 15901050 ldrne r1, [r0, #80]
ISR_Level level;
bool notify = false;
the_message->priority = submit_type;
switch ( submit_type ) {
1747c: 1a000022 bne 1750c <_CORE_message_queue_Insert_message+0xb4>
case CORE_MESSAGE_QUEUE_SEND_REQUEST:
_ISR_Disable( level );
17480: e10f0000 mrs r0, CPSR 17484: e38030c0 orr r3, r0, #192 ; 0xc0 17488: e129f003 msr CPSR_fc, r3
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
1748c: e585c000 str ip, [r5]
if ( the_message_queue->number_of_pending_messages++ == 0 )
17490: e5942048 ldr r2, [r4, #72]
old_last_node = the_chain->last;
17494: e5941058 ldr r1, [r4, #88] 17498: e2823001 add r3, r2, #1 ; 0x1
the_chain->last = the_node;
1749c: e5845058 str r5, [r4, #88] 174a0: e5843048 str r3, [r4, #72] 174a4: e2722001 rsbs r2, r2, #1 ; 0x1 174a8: 33a02000 movcc r2, #0 ; 0x0
old_last_node->next = the_node; the_node->previous = old_last_node;
174ac: e5851004 str r1, [r5, #4]
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
174b0: e5815000 str r5, [r1]
notify = true;
_CORE_message_queue_Append_unprotected(the_message_queue, the_message);
_ISR_Enable( level );
174b4: e129f000 msr CPSR_fc, r0 174b8: ea000024 b 17550 <_CORE_message_queue_Insert_message+0xf8>
break;
case CORE_MESSAGE_QUEUE_URGENT_REQUEST:
_ISR_Disable( level );
174bc: e10fc000 mrs ip, CPSR 174c0: e38c30c0 orr r3, ip, #192 ; 0xc0 174c4: e129f003 msr CPSR_fc, r3
if ( the_message_queue->number_of_pending_messages++ == 0 )
174c8: e5901048 ldr r1, [r0, #72]
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
174cc: e5900050 ldr r0, [r0, #80] 174d0: e2812001 add r2, r1, #1 ; 0x1
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head(
Chain_Control *the_chain
)
{
return (Chain_Node *) the_chain;
174d4: e2843050 add r3, r4, #80 ; 0x50
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
174d8: e5853004 str r3, [r5, #4] 174dc: e5842048 str r2, [r4, #72]
before_node = after_node->next; after_node->next = the_node;
174e0: e5845050 str r5, [r4, #80]
the_node->next = before_node; before_node->previous = the_node;
174e4: e5805004 str r5, [r0, #4] 174e8: e2712001 rsbs r2, r1, #1 ; 0x1 174ec: 33a02000 movcc r2, #0 ; 0x0
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
174f0: e5850000 str r0, [r5]
notify = true;
_CORE_message_queue_Prepend_unprotected(the_message_queue, the_message);
_ISR_Enable( level );
174f4: e129f00c msr CPSR_fc, ip 174f8: ea000014 b 17550 <_CORE_message_queue_Insert_message+0xf8>
the_node = the_header->first;
while ( !_Chain_Is_tail( the_header, the_node ) ) {
this_message = (CORE_message_queue_Buffer_control *) the_node;
if ( this_message->priority <= the_message->priority ) {
174fc: e5913008 ldr r3, [r1, #8] <== NOT EXECUTED 17500: e1530002 cmp r3, r2 <== NOT EXECUTED 17504: ca000002 bgt 17514 <_CORE_message_queue_Insert_message+0xbc><== NOT EXECUTED
the_node = the_node->next;
17508: e5911000 ldr r1, [r1] <== NOT EXECUTED
Chain_Node *the_node;
Chain_Control *the_header;
the_header = &the_message_queue->Pending_messages;
the_node = the_header->first;
while ( !_Chain_Is_tail( the_header, the_node ) ) {
1750c: e151000c cmp r1, ip <== NOT EXECUTED 17510: 1afffff9 bne 174fc <_CORE_message_queue_Insert_message+0xa4><== NOT EXECUTED
continue;
}
break;
}
_ISR_Disable( level );
17514: e10fc000 mrs ip, CPSR <== NOT EXECUTED 17518: e38c30c0 orr r3, ip, #192 ; 0xc0 <== NOT EXECUTED 1751c: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED
if ( the_message_queue->number_of_pending_messages++ == 0 )
notify = true;
_Chain_Insert_unprotected( the_node->previous, &the_message->Node );
17520: e5913004 ldr r3, [r1, #4] <== NOT EXECUTED
}
break;
}
_ISR_Disable( level );
if ( the_message_queue->number_of_pending_messages++ == 0 )
17524: e5941048 ldr r1, [r4, #72] <== NOT EXECUTED
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
17528: e5930000 ldr r0, [r3] <== NOT EXECUTED 1752c: e2812001 add r2, r1, #1 ; 0x1 <== NOT EXECUTED
after_node->next = the_node;
17530: e5835000 str r5, [r3] <== NOT EXECUTED 17534: e5842048 str r2, [r4, #72] <== NOT EXECUTED
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
17538: e5853004 str r3, [r5, #4] <== NOT EXECUTED 1753c: e2712001 rsbs r2, r1, #1 ; 0x1 <== NOT EXECUTED 17540: 33a02000 movcc r2, #0 ; 0x0 <== NOT EXECUTED
before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; before_node->previous = the_node;
17544: e5805004 str r5, [r0, #4] <== NOT EXECUTED
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
17548: e5850000 str r0, [r5] <== NOT EXECUTED
notify = true;
_Chain_Insert_unprotected( the_node->previous, &the_message->Node );
_ISR_Enable( level );
1754c: e129f00c msr CPSR_fc, ip <== NOT EXECUTED
* According to POSIX, does this happen before or after the message
* is actually enqueued. It is logical to think afterwards, because
* the message is actually in the queue at this point.
*/
if ( notify && the_message_queue->notify_handler )
17550: e3520000 cmp r2, #0 ; 0x0
17554: 08bd8030 popeq {r4, r5, pc}
17558: e5943060 ldr r3, [r4, #96]
1755c: e3530000 cmp r3, #0 ; 0x0
17560: 08bd8030 popeq {r4, r5, pc}
(*the_message_queue->notify_handler)( the_message_queue->notify_argument );
17564: e5940064 ldr r0, [r4, #100] <== NOT EXECUTED
17568: e1a0e00f mov lr, pc <== NOT EXECUTED
1756c: e12fff13 bx r3 <== NOT EXECUTED
17570: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED
00011c9c <_CORE_message_queue_Seize>:
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
11c9c: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr}
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
Thread_Control *the_thread;
executing = _Thread_Executing;
11ca0: e59fc128 ldr ip, [pc, #296] ; 11dd0 <_CORE_message_queue_Seize+0x134> 11ca4: e59cc000 ldr ip, [ip]
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
11ca8: e1a05000 mov r5, r0 11cac: e1a00003 mov r0, r3
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
Thread_Control *the_thread;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
11cb0: e3a03000 mov r3, #0 ; 0x0
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
11cb4: e59da020 ldr sl, [sp, #32] 11cb8: e1a07001 mov r7, r1 11cbc: e1a08002 mov r8, r2
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
Thread_Control *the_thread;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
11cc0: e58c3034 str r3, [ip, #52]
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
11cc4: e5dd601c ldrb r6, [sp, #28]
Thread_Control *executing;
Thread_Control *the_thread;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
11cc8: e10f1000 mrs r1, CPSR 11ccc: e38130c0 orr r3, r1, #192 ; 0xc0 11cd0: e129f003 msr CPSR_fc, r3
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
11cd4: e5954050 ldr r4, [r5, #80]
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
Chain_Control *the_chain
)
{
if ( !_Chain_Is_empty(the_chain))
11cd8: e2853054 add r3, r5, #84 ; 0x54 11cdc: e1540003 cmp r4, r3
11ce0: 0a000028 beq 11d88 <_CORE_message_queue_Seize+0xec>
{
Chain_Node *return_node;
Chain_Node *new_first;
return_node = the_chain->first;
new_first = return_node->next;
11ce4: e5942000 ldr r2, [r4]
the_chain->first = new_first;
11ce8: e1a03005 mov r3, r5 11cec: e5a32050 str r2, [r3, #80]!
the_message = _CORE_message_queue_Get_pending_message( the_message_queue );
if ( the_message != NULL ) {
11cf0: e3540000 cmp r4, #0 ; 0x0
new_first->previous = _Chain_Head(the_chain);
11cf4: e5823004 str r3, [r2, #4]
11cf8: 0a000022 beq 11d88 <_CORE_message_queue_Seize+0xec>
the_message_queue->number_of_pending_messages -= 1;
11cfc: e5953048 ldr r3, [r5, #72] 11d00: e2433001 sub r3, r3, #1 ; 0x1 11d04: e5853048 str r3, [r5, #72]
_ISR_Enable( level );
11d08: e129f001 msr CPSR_fc, r1
*size_p = the_message->Contents.size;
_Thread_Executing->Wait.count = the_message->priority;
11d0c: e59f30bc ldr r3, [pc, #188] ; 11dd0 <_CORE_message_queue_Seize+0x134> 11d10: e5942008 ldr r2, [r4, #8] 11d14: e5931000 ldr r1, [r3]
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;
11d18: e594300c ldr r3, [r4, #12] 11d1c: e5803000 str r3, [r0]
_Thread_Executing->Wait.count = the_message->priority;
11d20: e5812024 str r2, [r1, #36]
_CORE_message_queue_Copy_buffer(the_message->Contents.buffer,buffer,*size_p);
11d24: e2846010 add r6, r4, #16 ; 0x10
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
11d28: e5902000 ldr r2, [r0] 11d2c: e1a01006 mov r1, r6 11d30: e1a00008 mov r0, r8 11d34: eb001bca bl 18c64 <memcpy>
*
* 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 );
11d38: e1a00005 mov r0, r5 11d3c: eb0008a5 bl 13fd8 <_Thread_queue_Dequeue>
if ( !the_thread ) {
11d40: e2501000 subs r1, r0, #0 ; 0x0
11d44: 1a000003 bne 11d58 <_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 );
11d48: e2850068 add r0, r5, #104 ; 0x68 11d4c: e1a01004 mov r1, r4
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 );
}
11d50: e8bd45f0 pop {r4, r5, r6, r7, r8, sl, lr}
11d54: eaffff31 b 11a20 <_Chain_Append>
* There was a thread waiting to send a message. This code
* puts the messages in the message queue on behalf of the
* waiting task.
*/
the_message->priority = the_thread->Wait.count;
11d58: e5913024 ldr r3, [r1, #36] <== NOT EXECUTED
the_message->Contents.size = (size_t) the_thread->Wait.option;
11d5c: e5912030 ldr r2, [r1, #48] <== NOT EXECUTED
* There was a thread waiting to send a message. This code
* puts the messages in the message queue on behalf of the
* waiting task.
*/
the_message->priority = the_thread->Wait.count;
11d60: e5843008 str r3, [r4, #8] <== NOT EXECUTED
the_message->Contents.size = (size_t) the_thread->Wait.option;
11d64: e584200c str r2, [r4, #12] <== NOT EXECUTED
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
11d68: e1a00006 mov r0, r6 <== NOT EXECUTED 11d6c: e591102c ldr r1, [r1, #44] <== NOT EXECUTED 11d70: eb001bbb bl 18c64 <memcpy> <== NOT EXECUTED
the_thread->Wait.return_argument_second.immutable_object,
the_message->Contents.buffer,
the_message->Contents.size
);
_CORE_message_queue_Insert_message(
11d74: e5942008 ldr r2, [r4, #8] <== NOT EXECUTED 11d78: e1a00005 mov r0, r5 <== NOT EXECUTED 11d7c: e1a01004 mov r1, r4 <== NOT EXECUTED
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 );
}
11d80: e8bd45f0 pop {r4, r5, r6, r7, r8, sl, lr} <== NOT EXECUTED
the_thread->Wait.return_argument_second.immutable_object,
the_message->Contents.buffer,
the_message->Contents.size
);
_CORE_message_queue_Insert_message(
11d84: ea0015b3 b 17458 <_CORE_message_queue_Insert_message> <== NOT EXECUTED
the_message->priority
);
return;
}
if ( !wait ) {
11d88: e3560000 cmp r6, #0 ; 0x0
11d8c: 1a000003 bne 11da0 <_CORE_message_queue_Seize+0x104>
_ISR_Enable( level );
11d90: e129f001 msr CPSR_fc, r1
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
11d94: e3a03004 mov r3, #4 ; 0x4 11d98: e58c3034 str r3, [ip, #52]
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 );
}
11d9c: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc}
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;
11da0: e3a03001 mov r3, #1 ; 0x1 11da4: e5853030 str r3, [r5, #48]
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
executing->Wait.return_argument_second.mutable_object = buffer;
executing->Wait.return_argument = size_p;
11da8: e58c0028 str r0, [ip, #40]
return;
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
11dac: e58c7020 str r7, [ip, #32]
executing->Wait.return_argument_second.mutable_object = buffer;
11db0: e58c802c str r8, [ip, #44]
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
return;
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
11db4: e58c5044 str r5, [ip, #68]
executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level );
11db8: e129f001 msr CPSR_fc, r1
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
11dbc: e59f2010 ldr r2, [pc, #16] ; 11dd4 <_CORE_message_queue_Seize+0x138> 11dc0: e1a00005 mov r0, r5 11dc4: e1a0100a mov r1, sl
}
11dc8: e8bd45f0 pop {r4, r5, r6, r7, r8, sl, lr}
executing->Wait.return_argument_second.mutable_object = buffer;
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 );
11dcc: ea0008da b 1413c <_Thread_queue_Enqueue_with_handler>
00011dd8 <_CORE_message_queue_Submit>:
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support,
CORE_message_queue_Submit_types submit_type,
bool wait,
Watchdog_Interval timeout
)
{
11dd8: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr}
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *the_thread;
if ( size > the_message_queue->maximum_message_size ) {
11ddc: e590c04c ldr ip, [r0, #76] 11de0: e152000c cmp r2, ip
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support,
CORE_message_queue_Submit_types submit_type,
bool wait,
Watchdog_Interval timeout
)
{
11de4: e1a05000 mov r5, r0 11de8: e1a06002 mov r6, r2 11dec: e1a07001 mov r7, r1 11df0: e1a0b003 mov fp, r3 11df4: e59d9028 ldr r9, [sp, #40] 11df8: e5dda02c ldrb sl, [sp, #44]
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *the_thread;
if ( size > the_message_queue->maximum_message_size ) {
11dfc: 83a00001 movhi r0, #1 ; 0x1
11e00: 88bd8ff0 pophi {r4, r5, r6, r7, r8, r9, sl, fp, pc}
/*
* Is there a thread currently waiting on this message queue?
*/
if ( the_message_queue->number_of_pending_messages == 0 ) {
11e04: e5958048 ldr r8, [r5, #72] 11e08: e3580000 cmp r8, #0 ; 0x0
11e0c: 1a00000b bne 11e40 <_CORE_message_queue_Submit+0x68>
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
11e10: eb000870 bl 13fd8 <_Thread_queue_Dequeue>
if ( the_thread ) {
11e14: e2504000 subs r4, r0, #0 ; 0x0
11e18: 0a000008 beq 11e40 <_CORE_message_queue_Submit+0x68>
11e1c: e1a01007 mov r1, r7 11e20: e594002c ldr r0, [r4, #44] 11e24: e1a02006 mov r2, r6 11e28: eb001b8d bl 18c64 <memcpy>
_CORE_message_queue_Copy_buffer(
buffer,
the_thread->Wait.return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
11e2c: e5943028 ldr r3, [r4, #40]
the_thread->Wait.count = submit_type;
11e30: e1a00008 mov r0, r8
_CORE_message_queue_Copy_buffer(
buffer,
the_thread->Wait.return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
11e34: e5836000 str r6, [r3]
the_thread->Wait.count = submit_type;
11e38: e5849024 str r9, [r4, #36]
11e3c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc}
/*
* No one waiting on the message queue at this time, so attempt to
* queue the message up for a future receive.
*/
if ( the_message_queue->number_of_pending_messages <
11e40: e5952048 ldr r2, [r5, #72] 11e44: e5953044 ldr r3, [r5, #68] 11e48: e1520003 cmp r2, r3
11e4c: 2a00000f bcs 11e90 <_CORE_message_queue_Submit+0xb8>
RTEMS_INLINE_ROUTINE CORE_message_queue_Buffer_control *
_CORE_message_queue_Allocate_message_buffer (
CORE_message_queue_Control *the_message_queue
)
{
return (CORE_message_queue_Buffer_control *)
11e50: e2850068 add r0, r5, #104 ; 0x68 11e54: ebfffefc bl 11a4c <_Chain_Get>
/*
* NOTE: If the system is consistent, this error should never occur.
*/
if ( !the_message ) {
11e58: e2504000 subs r4, r0, #0 ; 0x0
11e5c: 0a000025 beq 11ef8 <_CORE_message_queue_Submit+0x120>
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
11e60: e1a01007 mov r1, r7 11e64: e1a02006 mov r2, r6 11e68: e2840010 add r0, r4, #16 ; 0x10 11e6c: eb001b7c bl 18c64 <memcpy>
size
);
the_message->Contents.size = size;
the_message->priority = submit_type;
_CORE_message_queue_Insert_message(
11e70: e1a00005 mov r0, r5
_CORE_message_queue_Copy_buffer(
buffer,
the_message->Contents.buffer,
size
);
the_message->Contents.size = size;
11e74: e584600c str r6, [r4, #12]
the_message->priority = submit_type;
11e78: e5849008 str r9, [r4, #8]
_CORE_message_queue_Insert_message(
11e7c: e1a01004 mov r1, r4
11e80: e1a02009 mov r2, r9
11e84: eb001573 bl 17458 <_CORE_message_queue_Insert_message>
11e88: e3a00000 mov r0, #0 ; 0x0
11e8c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc}
* No message buffers were available so we may need to return an
* overflow error or block the sender until the message is placed
* on the queue.
*/
if ( !wait ) {
11e90: e35a0000 cmp sl, #0 ; 0x0
11e94: 03a00002 moveq r0, #2 ; 0x2
11e98: 08bd8ff0 popeq {r4, r5, r6, r7, r8, r9, sl, fp, pc}
/*
* Do NOT block on a send if the caller is in an ISR. It is
* deadly to block in an ISR.
*/
if ( _ISR_Is_in_progress() ) {
11e9c: e59f305c ldr r3, [pc, #92] ; 11f00 <_CORE_message_queue_Submit+0x128><== NOT EXECUTED 11ea0: e5933000 ldr r3, [r3] <== NOT EXECUTED 11ea4: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED 11ea8: 1a000012 bne 11ef8 <_CORE_message_queue_Submit+0x120> <== NOT EXECUTED
* it as a variable. Doing this emphasizes how dangerous it
* would be to use this variable prior to here.
*/
{
Thread_Control *executing = _Thread_Executing;
11eac: e59f3050 ldr r3, [pc, #80] ; 11f04 <_CORE_message_queue_Submit+0x12c><== NOT EXECUTED 11eb0: e5932000 ldr r2, [r3] <== NOT EXECUTED
_ISR_Disable( level );
11eb4: e10f1000 mrs r1, CPSR <== NOT EXECUTED 11eb8: e38130c0 orr r3, r1, #192 ; 0xc0 <== NOT EXECUTED 11ebc: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED 11ec0: e3a03001 mov r3, #1 ; 0x1 <== NOT EXECUTED 11ec4: e5853030 str r3, [r5, #48] <== NOT EXECUTED
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
executing->Wait.return_argument_second.immutable_object = buffer;
executing->Wait.option = (uint32_t) size;
executing->Wait.count = submit_type;
11ec8: e5829024 str r9, [r2, #36] <== NOT EXECUTED
Thread_Control *executing = _Thread_Executing;
_ISR_Disable( level );
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
11ecc: e582b020 str fp, [r2, #32] <== NOT EXECUTED
executing->Wait.return_argument_second.immutable_object = buffer;
11ed0: e582702c str r7, [r2, #44] <== NOT EXECUTED
executing->Wait.option = (uint32_t) size;
11ed4: e5826030 str r6, [r2, #48] <== NOT EXECUTED
{
Thread_Control *executing = _Thread_Executing;
_ISR_Disable( level );
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
11ed8: e5825044 str r5, [r2, #68] <== NOT EXECUTED
executing->Wait.id = id;
executing->Wait.return_argument_second.immutable_object = buffer;
executing->Wait.option = (uint32_t) size;
executing->Wait.count = submit_type;
_ISR_Enable( level );
11edc: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
11ee0: e59f2020 ldr r2, [pc, #32] ; 11f08 <_CORE_message_queue_Submit+0x130><== NOT EXECUTED
11ee4: e1a00005 mov r0, r5 <== NOT EXECUTED
11ee8: e59d1030 ldr r1, [sp, #48] <== NOT EXECUTED
11eec: eb000892 bl 1413c <_Thread_queue_Enqueue_with_handler> <== NOT EXECUTED
11ef0: e3a00007 mov r0, #7 ; 0x7 <== NOT EXECUTED
11ef4: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED
}
return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT;
11ef8: e3a00003 mov r0, #3 ; 0x3 <== NOT EXECUTED
}
11efc: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED
00004d74 <_CORE_mutex_Initialize>:
CORE_mutex_Status _CORE_mutex_Initialize(
CORE_mutex_Control *the_mutex,
CORE_mutex_Attributes *the_mutex_attributes,
uint32_t initial_lock
)
{
4d74: e92d40f0 push {r4, r5, r6, r7, lr}
4d78: e1a05000 mov r5, r0
4d7c: e1a04002 mov r4, r2
4d80: e1a07001 mov r7, r1
/* Add this to the RTEMS environment later ?????????
rtems_assert( initial_lock == CORE_MUTEX_LOCKED ||
initial_lock == CORE_MUTEX_UNLOCKED );
*/
the_mutex->Attributes = *the_mutex_attributes;
4d84: e891000f ldm r1, {r0, r1, r2, r3}
the_mutex->lock = initial_lock; the_mutex->blocked_count = 0;
4d88: e3a06000 mov r6, #0 ; 0x0
if ( initial_lock == CORE_MUTEX_LOCKED ) {
4d8c: e3540000 cmp r4, #0 ; 0x0
/* Add this to the RTEMS environment later ?????????
rtems_assert( initial_lock == CORE_MUTEX_LOCKED ||
initial_lock == CORE_MUTEX_UNLOCKED );
*/
the_mutex->Attributes = *the_mutex_attributes;
4d90: e285c040 add ip, r5, #64 ; 0x40
4d94: e88c000f stm ip, {r0, r1, r2, r3}
the_mutex->lock = initial_lock;
4d98: e5854050 str r4, [r5, #80]
the_mutex->blocked_count = 0;
4d9c: e5856058 str r6, [r5, #88]
_Thread_Executing->resource_count++;
}
} else {
the_mutex->nest_count = 0;
the_mutex->holder = NULL;
the_mutex->holder_id = 0;
4da0: 15856060 strne r6, [r5, #96]
#endif
_Thread_Executing->resource_count++;
}
} else {
the_mutex->nest_count = 0;
4da4: 15856054 strne r6, [r5, #84]
the_mutex->holder = NULL;
4da8: 1585605c strne r6, [r5, #92]
the_mutex->Attributes = *the_mutex_attributes;
the_mutex->lock = initial_lock;
the_mutex->blocked_count = 0;
if ( initial_lock == CORE_MUTEX_LOCKED ) {
4dac: 1a000013 bne 4e00 <_CORE_mutex_Initialize+0x8c>
the_mutex->nest_count = 1;
4db0: e3a03001 mov r3, #1 ; 0x1
4db4: e5853054 str r3, [r5, #84]
the_mutex->holder = _Thread_Executing;
4db8: e59f3064 ldr r3, [pc, #100] ; 4e24 <_CORE_mutex_Initialize+0xb0>
4dbc: e5931000 ldr r1, [r3]
*/
RTEMS_INLINE_ROUTINE bool _CORE_mutex_Is_inherit_priority(
CORE_mutex_Attributes *the_attribute
)
{
return the_attribute->discipline == CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
4dc0: e5952048 ldr r2, [r5, #72]
the_mutex->holder_id = _Thread_Executing->Object.id;
4dc4: e5913008 ldr r3, [r1, #8]
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
4dc8: e3520002 cmp r2, #2 ; 0x2
the_mutex->blocked_count = 0;
if ( initial_lock == CORE_MUTEX_LOCKED ) {
the_mutex->nest_count = 1;
the_mutex->holder = _Thread_Executing;
the_mutex->holder_id = _Thread_Executing->Object.id;
4dcc: e5853060 str r3, [r5, #96]
the_mutex->lock = initial_lock;
the_mutex->blocked_count = 0;
if ( initial_lock == CORE_MUTEX_LOCKED ) {
the_mutex->nest_count = 1;
the_mutex->holder = _Thread_Executing;
4dd0: e585105c str r1, [r5, #92]
the_mutex->holder_id = _Thread_Executing->Object.id;
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
4dd4: 0a000001 beq 4de0 <_CORE_mutex_Initialize+0x6c>
4dd8: e3520003 cmp r2, #3 ; 0x3
4ddc: 1a000007 bne 4e00 <_CORE_mutex_Initialize+0x8c>
_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
if ( _Thread_Executing->current_priority <
4de0: e595304c ldr r3, [r5, #76] <== NOT EXECUTED
4de4: e5912014 ldr r2, [r1, #20] <== NOT EXECUTED
4de8: e1520003 cmp r2, r3 <== NOT EXECUTED
_Chain_Prepend_unprotected( &_Thread_Executing->lock_mutex,
&the_mutex->queue.lock_queue );
the_mutex->queue.priority_before = _Thread_Executing->current_priority;
#endif
_Thread_Executing->resource_count++;
4dec: 2591301c ldrcs r3, [r1, #28] <== NOT EXECUTED
4df0: 22833001 addcs r3, r3, #1 ; 0x1 <== NOT EXECUTED
the_mutex->holder = _Thread_Executing;
the_mutex->holder_id = _Thread_Executing->Object.id;
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
if ( _Thread_Executing->current_priority <
4df4: 33a00006 movcc r0, #6 ; 0x6 <== NOT EXECUTED
_Chain_Prepend_unprotected( &_Thread_Executing->lock_mutex,
&the_mutex->queue.lock_queue );
the_mutex->queue.priority_before = _Thread_Executing->current_priority;
#endif
_Thread_Executing->resource_count++;
4df8: 2581301c strcs r3, [r1, #28] <== NOT EXECUTED
the_mutex->holder = _Thread_Executing;
the_mutex->holder_id = _Thread_Executing->Object.id;
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
if ( _Thread_Executing->current_priority <
4dfc: 38bd80f0 popcc {r4, r5, r6, r7, pc} <== NOT EXECUTED
the_mutex->nest_count = 0;
the_mutex->holder = NULL;
the_mutex->holder_id = 0;
}
_Thread_queue_Initialize(
4e00: e5971008 ldr r1, [r7, #8]
4e04: e1a00005 mov r0, r5
4e08: e2511000 subs r1, r1, #0 ; 0x0
4e0c: 13a01001 movne r1, #1 ; 0x1
4e10: e3a02b01 mov r2, #1024 ; 0x400
4e14: e3a03005 mov r3, #5 ; 0x5
4e18: eb0006f0 bl 69e0 <_Thread_queue_Initialize>
4e1c: e3a00000 mov r0, #0 ; 0x0
STATES_WAITING_FOR_MUTEX,
CORE_MUTEX_TIMEOUT
);
return CORE_MUTEX_STATUS_SUCCESSFUL;
}
4e20: e8bd80f0 pop {r4, r5, r6, r7, pc}
00009548 <_CORE_mutex_Seize_interrupt_trylock>:
Thread_Control *executing;
ISR_Level level = *level_p;
/* disabled when you get here */
executing = _Thread_Executing;
9548: e59f3130 ldr r3, [pc, #304] ; 9680 <_CORE_mutex_Seize_interrupt_trylock+0x138>
954c: e593c000 ldr ip, [r3]
executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
9550: e3a02000 mov r2, #0 ; 0x0
CORE_mutex_Control *the_mutex,
ISR_Level *level_p
)
{
Thread_Control *executing;
ISR_Level level = *level_p;
9554: e5911000 ldr r1, [r1]
/* disabled when you get here */
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
9558: e58c2034 str r2, [ip, #52]
if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
955c: e5903050 ldr r3, [r0, #80]
9560: e1530002 cmp r3, r2
#if defined(__RTEMS_DO_NOT_INLINE_CORE_MUTEX_SEIZE__)
int _CORE_mutex_Seize_interrupt_trylock(
CORE_mutex_Control *the_mutex,
ISR_Level *level_p
)
{
9564: e52de004 push {lr} ; (str lr, [sp, #-4]!)
9568: 0a00002f beq 962c <_CORE_mutex_Seize_interrupt_trylock+0xe4>
the_mutex->lock = CORE_MUTEX_LOCKED;
956c: e5802050 str r2, [r0, #80]
*/
RTEMS_INLINE_ROUTINE bool _CORE_mutex_Is_inherit_priority(
CORE_mutex_Attributes *the_attribute
)
{
return the_attribute->discipline == CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
9570: e5902048 ldr r2, [r0, #72]
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
the_mutex->lock = CORE_MUTEX_LOCKED;
the_mutex->holder = executing;
the_mutex->holder_id = executing->Object.id;
9574: e59c3008 ldr r3, [ip, #8]
the_mutex->nest_count = 1;
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
9578: e3520002 cmp r2, #2 ; 0x2
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
the_mutex->lock = CORE_MUTEX_LOCKED;
the_mutex->holder = executing;
the_mutex->holder_id = executing->Object.id;
957c: e5803060 str r3, [r0, #96]
the_mutex->nest_count = 1;
9580: e3a03001 mov r3, #1 ; 0x1
9584: e5803054 str r3, [r0, #84]
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
the_mutex->lock = CORE_MUTEX_LOCKED;
the_mutex->holder = executing;
9588: e580c05c str ip, [r0, #92]
the_mutex->holder_id = executing->Object.id;
the_mutex->nest_count = 1;
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
958c: 0a000001 beq 9598 <_CORE_mutex_Seize_interrupt_trylock+0x50>
9590: e3520003 cmp r2, #3 ; 0x3 <== NOT EXECUTED
9594: 1a000002 bne 95a4 <_CORE_mutex_Seize_interrupt_trylock+0x5c><== NOT EXECUTED
_Chain_Prepend_unprotected( &executing->lock_mutex,
&the_mutex->queue.lock_queue );
the_mutex->queue.priority_before = executing->current_priority;
#endif
executing->resource_count++;
9598: e59c301c ldr r3, [ip, #28]
959c: e2833001 add r3, r3, #1 ; 0x1
95a0: e58c301c str r3, [ip, #28]
}
if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
95a4: e5903048 ldr r3, [r0, #72]
95a8: e3530003 cmp r3, #3 ; 0x3
95ac: 0a000001 beq 95b8 <_CORE_mutex_Seize_interrupt_trylock+0x70>
_ISR_Enable( level );
95b0: e129f001 msr CPSR_fc, r1
95b4: ea00002d b 9670 <_CORE_mutex_Seize_interrupt_trylock+0x128>
*/
{
Priority_Control ceiling;
Priority_Control current;
ceiling = the_mutex->Attributes.priority_ceiling;
95b8: e590204c ldr r2, [r0, #76] <== NOT EXECUTED
current = executing->current_priority;
95bc: e59c3014 ldr r3, [ip, #20] <== NOT EXECUTED
if ( current == ceiling ) {
95c0: e1530002 cmp r3, r2 <== NOT EXECUTED
95c4: 1a000001 bne 95d0 <_CORE_mutex_Seize_interrupt_trylock+0x88><== NOT EXECUTED
_ISR_Enable( level );
95c8: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED
95cc: ea000027 b 9670 <_CORE_mutex_Seize_interrupt_trylock+0x128><== NOT EXECUTED
return 0;
}
if ( current > ceiling ) {
95d0: 9a00000a bls 9600 <_CORE_mutex_Seize_interrupt_trylock+0xb8><== NOT EXECUTED
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
95d4: e59f20a8 ldr r2, [pc, #168] ; 9684 <_CORE_mutex_Seize_interrupt_trylock+0x13c><== NOT EXECUTED
95d8: e5923000 ldr r3, [r2] <== NOT EXECUTED
95dc: e2833001 add r3, r3, #1 ; 0x1 <== NOT EXECUTED
95e0: e5823000 str r3, [r2] <== NOT EXECUTED
_Thread_Disable_dispatch();
_ISR_Enable( level );
95e4: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED
_Thread_Change_priority(
95e8: e3a02000 mov r2, #0 ; 0x0 <== NOT EXECUTED
95ec: e590104c ldr r1, [r0, #76] <== NOT EXECUTED
95f0: e590005c ldr r0, [r0, #92] <== NOT EXECUTED
95f4: ebfff19b bl 5c68 <_Thread_Change_priority> <== NOT EXECUTED
the_mutex->holder,
the_mutex->Attributes.priority_ceiling,
FALSE
);
_Thread_Enable_dispatch();
95f8: ebfff302 bl 6208 <_Thread_Enable_dispatch> <== NOT EXECUTED
95fc: ea00001b b 9670 <_CORE_mutex_Seize_interrupt_trylock+0x128><== NOT EXECUTED
return 0;
}
/* if ( current < ceiling ) */ {
executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED;
9600: e3a03006 mov r3, #6 ; 0x6 <== NOT EXECUTED
9604: e58c3034 str r3, [ip, #52] <== NOT EXECUTED
the_mutex->lock = CORE_MUTEX_UNLOCKED;
the_mutex->nest_count = 0; /* undo locking above */
9608: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
960c: e5803054 str r3, [r0, #84] <== NOT EXECUTED
_Thread_Enable_dispatch();
return 0;
}
/* if ( current < ceiling ) */ {
executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED;
the_mutex->lock = CORE_MUTEX_UNLOCKED;
9610: e2833001 add r3, r3, #1 ; 0x1 <== NOT EXECUTED
9614: e5803050 str r3, [r0, #80] <== NOT EXECUTED
the_mutex->nest_count = 0; /* undo locking above */
executing->resource_count--; /* undo locking above */
9618: e59c301c ldr r3, [ip, #28] <== NOT EXECUTED
961c: e2433001 sub r3, r3, #1 ; 0x1 <== NOT EXECUTED
9620: e58c301c str r3, [ip, #28] <== NOT EXECUTED
_ISR_Enable( level );
9624: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED
9628: ea000010 b 9670 <_CORE_mutex_Seize_interrupt_trylock+0x128><== NOT EXECUTED
/*
* At this point, we know the mutex was not available. If this thread
* is the thread that has locked the mutex, let's see if we are allowed
* to nest access.
*/
if ( _Thread_Is_executing( the_mutex->holder ) ) {
962c: e590205c ldr r2, [r0, #92]
9630: e152000c cmp r2, ip
9634: 1a00000f bne 9678 <_CORE_mutex_Seize_interrupt_trylock+0x130>
switch ( the_mutex->Attributes.lock_nesting_behavior ) {
9638: e5903040 ldr r3, [r0, #64]
963c: e3530000 cmp r3, #0 ; 0x0
9640: 0a000002 beq 9650 <_CORE_mutex_Seize_interrupt_trylock+0x108>
9644: e3530001 cmp r3, #1 ; 0x1
9648: 1a00000a bne 9678 <_CORE_mutex_Seize_interrupt_trylock+0x130>
964c: ea000004 b 9664 <_CORE_mutex_Seize_interrupt_trylock+0x11c>
case CORE_MUTEX_NESTING_ACQUIRES:
the_mutex->nest_count++;
9650: e5903054 ldr r3, [r0, #84]
9654: e2833001 add r3, r3, #1 ; 0x1
9658: e5803054 str r3, [r0, #84]
_ISR_Enable( level );
965c: e129f001 msr CPSR_fc, r1
9660: ea000002 b 9670 <_CORE_mutex_Seize_interrupt_trylock+0x128>
return 0;
case CORE_MUTEX_NESTING_IS_ERROR:
executing->Wait.return_code = CORE_MUTEX_STATUS_NESTING_NOT_ALLOWED;
9664: e3a03002 mov r3, #2 ; 0x2
9668: e5823034 str r3, [r2, #52]
_ISR_Enable( level );
966c: e129f001 msr CPSR_fc, r1
9670: e3a00000 mov r0, #0 ; 0x0
9674: e49df004 pop {pc} ; (ldr pc, [sp], #4)
9678: e3a00001 mov r0, #1 ; 0x1
return _CORE_mutex_Seize_interrupt_trylock_body( the_mutex, level_p ); }
967c: e49df004 pop {pc} ; (ldr pc, [sp], #4)
00004f54 <_CORE_mutex_Surrender>:
* allowed when the mutex in quetion is FIFO or simple Priority
* discipline. But Priority Ceiling or Priority Inheritance mutexes
* must be released by the thread which acquired them.
*/
if ( the_mutex->Attributes.only_owner_release ) {
4f54: e5d03044 ldrb r3, [r0, #68]
4f58: e3530000 cmp r3, #0 ; 0x0
CORE_mutex_Status _CORE_mutex_Surrender(
CORE_mutex_Control *the_mutex,
Objects_Id id,
CORE_mutex_API_mp_support_callout api_mutex_mp_support
)
{
4f5c: e92d4010 push {r4, lr}
4f60: e1a04000 mov r4, r0
Thread_Control *the_thread; Thread_Control *holder; #ifdef __RTEMS_STRICT_ORDER_MUTEX__ Chain_Node *first_node; #endif holder = the_mutex->holder;
4f64: e590005c ldr r0, [r0, #92]
* allowed when the mutex in quetion is FIFO or simple Priority
* discipline. But Priority Ceiling or Priority Inheritance mutexes
* must be released by the thread which acquired them.
*/
if ( the_mutex->Attributes.only_owner_release ) {
4f68: 0a000004 beq 4f80 <_CORE_mutex_Surrender+0x2c>
if ( !_Thread_Is_executing( holder ) )
4f6c: e59f312c ldr r3, [pc, #300] ; 50a0 <_CORE_mutex_Surrender+0x14c>
4f70: e5933000 ldr r3, [r3]
4f74: e1500003 cmp r0, r3
4f78: 13a00003 movne r0, #3 ; 0x3
4f7c: 18bd8010 popne {r4, pc}
return CORE_MUTEX_STATUS_NOT_OWNER_OF_RESOURCE;
}
/* XXX already unlocked -- not right status */
if ( !the_mutex->nest_count )
4f80: e5943054 ldr r3, [r4, #84]
4f84: e3530000 cmp r3, #0 ; 0x0
4f88: 0a000042 beq 5098 <_CORE_mutex_Surrender+0x144>
return CORE_MUTEX_STATUS_SUCCESSFUL;
the_mutex->nest_count--;
4f8c: e2433001 sub r3, r3, #1 ; 0x1
if ( the_mutex->nest_count != 0 ) {
4f90: e3530000 cmp r3, #0 ; 0x0
/* XXX already unlocked -- not right status */
if ( !the_mutex->nest_count )
return CORE_MUTEX_STATUS_SUCCESSFUL;
the_mutex->nest_count--;
4f94: e5843054 str r3, [r4, #84]
if ( the_mutex->nest_count != 0 ) {
4f98: 0a000005 beq 4fb4 <_CORE_mutex_Surrender+0x60>
switch ( the_mutex->Attributes.lock_nesting_behavior ) {
4f9c: e5943040 ldr r3, [r4, #64]
4fa0: e3530000 cmp r3, #0 ; 0x0
4fa4: 0a00003b beq 5098 <_CORE_mutex_Surrender+0x144>
4fa8: e3530001 cmp r3, #1 ; 0x1 <== NOT EXECUTED
4fac: 03a00002 moveq r0, #2 ; 0x2 <== NOT EXECUTED
4fb0: 08bd8010 popeq {r4, pc} <== NOT EXECUTED
4fb4: e5943048 ldr r3, [r4, #72]
/*
* Formally release the mutex before possibly transferring it to a
* blocked thread.
*/
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
4fb8: e3530002 cmp r3, #2 ; 0x2
4fbc: 0a000001 beq 4fc8 <_CORE_mutex_Surrender+0x74>
4fc0: e3530003 cmp r3, #3 ; 0x3
4fc4: 1a000002 bne 4fd4 <_CORE_mutex_Surrender+0x80>
the_mutex->nest_count++;
return CORE_MUTEX_RELEASE_NOT_ORDER;
}
first_node = _Chain_Get_first_unprotected(&holder->lock_mutex);
#endif
holder->resource_count--;
4fc8: e590301c ldr r3, [r0, #28]
4fcc: e2433001 sub r3, r3, #1 ; 0x1
4fd0: e580301c str r3, [r0, #28]
4fd4: e5942048 ldr r2, [r4, #72]
} the_mutex->holder = NULL;
4fd8: e3a03000 mov r3, #0 ; 0x0
/* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
4fdc: e3520002 cmp r2, #2 ; 0x2
first_node = _Chain_Get_first_unprotected(&holder->lock_mutex);
#endif
holder->resource_count--;
}
the_mutex->holder = NULL;
the_mutex->holder_id = 0;
4fe0: e5843060 str r3, [r4, #96]
}
first_node = _Chain_Get_first_unprotected(&holder->lock_mutex);
#endif
holder->resource_count--;
}
the_mutex->holder = NULL;
4fe4: e584305c str r3, [r4, #92]
/*
* Whether or not someone is waiting for the mutex, an
* inherited priority must be lowered if this is the last
* mutex (i.e. resource) this task has.
*/
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
4fe8: 0a000001 beq 4ff4 <_CORE_mutex_Surrender+0xa0>
4fec: e3520003 cmp r2, #3 ; 0x3
4ff0: 1a000007 bne 5014 <_CORE_mutex_Surrender+0xc0>
_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
if(the_mutex->queue.priority_before != holder->current_priority)
_Thread_Change_priority(holder,the_mutex->queue.priority_before,TRUE);
#endif
if ( holder->resource_count == 0 &&
4ff4: e590301c ldr r3, [r0, #28]
4ff8: e3530000 cmp r3, #0 ; 0x0
4ffc: 1a000004 bne 5014 <_CORE_mutex_Surrender+0xc0>
5000: e5901018 ldr r1, [r0, #24]
5004: e5903014 ldr r3, [r0, #20]
5008: e1510003 cmp r1, r3
holder->real_priority != holder->current_priority ) {
_Thread_Change_priority( holder, holder->real_priority, TRUE );
500c: 13a02001 movne r2, #1 ; 0x1
5010: 1b000314 blne 5c68 <_Thread_Change_priority>
/*
* Now we check if another thread was waiting for this mutex. If so,
* transfer the mutex to that thread.
*/
if ( ( the_thread = _Thread_queue_Dequeue( &the_mutex->Wait_queue ) ) ) {
5014: e1a00004 mov r0, r4
5018: eb00055c bl 6590 <_Thread_queue_Dequeue>
501c: e2502000 subs r2, r0, #0 ; 0x0
}
break;
}
}
} else
the_mutex->lock = CORE_MUTEX_UNLOCKED;
5020: 03a03001 moveq r3, #1 ; 0x1
5024: 05843050 streq r3, [r4, #80]
5028: 01a00002 moveq r0, r2
/*
* Now we check if another thread was waiting for this mutex. If so,
* transfer the mutex to that thread.
*/
if ( ( the_thread = _Thread_queue_Dequeue( &the_mutex->Wait_queue ) ) ) {
502c: 08bd8010 popeq {r4, pc}
} else
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
5030: e5923008 ldr r3, [r2, #8]
the_mutex->nest_count = 1;
switch ( the_mutex->Attributes.discipline ) {
5034: e5941048 ldr r1, [r4, #72]
} else
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
5038: e5843060 str r3, [r4, #96]
the_mutex->nest_count = 1;
switch ( the_mutex->Attributes.discipline ) {
503c: e3510002 cmp r1, #2 ; 0x2
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
the_mutex->nest_count = 1;
5040: e3a03001 mov r3, #1 ; 0x1
5044: e5843054 str r3, [r4, #84]
} else
#endif
{
the_mutex->holder = the_thread;
5048: e584205c str r2, [r4, #92]
the_mutex->holder_id = the_thread->Object.id;
the_mutex->nest_count = 1;
switch ( the_mutex->Attributes.discipline ) {
504c: 0a000002 beq 505c <_CORE_mutex_Surrender+0x108>
5050: e3510003 cmp r1, #3 ; 0x3
5054: 1a00000f bne 5098 <_CORE_mutex_Surrender+0x144>
5058: ea000003 b 506c <_CORE_mutex_Surrender+0x118> <== NOT EXECUTED
case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT:
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
_Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue);
the_mutex->queue.priority_before = the_thread->current_priority;
#endif
the_thread->resource_count++;
505c: e592301c ldr r3, [r2, #28]
5060: e2833001 add r3, r3, #1 ; 0x1
5064: e582301c str r3, [r2, #28]
5068: ea000008 b 5090 <_CORE_mutex_Surrender+0x13c>
case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING:
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
_Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue);
the_mutex->queue.priority_before = the_thread->current_priority;
#endif
the_thread->resource_count++;
506c: e592301c ldr r3, [r2, #28] <== NOT EXECUTED
5070: e2833001 add r3, r3, #1 ; 0x1 <== NOT EXECUTED
5074: e582301c str r3, [r2, #28] <== NOT EXECUTED
if (the_mutex->Attributes.priority_ceiling <
5078: e5923014 ldr r3, [r2, #20] <== NOT EXECUTED
507c: e594104c ldr r1, [r4, #76] <== NOT EXECUTED
5080: e1510003 cmp r1, r3 <== NOT EXECUTED
5084: 2a000003 bcs 5098 <_CORE_mutex_Surrender+0x144> <== NOT EXECUTED
the_thread->current_priority){
_Thread_Change_priority(
5088: e3a02000 mov r2, #0 ; 0x0 <== NOT EXECUTED
508c: eb0002f5 bl 5c68 <_Thread_Change_priority> <== NOT EXECUTED
5090: e3a00000 mov r0, #0 ; 0x0
5094: e8bd8010 pop {r4, pc}
}
break;
}
}
} else
the_mutex->lock = CORE_MUTEX_UNLOCKED;
5098: e3a00000 mov r0, #0 ; 0x0
return CORE_MUTEX_STATUS_SUCCESSFUL;
}
509c: e8bd8010 pop {r4, pc}
00009444 <_Debug_Is_enabled>:
*/
bool _Debug_Is_enabled(
rtems_debug_control level
)
{
9444: e59f3010 ldr r3, [pc, #16] ; 945c <_Debug_Is_enabled+0x18> <== NOT EXECUTED
9448: e5933000 ldr r3, [r3] <== NOT EXECUTED
944c: e1100003 tst r0, r3 <== NOT EXECUTED
return (_Debug_Level & level) ? true : false; }
9450: 03a00000 moveq r0, #0 ; 0x0 <== NOT EXECUTED
9454: 13a00001 movne r0, #1 ; 0x1 <== NOT EXECUTED
9458: e12fff1e bx lr <== NOT EXECUTED
00008f88 <_Dual_ported_memory_Manager_initialization>:
*/
void _Dual_ported_memory_Manager_initialization(
uint32_t maximum_ports
)
{
8f88: e52de004 push {lr} ; (str lr, [sp, #-4]!)
_Objects_Initialize_information(
8f8c: e3a0c01c mov ip, #28 ; 0x1c
*/
void _Dual_ported_memory_Manager_initialization(
uint32_t maximum_ports
)
{
8f90: e24dd00c sub sp, sp, #12 ; 0xc
_Objects_Initialize_information(
8f94: e58dc000 str ip, [sp]
8f98: e3a0c000 mov ip, #0 ; 0x0
*/
void _Dual_ported_memory_Manager_initialization(
uint32_t maximum_ports
)
{
8f9c: e1a03000 mov r3, r0
_Objects_Initialize_information(
8fa0: e58dc004 str ip, [sp, #4]
8fa4: e59f0018 ldr r0, [pc, #24] ; 8fc4 <_Dual_ported_memory_Manager_initialization+0x3c>
8fa8: e28cc004 add ip, ip, #4 ; 0x4
8fac: e3a01002 mov r1, #2 ; 0x2
8fb0: e3a02007 mov r2, #7 ; 0x7
8fb4: e58dc008 str ip, [sp, #8]
8fb8: ebfff287 bl 59dc <_Objects_Initialize_information>
,
FALSE, /* TRUE if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
8fbc: e28dd00c add sp, sp, #12 ; 0xc
8fc0: e8bd8000 pop {pc}
00003d7c <_Event_Seize>:
rtems_event_set pending_events;
ISR_Level level;
RTEMS_API_Control *api;
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
3d7c: e59fc104 ldr ip, [pc, #260] ; 3e88 <_Event_Seize+0x10c>
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
3d80: e92d40f0 push {r4, r5, r6, r7, lr}
rtems_event_set pending_events;
ISR_Level level;
RTEMS_API_Control *api;
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
3d84: e59c4000 ldr r4, [ip]
executing->Wait.return_code = RTEMS_SUCCESSFUL;
3d88: e3a0c000 mov ip, #0 ; 0x0
3d8c: e584c034 str ip, [r4, #52]
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
3d90: e1a07002 mov r7, r2
3d94: e1a05003 mov r5, r3
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
executing->Wait.return_code = RTEMS_SUCCESSFUL;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
3d98: e5946104 ldr r6, [r4, #260]
_ISR_Disable( level );
3d9c: e10fc000 mrs ip, CPSR
3da0: e38c30c0 orr r3, ip, #192 ; 0xc0
3da4: e129f003 msr CPSR_fc, r3
pending_events = api->pending_events;
3da8: e5963000 ldr r3, [r6]
seized_events = _Event_sets_Get( pending_events, event_in );
if ( !_Event_sets_Is_empty( seized_events ) &&
3dac: e0102003 ands r2, r0, r3
3db0: 0a000007 beq 3dd4 <_Event_Seize+0x58>
3db4: e1520000 cmp r2, r0
3db8: 0a000001 beq 3dc4 <_Event_Seize+0x48>
3dbc: e3110002 tst r1, #2 ; 0x2
3dc0: 0a000003 beq 3dd4 <_Event_Seize+0x58>
(seized_events == event_in || _Options_Is_any( option_set )) ) {
api->pending_events =
3dc4: e1c33002 bic r3, r3, r2
3dc8: e5863000 str r3, [r6]
_Event_sets_Clear( pending_events, seized_events );
_ISR_Enable( level );
3dcc: e129f00c msr CPSR_fc, ip
3dd0: ea000004 b 3de8 <_Event_Seize+0x6c>
*event_out = seized_events;
return;
}
if ( _Options_Is_no_wait( option_set ) ) {
3dd4: e3110001 tst r1, #1 ; 0x1
3dd8: 0a000004 beq 3df0 <_Event_Seize+0x74>
_ISR_Enable( level );
3ddc: e129f00c msr CPSR_fc, ip
executing->Wait.return_code = RTEMS_UNSATISFIED;
3de0: e3a0300d mov r3, #13 ; 0xd
3de4: e5843034 str r3, [r4, #52]
*event_out = seized_events;
3de8: e5852000 str r2, [r5]
3dec: e8bd80f0 pop {r4, r5, r6, r7, pc}
return;
}
_Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
3df0: e59f3094 ldr r3, [pc, #148] ; 3e8c <_Event_Seize+0x110>
3df4: e3a02001 mov r2, #1 ; 0x1
3df8: e5832000 str r2, [r3]
executing->Wait.option = (uint32_t) option_set;
3dfc: e5841030 str r1, [r4, #48]
executing->Wait.count = (uint32_t) event_in;
3e00: e5840024 str r0, [r4, #36]
executing->Wait.return_argument = event_out;
3e04: e5845028 str r5, [r4, #40]
_ISR_Enable( level );
3e08: e129f00c msr CPSR_fc, ip
if ( ticks ) {
3e0c: e3570000 cmp r7, #0 ; 0x0
3e10: 0a00000a beq 3e40 <_Event_Seize+0xc4>
_Watchdog_Initialize(
3e14: e5943008 ldr r3, [r4, #8]
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
3e18: e59f2070 ldr r2, [pc, #112] ; 3e90 <_Event_Seize+0x114>
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
3e1c: e3a01000 mov r1, #0 ; 0x0
the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data;
3e20: e584106c str r1, [r4, #108]
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
3e24: e5841050 str r1, [r4, #80]
the_watchdog->routine = routine;
3e28: e5842064 str r2, [r4, #100]
the_watchdog->id = id;
3e2c: e5843068 str r3, [r4, #104]
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
3e30: e5847054 str r7, [r4, #84]
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
3e34: e59f0058 ldr r0, [pc, #88] ; 3e94 <_Event_Seize+0x118>
3e38: e2841048 add r1, r4, #72 ; 0x48
3e3c: eb000d2c bl 72f4 <_Watchdog_Insert>
NULL
);
_Watchdog_Insert_ticks( &executing->Timer, ticks );
}
_Thread_Set_state( executing, STATES_WAITING_FOR_EVENT );
3e40: e1a00004 mov r0, r4
3e44: e3a01c01 mov r1, #256 ; 0x100
3e48: eb000b4b bl 6b7c <_Thread_Set_state>
_ISR_Disable( level );
3e4c: e10fc000 mrs ip, CPSR
3e50: e38c30c0 orr r3, ip, #192 ; 0xc0
3e54: e129f003 msr CPSR_fc, r3
sync_state = _Event_Sync_state;
3e58: e59f202c ldr r2, [pc, #44] ; 3e8c <_Event_Seize+0x110>
3e5c: e5920000 ldr r0, [r2]
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
3e60: e3a03000 mov r3, #0 ; 0x0
if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) {
3e64: e3500001 cmp r0, #1 ; 0x1
_Thread_Set_state( executing, STATES_WAITING_FOR_EVENT );
_ISR_Disable( level );
sync_state = _Event_Sync_state;
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
3e68: e5823000 str r3, [r2]
if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) {
3e6c: 1a000001 bne 3e78 <_Event_Seize+0xfc>
_ISR_Enable( level );
3e70: e129f00c msr CPSR_fc, ip
3e74: e8bd80f0 pop {r4, r5, r6, r7, pc}
* An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level );
3e78: e1a01004 mov r1, r4 <== NOT EXECUTED
3e7c: e1a0200c mov r2, ip <== NOT EXECUTED
}
3e80: e8bd40f0 pop {r4, r5, r6, r7, lr} <== NOT EXECUTED
* An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level );
3e84: ea000764 b 5c1c <_Thread_blocking_operation_Cancel> <== NOT EXECUTED
00003ef0 <_Event_Surrender>:
*/
void _Event_Surrender(
Thread_Control *the_thread
)
{
3ef0: e92d40f0 push {r4, r5, r6, r7, lr}
3ef4: e1a04000 mov r4, r0
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 ];
3ef8: e5906104 ldr r6, [r0, #260]
option_set = (rtems_option) the_thread->Wait.option;
3efc: e5907030 ldr r7, [r0, #48]
_ISR_Disable( level );
3f00: e10f5000 mrs r5, CPSR
3f04: e38530c0 orr r3, r5, #192 ; 0xc0
3f08: e129f003 msr CPSR_fc, r3
pending_events = api->pending_events;
3f0c: e596c000 ldr ip, [r6]
event_condition = (rtems_event_set) the_thread->Wait.count;
3f10: e5902024 ldr r2, [r0, #36]
seized_events = _Event_sets_Get( pending_events, event_condition );
/*
* No events were seized in this operation
*/
if ( _Event_sets_Is_empty( seized_events ) ) {
3f14: e012000c ands r0, r2, ip
3f18: 1a000001 bne 3f24 <_Event_Surrender+0x34>
_ISR_Enable( level );
3f1c: e129f005 msr CPSR_fc, r5
3f20: e8bd80f0 pop {r4, r5, r6, r7, pc}
/*
* 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() &&
3f24: e59f30f0 ldr r3, [pc, #240] ; 401c <_Event_Surrender+0x12c>
3f28: e5933000 ldr r3, [r3]
3f2c: e3530000 cmp r3, #0 ; 0x0
3f30: 0a000019 beq 3f9c <_Event_Surrender+0xac>
3f34: e59f30e4 ldr r3, [pc, #228] ; 4020 <_Event_Surrender+0x130>
3f38: e5933000 ldr r3, [r3]
3f3c: e1540003 cmp r4, r3
3f40: 1a000015 bne 3f9c <_Event_Surrender+0xac>
3f44: e59f10d8 ldr r1, [pc, #216] ; 4024 <_Event_Surrender+0x134><== NOT EXECUTED
3f48: e5913000 ldr r3, [r1] <== NOT EXECUTED
3f4c: e3530001 cmp r3, #1 ; 0x1 <== NOT EXECUTED
3f50: 0a000002 beq 3f60 <_Event_Surrender+0x70> <== NOT EXECUTED
3f54: e5913000 ldr r3, [r1] <== NOT EXECUTED
3f58: e3530002 cmp r3, #2 ; 0x2 <== NOT EXECUTED
3f5c: 1a00000e bne 3f9c <_Event_Surrender+0xac> <== NOT EXECUTED
_Thread_Is_executing( the_thread ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ||
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
3f60: e1500002 cmp r0, r2 <== NOT EXECUTED
3f64: 0a000001 beq 3f70 <_Event_Surrender+0x80> <== NOT EXECUTED
3f68: e3170002 tst r7, #2 ; 0x2 <== NOT EXECUTED
3f6c: 0a000008 beq 3f94 <_Event_Surrender+0xa4> <== NOT EXECUTED
api->pending_events = _Event_sets_Clear( pending_events,seized_events );
3f70: e1cc3000 bic r3, ip, r0 <== NOT EXECUTED
3f74: e5863000 str r3, [r6] <== NOT EXECUTED
the_thread->Wait.count = 0;
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
3f78: e59f30a4 ldr r3, [pc, #164] ; 4024 <_Event_Surrender+0x134><== NOT EXECUTED
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ||
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
api->pending_events = _Event_sets_Clear( pending_events,seized_events );
the_thread->Wait.count = 0;
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
3f7c: e5941028 ldr r1, [r4, #40] <== NOT EXECUTED
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
3f80: e3a02003 mov r2, #3 ; 0x3 <== NOT EXECUTED
3f84: e5832000 str r2, [r3] <== NOT EXECUTED
_Thread_Is_executing( the_thread ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ||
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT)) ) {
if ( seized_events == event_condition || _Options_Is_any(option_set) ) {
api->pending_events = _Event_sets_Clear( pending_events,seized_events );
the_thread->Wait.count = 0;
3f88: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
3f8c: e5843024 str r3, [r4, #36] <== NOT EXECUTED
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
3f90: e5810000 str r0, [r1] <== NOT EXECUTED
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
}
_ISR_Enable( level );
3f94: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED
3f98: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED
}
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Is_waiting_for_event( the_thread->current_state ) ) {
3f9c: e5943010 ldr r3, [r4, #16]
3fa0: e3130c01 tst r3, #256 ; 0x100
3fa4: 0a00001a beq 4014 <_Event_Surrender+0x124>
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
3fa8: e1500002 cmp r0, r2
3fac: 0a000001 beq 3fb8 <_Event_Surrender+0xc8>
3fb0: e3170002 tst r7, #2 ; 0x2
3fb4: 0a000016 beq 4014 <_Event_Surrender+0x124>
api->pending_events = _Event_sets_Clear( pending_events, seized_events );
3fb8: e1cc3000 bic r3, ip, r0
the_thread->Wait.count = 0;
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
3fbc: e5942028 ldr r2, [r4, #40]
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Is_waiting_for_event( the_thread->current_state ) ) {
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
api->pending_events = _Event_sets_Clear( pending_events, seized_events );
3fc0: e5863000 str r3, [r6]
the_thread->Wait.count = 0;
3fc4: e3a03000 mov r3, #0 ; 0x0
3fc8: e5843024 str r3, [r4, #36]
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
3fcc: e5820000 str r0, [r2]
_ISR_Flash( level );
3fd0: e10f3000 mrs r3, CPSR
3fd4: e129f005 msr CPSR_fc, r5
3fd8: e129f003 msr CPSR_fc, r3
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
3fdc: e5943050 ldr r3, [r4, #80]
3fe0: e3530002 cmp r3, #2 ; 0x2
3fe4: 0a000001 beq 3ff0 <_Event_Surrender+0x100>
_ISR_Enable( level );
3fe8: e129f005 msr CPSR_fc, r5
3fec: ea000004 b 4004 <_Event_Surrender+0x114>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
3ff0: e3a03003 mov r3, #3 ; 0x3
3ff4: e5843050 str r3, [r4, #80]
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
3ff8: e129f005 msr CPSR_fc, r5
(void) _Watchdog_Remove( &the_thread->Timer );
3ffc: e2840048 add r0, r4, #72 ; 0x48
4000: eb000d17 bl 7464 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
4004: e59f101c ldr r1, [pc, #28] ; 4028 <_Event_Surrender+0x138>
4008: e1a00004 mov r0, r4
}
return;
}
}
_ISR_Enable( level );
}
400c: e8bd40f0 pop {r4, r5, r6, r7, lr}
4010: ea00077c b 5e08 <_Thread_Clear_state>
_Thread_Unblock( the_thread );
}
return;
}
}
_ISR_Enable( level );
4014: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED
4018: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED
0000402c <_Event_Timeout>:
void _Event_Timeout(
Objects_Id id,
void *ignored
)
{
402c: e52de004 push {lr} ; (str lr, [sp, #-4]!)
4030: e24dd004 sub sp, sp, #4 ; 0x4
Thread_Control *the_thread;
Objects_Locations location;
ISR_Level level;
the_thread = _Thread_Get( id, &location );
4034: e1a0100d mov r1, sp
4038: eb00087b bl 622c <_Thread_Get>
switch ( location ) {
403c: e59d2000 ldr r2, [sp]
4040: e3520000 cmp r2, #0 ; 0x0
4044: 1a00001e bne 40c4 <_Event_Timeout+0x98>
* this is the "timeout" transition. After a request is satisfied,
* a timeout is not allowed to occur.
*/
_ISR_Disable( level );
4048: e10f1000 mrs r1, CPSR
404c: e38130c0 orr r3, r1, #192 ; 0xc0
4050: e129f003 msr CPSR_fc, r3
if ( !the_thread->Wait.count ) { /* verify thread is waiting */
4054: e5903024 ldr r3, [r0, #36]
4058: e3530000 cmp r3, #0 ; 0x0
405c: 1a000005 bne 4078 <_Event_Timeout+0x4c>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
4060: e59f2064 ldr r2, [pc, #100] ; 40cc <_Event_Timeout+0xa0> <== NOT EXECUTED
4064: e5923000 ldr r3, [r2] <== NOT EXECUTED
4068: e2433001 sub r3, r3, #1 ; 0x1 <== NOT EXECUTED
406c: e5823000 str r3, [r2] <== NOT EXECUTED
_Thread_Unnest_dispatch();
_ISR_Enable( level );
4070: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED
4074: ea000012 b 40c4 <_Event_Timeout+0x98> <== NOT EXECUTED
return;
}
the_thread->Wait.count = 0;
if ( _Thread_Is_executing( the_thread ) ) {
4078: e59f3050 ldr r3, [pc, #80] ; 40d0 <_Event_Timeout+0xa4>
407c: e5933000 ldr r3, [r3]
4080: e1500003 cmp r0, r3
_Thread_Unnest_dispatch();
_ISR_Enable( level );
return;
}
the_thread->Wait.count = 0;
4084: e5802024 str r2, [r0, #36]
if ( _Thread_Is_executing( the_thread ) ) {
4088: 1a000004 bne 40a0 <_Event_Timeout+0x74>
Thread_blocking_operation_States sync = _Event_Sync_state;
408c: e59f2040 ldr r2, [pc, #64] ; 40d4 <_Event_Timeout+0xa8> <== NOT EXECUTED
4090: e5923000 ldr r3, [r2] <== NOT EXECUTED
if ( (sync == THREAD_BLOCKING_OPERATION_SYNCHRONIZED) ||
4094: e3530001 cmp r3, #1 ; 0x1 <== NOT EXECUTED
(sync == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) {
_Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
4098: 93a03002 movls r3, #2 ; 0x2 <== NOT EXECUTED
409c: 95823000 strls r3, [r2] <== NOT EXECUTED
}
}
the_thread->Wait.return_code = RTEMS_TIMEOUT;
40a0: e3a03006 mov r3, #6 ; 0x6
40a4: e5803034 str r3, [r0, #52]
_ISR_Enable( level );
40a8: e129f001 msr CPSR_fc, r1
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
40ac: e59f1024 ldr r1, [pc, #36] ; 40d8 <_Event_Timeout+0xac>
40b0: eb000754 bl 5e08 <_Thread_Clear_state>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
40b4: e59f2010 ldr r2, [pc, #16] ; 40cc <_Event_Timeout+0xa0>
40b8: e5923000 ldr r3, [r2]
40bc: e2433001 sub r3, r3, #1 ; 0x1
40c0: e5823000 str r3, [r2]
case OBJECTS_REMOTE: /* impossible */
#endif
case OBJECTS_ERROR:
break;
}
}
40c4: e28dd004 add sp, sp, #4 ; 0x4
40c8: e8bd8000 pop {pc}
000096f4 <_Heap_Allocate>:
void *_Heap_Allocate(
Heap_Control *the_heap,
size_t size
)
{
96f4: e92d4070 push {r4, r5, r6, lr}
96f8: e1a04000 mov r4, r0
Heap_Block *the_block;
void *ptr = NULL;
Heap_Statistics *const stats = &the_heap->stats;
Heap_Block *const tail = _Heap_Tail(the_heap);
the_size =
96fc: e5942014 ldr r2, [r4, #20]
9700: e1a00001 mov r0, r1
9704: e5941010 ldr r1, [r4, #16]
9708: ebffef1b bl 537c <_Heap_Calc_block_size>
_Heap_Calc_block_size(size, the_heap->page_size, the_heap->min_block_size);
if(the_size == 0)
970c: e3500000 cmp r0, #0 ; 0x0
*/
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_First (
Heap_Control *the_heap
)
{
return _Heap_Head(the_heap)->next;
9710: 15945008 ldrne r5, [r4, #8]
9714: 13a06000 movne r6, #0 ; 0x0
9718: 1a000012 bne 9768 <_Heap_Allocate+0x74>
971c: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED
/* As we always coalesce free blocks, prev block must have been used. */
_HAssert(_Heap_Is_prev_used(the_block));
/* Don't bother to mask out the HEAP_PREV_USED bit as it won't change the
result of the comparison. */
if(the_block->size >= the_size) {
9720: e5953004 ldr r3, [r5, #4]
9724: e1530000 cmp r3, r0
9728: 3a00000c bcc 9760 <_Heap_Allocate+0x6c>
(void)_Heap_Block_allocate(the_heap, the_block, the_size );
972c: e1a02000 mov r2, r0
9730: e1a01005 mov r1, r5
9734: e1a00004 mov r0, r4
9738: ebffef1f bl 53bc <_Heap_Block_allocate>
ptr = _Heap_User_area(the_block);
stats->allocs += 1;
stats->searches += search_count + 1;
973c: e2842048 add r2, r4, #72 ; 0x48
9740: e892000c ldm r2, {r2, r3}
9744: e2833001 add r3, r3, #1 ; 0x1
if(the_block->size >= the_size) {
(void)_Heap_Block_allocate(the_heap, the_block, the_size );
ptr = _Heap_User_area(the_block);
stats->allocs += 1;
9748: e2822001 add r2, r2, #1 ; 0x1
stats->searches += search_count + 1;
974c: e0833006 add r3, r3, r6
if(the_block->size >= the_size) {
(void)_Heap_Block_allocate(the_heap, the_block, the_size );
ptr = _Heap_User_area(the_block);
stats->allocs += 1;
9750: e5842048 str r2, [r4, #72]
stats->searches += search_count + 1;
9754: e584304c str r3, [r4, #76]
9758: e2850008 add r0, r5, #8 ; 0x8
975c: ea000004 b 9774 <_Heap_Allocate+0x80>
return NULL;
/* Find large enough free block. */
for(the_block = _Heap_First(the_heap), search_count = 0;
the_block != tail;
the_block = the_block->next, ++search_count)
9760: e5955008 ldr r5, [r5, #8]
9764: e2866001 add r6, r6, #1 ; 0x1
if(the_size == 0)
return NULL;
/* Find large enough free block. */
for(the_block = _Heap_First(the_heap), search_count = 0;
the_block != tail;
9768: e1550004 cmp r5, r4
976c: 1affffeb bne 9720 <_Heap_Allocate+0x2c>
9770: e3a00000 mov r0, #0 ; 0x0
_HAssert(_Heap_Is_aligned_ptr(ptr, the_heap->page_size));
break;
}
}
if(stats->max_search < search_count)
9774: e5943044 ldr r3, [r4, #68]
9778: e1530006 cmp r3, r6
stats->max_search = search_count;
977c: 35846044 strcc r6, [r4, #68]
return ptr;
}
9780: e8bd8070 pop {r4, r5, r6, pc}
0000cbfc <_Heap_Get_information>:
Heap_Block *const end = the_heap->final;
_HAssert(the_block->prev_size == HEAP_PREV_USED);
_HAssert(_Heap_Is_prev_used(the_block));
the_info->Free.number = 0;
cbfc: e3a03000 mov r3, #0 ; 0x0
Heap_Get_information_status _Heap_Get_information(
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
cc00: e92d4030 push {r4, r5, lr}
cc04: e1a0c001 mov ip, r1
the_info->Free.number = 0; the_info->Free.total = 0; the_info->Free.largest = 0; the_info->Used.number = 0; the_info->Used.total = 0; the_info->Used.largest = 0;
cc08: e5813010 str r3, [r1, #16]
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
Heap_Block *the_block = the_heap->start;
Heap_Block *const end = the_heap->final;
cc0c: e5905024 ldr r5, [r0, #36]
_HAssert(the_block->prev_size == HEAP_PREV_USED);
_HAssert(_Heap_Is_prev_used(the_block));
the_info->Free.number = 0;
cc10: e5813000 str r3, [r1]
the_info->Free.total = 0;
cc14: e5813008 str r3, [r1, #8]
the_info->Free.largest = 0;
cc18: e5813004 str r3, [r1, #4]
the_info->Used.number = 0;
cc1c: e581300c str r3, [r1, #12]
the_info->Used.total = 0;
cc20: e5813014 str r3, [r1, #20]
Heap_Get_information_status _Heap_Get_information(
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
Heap_Block *the_block = the_heap->start;
cc24: e5902020 ldr r2, [r0, #32]
cc28: ea00001e b cca8 <_Heap_Get_information+0xac>
cc2c: e5923004 ldr r3, [r2, #4]
cc30: e3c30001 bic r0, r3, #1 ; 0x1
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
cc34: e0824000 add r4, r2, r0
while ( the_block != end ) {
uint32_t const the_size = _Heap_Block_size(the_block);
Heap_Block *const next_block = _Heap_Block_at(the_block, the_size);
if ( _Heap_Is_prev_used(next_block) ) {
cc38: e5943004 ldr r3, [r4, #4]
cc3c: e3130001 tst r3, #1 ; 0x1
cc40: 0a000009 beq cc6c <_Heap_Get_information+0x70>
the_info->Used.number++;
cc44: e59c300c ldr r3, [ip, #12]
the_info->Used.total += the_size;
cc48: e59c1014 ldr r1, [ip, #20]
if ( the_info->Used.largest < the_size )
cc4c: e59c2010 ldr r2, [ip, #16]
while ( the_block != end ) {
uint32_t const the_size = _Heap_Block_size(the_block);
Heap_Block *const next_block = _Heap_Block_at(the_block, the_size);
if ( _Heap_Is_prev_used(next_block) ) {
the_info->Used.number++;
cc50: e2833001 add r3, r3, #1 ; 0x1
the_info->Used.total += the_size;
if ( the_info->Used.largest < the_size )
cc54: e1520000 cmp r2, r0
uint32_t const the_size = _Heap_Block_size(the_block);
Heap_Block *const next_block = _Heap_Block_at(the_block, the_size);
if ( _Heap_Is_prev_used(next_block) ) {
the_info->Used.number++;
the_info->Used.total += the_size;
cc58: e0811000 add r1, r1, r0
while ( the_block != end ) {
uint32_t const the_size = _Heap_Block_size(the_block);
Heap_Block *const next_block = _Heap_Block_at(the_block, the_size);
if ( _Heap_Is_prev_used(next_block) ) {
the_info->Used.number++;
cc5c: e58c300c str r3, [ip, #12]
the_info->Used.total += the_size;
cc60: e58c1014 str r1, [ip, #20]
if ( the_info->Used.largest < the_size )
the_info->Used.largest = the_size;
cc64: 358c0010 strcc r0, [ip, #16]
cc68: ea00000d b cca4 <_Heap_Get_information+0xa8>
} else {
the_info->Free.number++;
cc6c: e59c3000 ldr r3, [ip]
the_info->Free.total += the_size;
cc70: e59c1008 ldr r1, [ip, #8]
if ( the_info->Free.largest < the_size )
cc74: e59c2004 ldr r2, [ip, #4]
the_info->Used.number++;
the_info->Used.total += the_size;
if ( the_info->Used.largest < the_size )
the_info->Used.largest = the_size;
} else {
the_info->Free.number++;
cc78: e2833001 add r3, r3, #1 ; 0x1
the_info->Free.total += the_size;
if ( the_info->Free.largest < the_size )
cc7c: e1520000 cmp r2, r0
the_info->Used.total += the_size;
if ( the_info->Used.largest < the_size )
the_info->Used.largest = the_size;
} else {
the_info->Free.number++;
the_info->Free.total += the_size;
cc80: e0811000 add r1, r1, r0
if ( the_info->Free.largest < the_size )
the_info->Free.largest = the_size;
cc84: 358c0004 strcc r0, [ip, #4]
the_info->Used.number++;
the_info->Used.total += the_size;
if ( the_info->Used.largest < the_size )
the_info->Used.largest = the_size;
} else {
the_info->Free.number++;
cc88: e58c3000 str r3, [ip]
the_info->Free.total += the_size;
cc8c: e58c1008 str r1, [ip, #8]
if ( the_info->Free.largest < the_size )
the_info->Free.largest = the_size;
if ( the_size != next_block->prev_size )
cc90: e5943000 ldr r3, [r4]
cc94: e1500003 cmp r0, r3
cc98: 0a000001 beq cca4 <_Heap_Get_information+0xa8>
cc9c: e3a00001 mov r0, #1 ; 0x1 <== NOT EXECUTED
cca0: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED
cca4: e1a02004 mov r2, r4
the_info->Free.largest = 0;
the_info->Used.number = 0;
the_info->Used.total = 0;
the_info->Used.largest = 0;
while ( the_block != end ) {
cca8: e1520005 cmp r2, r5
ccac: 1affffde bne cc2c <_Heap_Get_information+0x30>
}
/* Handle the last dummy block. Don't consider this block to be
"used" as client never allocated it. Make 'Used.total' contain this
blocks' overhead though. */
the_info->Used.total += HEAP_OVERHEAD;
ccb0: e59c3014 ldr r3, [ip, #20]
ccb4: e2833008 add r3, r3, #8 ; 0x8
ccb8: e58c3014 str r3, [ip, #20]
ccbc: e3a00000 mov r0, #0 ; 0x0
return HEAP_GET_INFORMATION_SUCCESSFUL;
}
ccc0: e8bd8030 pop {r4, r5, pc}
00013260 <_Heap_Resize_block>:
void *starting_address,
size_t size,
uint32_t *old_mem_size,
uint32_t *avail_mem_size
)
{
13260: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr}
13264: e1a05000 mov r5, r0
Heap_Block *next_next_block; uint32_t old_block_size; uint32_t old_user_size; uint32_t prev_used_flag; Heap_Statistics *const stats = &the_heap->stats; uint32_t const min_block_size = the_heap->min_block_size;
13268: e5900014 ldr r0, [r0, #20]
void *starting_address,
size_t size,
uint32_t *old_mem_size,
uint32_t *avail_mem_size
)
{
1326c: e24dd00c sub sp, sp, #12 ; 0xc
Heap_Block *next_next_block; uint32_t old_block_size; uint32_t old_user_size; uint32_t prev_used_flag; Heap_Statistics *const stats = &the_heap->stats; uint32_t const min_block_size = the_heap->min_block_size;
13270: e58d0004 str r0, [sp, #4]
uint32_t const page_size = the_heap->page_size;
*old_mem_size = 0;
*avail_mem_size = 0;
13274: e59d0030 ldr r0, [sp, #48]
void *starting_address,
size_t size,
uint32_t *old_mem_size,
uint32_t *avail_mem_size
)
{
13278: e1a09003 mov r9, r3
uint32_t prev_used_flag;
Heap_Statistics *const stats = &the_heap->stats;
uint32_t const min_block_size = the_heap->min_block_size;
uint32_t const page_size = the_heap->page_size;
*old_mem_size = 0;
1327c: e3a03000 mov r3, #0 ; 0x0
uint32_t old_block_size; uint32_t old_user_size; uint32_t prev_used_flag; Heap_Statistics *const stats = &the_heap->stats; uint32_t const min_block_size = the_heap->min_block_size; uint32_t const page_size = the_heap->page_size;
13280: e595c010 ldr ip, [r5, #16]
*old_mem_size = 0;
13284: e5893000 str r3, [r9]
*avail_mem_size = 0;
13288: e5803000 str r3, [r0]
void *starting_address,
size_t size,
uint32_t *old_mem_size,
uint32_t *avail_mem_size
)
{
1328c: e1a04001 mov r4, r1
/* The address passed could be greater than the block address plus * HEAP_BLOCK_USER_OFFSET as _Heap_Allocate_aligned() may produce such user * pointers. To get rid of this offset we need to align the address down * to the nearest 'page_size' boundary. */ _Heap_Align_down_uptr ( &addr, the_heap->page_size ); *the_block = (Heap_Block *)(addr - HEAP_BLOCK_USER_OFFSET);
13290: e1a00001 mov r0, r1 13294: e5951010 ldr r1, [r5, #16] 13298: e1a08002 mov r8, r2
uint32_t old_block_size; uint32_t old_user_size; uint32_t prev_used_flag; Heap_Statistics *const stats = &the_heap->stats; uint32_t const min_block_size = the_heap->min_block_size; uint32_t const page_size = the_heap->page_size;
1329c: e58dc008 str ip, [sp, #8] 132a0: ebfff8ca bl 115d0 <__umodsi3> 132a4: e2443008 sub r3, r4, #8 ; 0x8
RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in (
Heap_Control *the_heap,
Heap_Block *the_block
)
{
return _Addresses_Is_in_range( the_block, the_heap->start, the_heap->final );
132a8: e2851020 add r1, r5, #32 ; 0x20
132ac: e8910006 ldm r1, {r1, r2}
/* The address passed could be greater than the block address plus * HEAP_BLOCK_USER_OFFSET as _Heap_Allocate_aligned() may produce such user * pointers. To get rid of this offset we need to align the address down * to the nearest 'page_size' boundary. */ _Heap_Align_down_uptr ( &addr, the_heap->page_size ); *the_block = (Heap_Block *)(addr - HEAP_BLOCK_USER_OFFSET);
132b0: e0607003 rsb r7, r0, r3
*old_mem_size = 0;
*avail_mem_size = 0;
_Heap_Start_of_block(the_heap, starting_address, &the_block);
_HAssert(_Heap_Is_block_in(the_heap, the_block));
if (!_Heap_Is_block_in(the_heap, the_block))
132b4: e1570001 cmp r7, r1 132b8: 33a03000 movcc r3, #0 ; 0x0 132bc: 23a03001 movcs r3, #1 ; 0x1 132c0: e1570002 cmp r7, r2 132c4: 83a03000 movhi r3, #0 ; 0x0 132c8: e3530000 cmp r3, #0 ; 0x0
132cc: 0a000075 beq 134a8 <_Heap_Resize_block+0x248>
return HEAP_RESIZE_FATAL_ERROR;
prev_used_flag = the_block->size & HEAP_PREV_USED;
132d0: e597c004 ldr ip, [r7, #4]
*/
RTEMS_INLINE_ROUTINE uint32_t _Heap_Block_size (
Heap_Block *the_block
)
{
return (the_block->size & ~HEAP_PREV_USED);
132d4: e3cc3001 bic r3, ip, #1 ; 0x1
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
132d8: e0876003 add r6, r7, r3
*/
RTEMS_INLINE_ROUTINE uint32_t _Heap_Block_size (
Heap_Block *the_block
)
{
return (the_block->size & ~HEAP_PREV_USED);
132dc: e58d3000 str r3, [sp]
old_block_size = _Heap_Block_size(the_block);
next_block = _Heap_Block_at(the_block, old_block_size);
_HAssert(_Heap_Is_block_in(the_heap, next_block));
_HAssert(_Heap_Is_prev_used(next_block));
if ( !_Heap_Is_block_in(the_heap, next_block) ||
132e0: e1560001 cmp r6, r1 132e4: 33a03000 movcc r3, #0 ; 0x0 132e8: 23a03001 movcs r3, #1 ; 0x1 132ec: e1560002 cmp r6, r2 132f0: 83a03000 movhi r3, #0 ; 0x0 132f4: e3530000 cmp r3, #0 ; 0x0
132f8: 0a00006a beq 134a8 <_Heap_Resize_block+0x248>
*/
RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used (
Heap_Block *the_block
)
{
return (the_block->size & HEAP_PREV_USED);
132fc: e5963004 ldr r3, [r6, #4] 13300: e3130001 tst r3, #1 ; 0x1
13304: 0a000067 beq 134a8 <_Heap_Resize_block+0x248>
*/
RTEMS_INLINE_ROUTINE uint32_t _Heap_Block_size (
Heap_Block *the_block
)
{
return (the_block->size & ~HEAP_PREV_USED);
13308: e3c3a001 bic sl, r3, #1 ; 0x1
!_Heap_Is_prev_used(next_block))
return HEAP_RESIZE_FATAL_ERROR;
next_block_size = _Heap_Block_size(next_block);
next_next_block = _Heap_Block_at(next_block, next_block_size);
next_is_used = (next_block == the_heap->final) ||
1330c: e1560002 cmp r6, r2
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
13310: e086300a add r3, r6, sl 13314: 15933004 ldrne r3, [r3, #4] 13318: 12032001 andne r2, r3, #1 ; 0x1
_Heap_Is_prev_used(next_next_block);
/* See _Heap_Size_of_user_area() source for explanations */
old_user_size = _Addresses_Subtract(next_block, starting_address)
1331c: e0643006 rsb r3, r4, r6 13320: e2830004 add r0, r3, #4 ; 0x4
!_Heap_Is_prev_used(next_block))
return HEAP_RESIZE_FATAL_ERROR;
next_block_size = _Heap_Block_size(next_block);
next_next_block = _Heap_Block_at(next_block, next_block_size);
next_is_used = (next_block == the_heap->final) ||
13324: 03a02001 moveq r2, #1 ; 0x1
old_user_size = _Addresses_Subtract(next_block, starting_address)
+ HEAP_BLOCK_HEADER_OFFSET;
*old_mem_size = old_user_size;
if (size > old_user_size) {
13328: e1580000 cmp r8, r0
/* See _Heap_Size_of_user_area() source for explanations */
old_user_size = _Addresses_Subtract(next_block, starting_address)
+ HEAP_BLOCK_HEADER_OFFSET;
*old_mem_size = old_user_size;
1332c: e5890000 str r0, [r9]
!_Heap_Is_prev_used(next_block))
return HEAP_RESIZE_FATAL_ERROR;
next_block_size = _Heap_Block_size(next_block);
next_next_block = _Heap_Block_at(next_block, next_block_size);
next_is_used = (next_block == the_heap->final) ||
13330: e202b0ff and fp, r2, #255 ; 0xff
_Heap_Start_of_block(the_heap, starting_address, &the_block);
_HAssert(_Heap_Is_block_in(the_heap, the_block));
if (!_Heap_Is_block_in(the_heap, the_block))
return HEAP_RESIZE_FATAL_ERROR;
prev_used_flag = the_block->size & HEAP_PREV_USED;
13334: e20c9001 and r9, ip, #1 ; 0x1
old_user_size = _Addresses_Subtract(next_block, starting_address)
+ HEAP_BLOCK_HEADER_OFFSET;
*old_mem_size = old_user_size;
if (size > old_user_size) {
13338: 9a000019 bls 133a4 <_Heap_Resize_block+0x144>
/* Need to extend the block: allocate part of the next block and then
merge 'the_block' and allocated block together. */
if (next_is_used) /* Next block is in use, -- no way to extend */
1333c: e35b0000 cmp fp, #0 ; 0x0
13340: 1a00005a bne 134b0 <_Heap_Resize_block+0x250>
return HEAP_RESIZE_UNSATISFIED;
else {
uint32_t add_block_size = size - old_user_size;
13344: e0604008 rsb r4, r0, r8
uint32_t alignment
)
{
uint32_t v = *value;
uint32_t a = alignment;
uint32_t r = v % a;
13348: e1a00004 mov r0, r4 1334c: e59d1008 ldr r1, [sp, #8] 13350: ebfff89e bl 115d0 <__umodsi3>
*value = r ? v - r + a : v;
13354: e3500000 cmp r0, #0 ; 0x0 13358: 159dc008 ldrne ip, [sp, #8] 1335c: e59d2004 ldr r2, [sp, #4] 13360: 1084300c addne r3, r4, ip 13364: 10604003 rsbne r4, r0, r3 13368: e1540002 cmp r4, r2 1336c: 21a02004 movcs r2, r4
_Heap_Align_up(&add_block_size, page_size);
if (add_block_size < min_block_size)
add_block_size = min_block_size;
if (add_block_size > next_block_size)
13370: e152000a cmp r2, sl
13374: 8a00004d bhi 134b0 <_Heap_Resize_block+0x250>
return HEAP_RESIZE_UNSATISFIED; /* Next block is too small or none. */
add_block_size =
13378: e1a01006 mov r1, r6 1337c: e1a00005 mov r0, r5 13380: ebffc80d bl 53bc <_Heap_Block_allocate>
_Heap_Block_allocate(the_heap, next_block, add_block_size);
/* Merge two subsequent blocks */
the_block->size = (old_block_size + add_block_size) | prev_used_flag;
13384: e59d2000 ldr r2, [sp] 13388: e0800002 add r0, r0, r2 1338c: e1800009 orr r0, r0, r9 13390: e5870004 str r0, [r7, #4]
--stats->used_blocks;
13394: e5953040 ldr r3, [r5, #64] 13398: e2433001 sub r3, r3, #1 ; 0x1 1339c: e5853040 str r3, [r5, #64] 133a0: ea00003b b 13494 <_Heap_Resize_block+0x234>
}
} else {
/* Calculate how much memory we could free */
uint32_t free_block_size = old_user_size - size;
133a4: e0684000 rsb r4, r8, r0
uint32_t *value,
uint32_t alignment
)
{
uint32_t v = *value;
*value = v - (v % alignment);
133a8: e1a00004 mov r0, r4 133ac: e59d1008 ldr r1, [sp, #8] 133b0: ebfff886 bl 115d0 <__umodsi3>
_Heap_Align_down(&free_block_size, page_size);
if (free_block_size > 0) {
133b4: e0544000 subs r4, r4, r0
133b8: 0a000035 beq 13494 <_Heap_Resize_block+0x234>
/* To free some memory the block should be shortened so that it can
can hold 'size' user bytes and still remain not shorter than
'min_block_size'. */
uint32_t new_block_size = old_block_size - free_block_size;
133bc: e89d1008 ldm sp, {r3, ip}
133c0: e0640003 rsb r0, r4, r3
if (new_block_size < min_block_size) {
133c4: e150000c cmp r0, ip
133c8: 2a000007 bcs 133ec <_Heap_Resize_block+0x18c>
uint32_t delta = min_block_size - new_block_size;
133cc: e060300c rsb r3, r0, ip
_HAssert(free_block_size >= delta);
free_block_size -= delta;
if (free_block_size == 0) {
133d0: e0544003 subs r4, r4, r3
++stats->resizes;
return HEAP_RESIZE_SUCCESSFUL;
}
new_block_size += delta;
133d4: 10800003 addne r0, r0, r3
if (new_block_size < min_block_size) {
uint32_t delta = min_block_size - new_block_size;
_HAssert(free_block_size >= delta);
free_block_size -= delta;
if (free_block_size == 0) {
++stats->resizes;
133d8: 05953054 ldreq r3, [r5, #84] 133dc: 02833001 addeq r3, r3, #1 ; 0x1 133e0: 05853054 streq r3, [r5, #84] 133e4: 01a00004 moveq r0, r4
133e8: 0a000031 beq 134b4 <_Heap_Resize_block+0x254>
_HAssert(new_block_size >= min_block_size);
_HAssert(new_block_size + free_block_size == old_block_size);
_HAssert(_Heap_Is_aligned(new_block_size, page_size));
_HAssert(_Heap_Is_aligned(free_block_size, page_size));
if (!next_is_used) {
133ec: e35b0000 cmp fp, #0 ; 0x0
133f0: 1a000013 bne 13444 <_Heap_Resize_block+0x1e4>
/* Extend the next block to the low addresses by 'free_block_size' */
Heap_Block *const new_next_block =
_Heap_Block_at(the_block, new_block_size);
uint32_t const new_next_block_size =
next_block_size + free_block_size;
133f4: e084200a add r2, r4, sl
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
133f8: e0871000 add r1, r7, r0
_HAssert(_Heap_Is_block_in(the_heap, next_next_block));
the_block->size = new_block_size | prev_used_flag;
133fc: e1803009 orr r3, r0, r9
new_next_block->size = new_next_block_size | HEAP_PREV_USED;
13400: e3820001 orr r0, r2, #1 ; 0x1
Heap_Block *const new_next_block =
_Heap_Block_at(the_block, new_block_size);
uint32_t const new_next_block_size =
next_block_size + free_block_size;
_HAssert(_Heap_Is_block_in(the_heap, next_next_block));
the_block->size = new_block_size | prev_used_flag;
13404: e5873004 str r3, [r7, #4]
new_next_block->size = new_next_block_size | HEAP_PREV_USED;
next_next_block->prev_size = new_next_block_size;
13408: e786200a str r2, [r6, sl]
_Heap_Block_at(the_block, new_block_size);
uint32_t const new_next_block_size =
next_block_size + free_block_size;
_HAssert(_Heap_Is_block_in(the_heap, next_next_block));
the_block->size = new_block_size | prev_used_flag;
new_next_block->size = new_next_block_size | HEAP_PREV_USED;
1340c: e5810004 str r0, [r1, #4]
next_next_block->prev_size = new_next_block_size;
_Heap_Block_replace(next_block, new_next_block);
the_heap->stats.free_size += free_block_size;
13410: e5953030 ldr r3, [r5, #48] 13414: e0833004 add r3, r3, r4
Heap_Block *new_block
)
{
Heap_Block *block = old_block;
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
13418: e596000c ldr r0, [r6, #12]
Heap_Block *old_block,
Heap_Block *new_block
)
{
Heap_Block *block = old_block;
Heap_Block *next = block->next;
1341c: e596c008 ldr ip, [r6, #8] 13420: e5853030 str r3, [r5, #48]
*avail_mem_size = new_next_block_size - HEAP_BLOCK_USED_OVERHEAD;
13424: e59d3030 ldr r3, [sp, #48] 13428: e2422004 sub r2, r2, #4 ; 0x4
Heap_Block *prev = block->prev;
block = new_block;
block->next = next;
1342c: e581c008 str ip, [r1, #8]
block->prev = prev;
13430: e581000c str r0, [r1, #12] 13434: e5832000 str r2, [r3]
next->prev = prev->next = block;
13438: e5801008 str r1, [r0, #8] 1343c: e58c100c str r1, [ip, #12] 13440: ea000013 b 13494 <_Heap_Resize_block+0x234>
} else if (free_block_size >= min_block_size) {
13444: e59dc004 ldr ip, [sp, #4] <== NOT EXECUTED 13448: e154000c cmp r4, ip <== NOT EXECUTED 1344c: 3a000010 bcc 13494 <_Heap_Resize_block+0x234> <== NOT EXECUTED
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
13450: e0871000 add r1, r7, r0 <== NOT EXECUTED
/* Split the block into 2 used parts, then free the second one. */
the_block->size = new_block_size | prev_used_flag;
13454: e1803009 orr r3, r0, r9 <== NOT EXECUTED
next_block = _Heap_Block_at(the_block, new_block_size);
next_block->size = free_block_size | HEAP_PREV_USED;
13458: e3842001 orr r2, r4, #1 ; 0x1 <== NOT EXECUTED
the_heap->stats.free_size += free_block_size;
*avail_mem_size = new_next_block_size - HEAP_BLOCK_USED_OVERHEAD;
} else if (free_block_size >= min_block_size) {
/* Split the block into 2 used parts, then free the second one. */
the_block->size = new_block_size | prev_used_flag;
1345c: e5873004 str r3, [r7, #4] <== NOT EXECUTED
next_block = _Heap_Block_at(the_block, new_block_size);
next_block->size = free_block_size | HEAP_PREV_USED;
13460: e5812004 str r2, [r1, #4] <== NOT EXECUTED
++stats->used_blocks; /* We have created used block */
13464: e5953040 ldr r3, [r5, #64] <== NOT EXECUTED
--stats->frees; /* Don't count next call in stats */
13468: e5952050 ldr r2, [r5, #80] <== NOT EXECUTED
} else if (free_block_size >= min_block_size) {
/* Split the block into 2 used parts, then free the second one. */
the_block->size = new_block_size | prev_used_flag;
next_block = _Heap_Block_at(the_block, new_block_size);
next_block->size = free_block_size | HEAP_PREV_USED;
++stats->used_blocks; /* We have created used block */
1346c: e2833001 add r3, r3, #1 ; 0x1 <== NOT EXECUTED
--stats->frees; /* Don't count next call in stats */
13470: e2422001 sub r2, r2, #1 ; 0x1 <== NOT EXECUTED
} else if (free_block_size >= min_block_size) {
/* Split the block into 2 used parts, then free the second one. */
the_block->size = new_block_size | prev_used_flag;
next_block = _Heap_Block_at(the_block, new_block_size);
next_block->size = free_block_size | HEAP_PREV_USED;
++stats->used_blocks; /* We have created used block */
13474: e5853040 str r3, [r5, #64] <== NOT EXECUTED
--stats->frees; /* Don't count next call in stats */
13478: e5852050 str r2, [r5, #80] <== NOT EXECUTED
_Heap_Free(the_heap, _Heap_User_area(next_block));
1347c: e2811008 add r1, r1, #8 ; 0x8 <== NOT EXECUTED 13480: e1a00005 mov r0, r5 <== NOT EXECUTED 13484: ebffd8be bl 9784 <_Heap_Free> <== NOT EXECUTED
*avail_mem_size = free_block_size - HEAP_BLOCK_USED_OVERHEAD;
13488: e59d0030 ldr r0, [sp, #48] <== NOT EXECUTED 1348c: e2443004 sub r3, r4, #4 ; 0x4 <== NOT EXECUTED 13490: e5803000 str r3, [r0] <== NOT EXECUTED
}
}
}
++stats->resizes;
13494: e5953054 ldr r3, [r5, #84] 13498: e2833001 add r3, r3, #1 ; 0x1 1349c: e5853054 str r3, [r5, #84] 134a0: e3a00000 mov r0, #0 ; 0x0 134a4: ea000002 b 134b4 <_Heap_Resize_block+0x254>
return HEAP_RESIZE_SUCCESSFUL;
134a8: e3a00002 mov r0, #2 ; 0x2 134ac: ea000000 b 134b4 <_Heap_Resize_block+0x254> 134b0: e3a00001 mov r0, #1 ; 0x1
}
134b4: e28dd00c add sp, sp, #12 ; 0xc
134b8: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc}
0000cd74 <_Heap_Walk>:
bool _Heap_Walk(
Heap_Control *the_heap,
int source,
bool do_dump
)
{
cd74: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr}
Heap_Block *the_block = the_heap->start;
cd78: e5907020 ldr r7, [r0, #32]
/*
* Handle the 1st block
*/
if (!_Heap_Is_prev_used(the_block)) {
cd7c: e5973004 ldr r3, [r7, #4]
/*
if ( !_System_state_Is_up( _System_state_Get() ) )
return TRUE;
*/
if (source < 0)
cd80: e2516000 subs r6, r1, #0 ; 0x0
source = the_heap->stats.instance;
cd84: b5906028 ldrlt r6, [r0, #40]
/*
* Handle the 1st block
*/
if (!_Heap_Is_prev_used(the_block)) {
cd88: e3130001 tst r3, #1 ; 0x1
bool _Heap_Walk(
Heap_Control *the_heap,
int source,
bool do_dump
)
{
cd8c: e1a05000 mov r5, r0
Heap_Block *the_block = the_heap->start; Heap_Block *const end = the_heap->final;
cd90: e590b024 ldr fp, [r0, #36]
/*
* Handle the 1st block
*/
if (!_Heap_Is_prev_used(the_block)) {
cd94: 13a04000 movne r4, #0 ; 0x0
cd98: 1a000003 bne cdac <_Heap_Walk+0x38>
printk("PASS: %d !HEAP_PREV_USED flag of 1st block isn't set\n", source);
cd9c: e59f01a0 ldr r0, [pc, #416] ; cf44 <_Heap_Walk+0x1d0> <== NOT EXECUTED
cda0: e1a01006 mov r1, r6 <== NOT EXECUTED
cda4: ebffde24 bl 463c <printk> <== NOT EXECUTED
cda8: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
error = 1;
}
if (the_block->prev_size != the_heap->page_size) {
cdac: e5972000 ldr r2, [r7]
cdb0: e5953010 ldr r3, [r5, #16]
cdb4: e1520003 cmp r2, r3
cdb8: 0a00004c beq cef0 <_Heap_Walk+0x17c>
printk("PASS: %d !prev_size of 1st block isn't page_size\n", source);
cdbc: e59f0184 ldr r0, [pc, #388] ; cf48 <_Heap_Walk+0x1d4> <== NOT EXECUTED
cdc0: e1a01006 mov r1, r6 <== NOT EXECUTED
cdc4: ebffde1c bl 463c <printk> <== NOT EXECUTED
cdc8: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
cdcc: ea000047 b cef0 <_Heap_Walk+0x17c> <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE uint32_t _Heap_Block_size (
Heap_Block *the_block
)
{
return (the_block->size & ~HEAP_PREV_USED);
cdd0: e5979004 ldr r9, [r7, #4]
printk(" prev_size %d", the_block->prev_size);
else
printk(" (prev_size) %d", the_block->prev_size);
}
if (!_Heap_Is_block_in(the_heap, next_block)) {
cdd4: e5952020 ldr r2, [r5, #32]
cdd8: e3c9a001 bic sl, r9, #1 ; 0x1
cddc: e5953024 ldr r3, [r5, #36]
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
void *base,
uint32_t offset
)
{
return (Heap_Block *) _Addresses_Add_offset( base, offset );
cde0: e087800a add r8, r7, sl
cde4: e1580002 cmp r8, r2
cde8: 33a01000 movcc r1, #0 ; 0x0
cdec: 23a01001 movcs r1, #1 ; 0x1
cdf0: e1580003 cmp r8, r3
cdf4: 83a01000 movhi r1, #0 ; 0x0
cdf8: e3510000 cmp r1, #0 ; 0x0
cdfc: 1a000004 bne ce14 <_Heap_Walk+0xa0>
if (do_dump) printk("\n");
printk("PASS: %d !block %p is out of heap\n", source, next_block);
ce00: e1a02008 mov r2, r8 <== NOT EXECUTED
ce04: e59f0140 ldr r0, [pc, #320] ; cf4c <_Heap_Walk+0x1d8> <== NOT EXECUTED
ce08: e1a01006 mov r1, r6 <== NOT EXECUTED
ce0c: ebffde0a bl 463c <printk> <== NOT EXECUTED
ce10: ea000039 b cefc <_Heap_Walk+0x188> <== NOT EXECUTED
error = 1;
break;
}
if (!_Heap_Is_prev_used(next_block)) {
ce14: e5983004 ldr r3, [r8, #4]
ce18: e3130001 tst r3, #1 ; 0x1
ce1c: 1a00001e bne ce9c <_Heap_Walk+0x128>
if (do_dump)
printk( " prev %p next %p", the_block->prev, the_block->next);
if (_Heap_Block_size(the_block) != next_block->prev_size) {
ce20: e5983000 ldr r3, [r8]
ce24: e15a0003 cmp sl, r3
ce28: 0a000003 beq ce3c <_Heap_Walk+0xc8>
if (do_dump) printk("\n");
printk("PASS: %d !front and back sizes don't match", source);
ce2c: e59f011c ldr r0, [pc, #284] ; cf50 <_Heap_Walk+0x1dc> <== NOT EXECUTED
ce30: e1a01006 mov r1, r6 <== NOT EXECUTED
ce34: ebffde00 bl 463c <printk> <== NOT EXECUTED
ce38: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
error = 1;
}
if (!prev_used) {
ce3c: e3190001 tst r9, #1 ; 0x1
ce40: 1a000006 bne ce60 <_Heap_Walk+0xec>
if (do_dump || error) printk("\n");
ce44: e3540000 cmp r4, #0 ; 0x0 <== NOT EXECUTED
ce48: 159f0104 ldrne r0, [pc, #260] ; cf54 <_Heap_Walk+0x1e0> <== NOT EXECUTED
ce4c: 1bffddfa blne 463c <printk> <== NOT EXECUTED
printk("PASS: %d !two consecutive blocks are free", source);
ce50: e59f0100 ldr r0, [pc, #256] ; cf58 <_Heap_Walk+0x1e4> <== NOT EXECUTED
ce54: e1a01006 mov r1, r6 <== NOT EXECUTED
ce58: ebffddf7 bl 463c <printk> <== NOT EXECUTED
ce5c: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_First (
Heap_Control *the_heap
)
{
return _Heap_Head(the_heap)->next;
ce60: e5953008 ldr r3, [r5, #8]
ce64: ea000000 b ce6c <_Heap_Walk+0xf8>
}
{ /* Check if 'the_block' is in the free block list */
Heap_Block* block = _Heap_First(the_heap);
while(block != the_block && block != tail)
block = block->next;
ce68: e5933008 ldr r3, [r3, #8]
error = 1;
}
{ /* Check if 'the_block' is in the free block list */
Heap_Block* block = _Heap_First(the_heap);
while(block != the_block && block != tail)
ce6c: e1530007 cmp r3, r7
ce70: 11530005 cmpne r3, r5
ce74: 1afffffb bne ce68 <_Heap_Walk+0xf4>
block = block->next;
if(block != the_block) {
ce78: e1530007 cmp r3, r7
ce7c: 0a000006 beq ce9c <_Heap_Walk+0x128>
if (do_dump || error) printk("\n");
ce80: e3540000 cmp r4, #0 ; 0x0 <== NOT EXECUTED
ce84: 159f00c8 ldrne r0, [pc, #200] ; cf54 <_Heap_Walk+0x1e0> <== NOT EXECUTED
ce88: 1bffddeb blne 463c <printk> <== NOT EXECUTED
printk("PASS: %d !the_block not in the free list", source);
ce8c: e59f00c8 ldr r0, [pc, #200] ; cf5c <_Heap_Walk+0x1e8> <== NOT EXECUTED
ce90: e1a01006 mov r1, r6 <== NOT EXECUTED
ce94: ebffdde8 bl 463c <printk> <== NOT EXECUTED
ce98: ea000001 b cea4 <_Heap_Walk+0x130> <== NOT EXECUTED
error = 1;
}
}
}
if (do_dump || error) printk("\n");
ce9c: e3540000 cmp r4, #0 ; 0x0
cea0: 0a000002 beq ceb0 <_Heap_Walk+0x13c>
cea4: e59f00a8 ldr r0, [pc, #168] ; cf54 <_Heap_Walk+0x1e0> <== NOT EXECUTED
cea8: ebffdde3 bl 463c <printk> <== NOT EXECUTED
ceac: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
if (the_size < the_heap->min_block_size) {
ceb0: e5953014 ldr r3, [r5, #20]
ceb4: e15a0003 cmp sl, r3
printk("PASS: %d !block size is too small\n", source);
ceb8: 359f00a0 ldrcc r0, [pc, #160] ; cf60 <_Heap_Walk+0x1ec>
cebc: 3a000005 bcc ced8 <_Heap_Walk+0x164>
error = 1;
break;
}
if (!_Heap_Is_aligned( the_size, the_heap->page_size)) {
cec0: e1a0000a mov r0, sl
cec4: e5951010 ldr r1, [r5, #16]
cec8: eb0025b9 bl 165b4 <__umodsi3>
cecc: e3500000 cmp r0, #0 ; 0x0
ced0: 0a000003 beq cee4 <_Heap_Walk+0x170>
printk("PASS: %d !block size is misaligned\n", source);
ced4: e59f0088 ldr r0, [pc, #136] ; cf64 <_Heap_Walk+0x1f0> <== NOT EXECUTED
ced8: e1a01006 mov r1, r6 <== NOT EXECUTED
cedc: ebffddd6 bl 463c <printk> <== NOT EXECUTED
cee0: ea000005 b cefc <_Heap_Walk+0x188> <== NOT EXECUTED
error = 1;
}
if (++passes > (do_dump ? 10 : 0) && error)
cee4: e3540000 cmp r4, #0 ; 0x0
cee8: 1a000003 bne cefc <_Heap_Walk+0x188>
break;
ceec: e1a07008 mov r7, r8
if (the_block->prev_size != the_heap->page_size) {
printk("PASS: %d !prev_size of 1st block isn't page_size\n", source);
error = 1;
}
while ( the_block != end ) {
cef0: e157000b cmp r7, fp
cef4: 1affffb5 bne cdd0 <_Heap_Walk+0x5c>
cef8: ea000005 b cf14 <_Heap_Walk+0x1a0>
the_block = next_block;
}
if (the_block != end) {
printk("PASS: %d !last block address isn't equal to 'final' %p %p\n",
cefc: e1a0300b mov r3, fp <== NOT EXECUTED
cf00: e59f0060 ldr r0, [pc, #96] ; cf68 <_Heap_Walk+0x1f4> <== NOT EXECUTED
cf04: e1a01006 mov r1, r6 <== NOT EXECUTED
cf08: e1a02007 mov r2, r7 <== NOT EXECUTED
cf0c: ebffddca bl 463c <printk> <== NOT EXECUTED
cf10: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE uint32_t _Heap_Block_size (
Heap_Block *the_block
)
{
return (the_block->size & ~HEAP_PREV_USED);
cf14: e5973004 ldr r3, [r7, #4]
source, the_block, end);
error = 1;
}
if (_Heap_Block_size(the_block) != the_heap->page_size) {
cf18: e5950010 ldr r0, [r5, #16]
cf1c: e3c32001 bic r2, r3, #1 ; 0x1
cf20: e1520000 cmp r2, r0
cf24: 0a000004 beq cf3c <_Heap_Walk+0x1c8>
printk("PASS: %d !last block's size isn't page_size (%d != %d)\n", source,
cf28: e1a03000 mov r3, r0 <== NOT EXECUTED
cf2c: e1a01006 mov r1, r6 <== NOT EXECUTED
cf30: e59f0034 ldr r0, [pc, #52] ; cf6c <_Heap_Walk+0x1f8> <== NOT EXECUTED
cf34: ebffddc0 bl 463c <printk> <== NOT EXECUTED
cf38: e3a04001 mov r4, #1 ; 0x1 <== NOT EXECUTED
if(do_dump && error)
_Internal_error_Occurred( INTERNAL_ERROR_CORE, TRUE, 0xffff0000 );
return error;
}
cf3c: e1a00004 mov r0, r4
cf40: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc}
00004a30 <_IO_Initialize_all_drivers>:
*
* Output Parameters: NONE
*/
void _IO_Initialize_all_drivers( void )
{
4a30: e92d4030 push {r4, r5, lr}
4a34: e3a04000 mov r4, #0 ; 0x0
rtems_device_major_number major;
for ( major=0 ; major < _IO_Number_of_drivers ; major ++ )
4a38: e59f5024 ldr r5, [pc, #36] ; 4a64 <_IO_Initialize_all_drivers+0x34>
4a3c: ea000000 b 4a44 <_IO_Initialize_all_drivers+0x14>
(void) rtems_io_initialize( major, 0, NULL );
4a40: eb001286 bl 9460 <rtems_io_initialize>
void _IO_Initialize_all_drivers( void )
{
rtems_device_major_number major;
for ( major=0 ; major < _IO_Number_of_drivers ; major ++ )
4a44: e5953000 ldr r3, [r5]
(void) rtems_io_initialize( major, 0, NULL );
4a48: e3a01000 mov r1, #0 ; 0x0
void _IO_Initialize_all_drivers( void )
{
rtems_device_major_number major;
for ( major=0 ; major < _IO_Number_of_drivers ; major ++ )
4a4c: e1540003 cmp r4, r3
(void) rtems_io_initialize( major, 0, NULL );
4a50: e1a00004 mov r0, r4
4a54: e1a02001 mov r2, r1
void _IO_Initialize_all_drivers( void )
{
rtems_device_major_number major;
for ( major=0 ; major < _IO_Number_of_drivers ; major ++ )
4a58: e2844001 add r4, r4, #1 ; 0x1
4a5c: 3afffff7 bcc 4a40 <_IO_Initialize_all_drivers+0x10>
(void) rtems_io_initialize( major, 0, NULL );
}
4a60: e8bd8030 pop {r4, r5, pc}
00009978 <_Objects_API_maximum_class>:
int _Objects_API_maximum_class(
uint32_t api
)
{
switch (api) {
9978: e2400001 sub r0, r0, #1 ; 0x1
997c: e3500003 cmp r0, #3 ; 0x3
9980: 979ff100 ldrls pc, [pc, r0, lsl #2]
9984: ea00000b b 99b8 <_Objects_API_maximum_class+0x40>
9988: 000099a0 .word 0x000099a0
998c: 00009998 .word 0x00009998
9990: 000099a8 .word 0x000099a8
9994: 000099b0 .word 0x000099b0
9998: e3a0000a mov r0, #10 ; 0xa
999c: e12fff1e bx lr
99a0: e3a00002 mov r0, #2 ; 0x2
99a4: e12fff1e bx lr
99a8: e3a0000c mov r0, #12 ; 0xc <== NOT EXECUTED
99ac: e12fff1e bx lr <== NOT EXECUTED
case OBJECTS_INTERNAL_API:
return OBJECTS_INTERNAL_CLASSES_LAST;
case OBJECTS_CLASSIC_API:
return OBJECTS_RTEMS_CLASSES_LAST;
case OBJECTS_POSIX_API:
return OBJECTS_POSIX_CLASSES_LAST;
99b0: e3a00008 mov r0, #8 ; 0x8
99b4: e12fff1e bx lr
case OBJECTS_ITRON_API:
return OBJECTS_ITRON_CLASSES_LAST;
99b8: e3e00000 mvn r0, #0 ; 0x0
case OBJECTS_NO_API:
default:
break;
}
return -1;
}
99bc: e12fff1e bx lr
00005570 <_Objects_Extend_information>:
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
5570: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr}
*/
RTEMS_INLINE_ROUTINE uint32_t _Objects_Get_index(
Objects_Id id
)
{
return (id >> OBJECTS_INDEX_START_BIT) & OBJECTS_INDEX_VALID_BITS;
5574: e1d060b8 ldrh r6, [r0, #8]
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
if ( information->maximum < minimum_index )
5578: e1d041b0 ldrh r4, [r0, #16]
557c: e1540006 cmp r4, r6
5580: 33a07000 movcc r7, #0 ; 0x0
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
5584: e24dd014 sub sp, sp, #20 ; 0x14
5588: e1a05000 mov r5, r0
minimum_index = _Objects_Get_index( information->minimum_id );
index_base = minimum_index;
block = 0;
if ( information->maximum < minimum_index )
558c: 31a0a006 movcc sl, r6
5590: 31a08007 movcc r8, r7
5594: 3a00000f bcc 55d8 <_Objects_Extend_information+0x68>
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
5598: e5909014 ldr r9, [r0, #20]
559c: e1a00004 mov r0, r4
55a0: e1a01009 mov r1, r9
55a4: eb002fc5 bl 114c0 <__aeabi_uidiv>
55a8: e1a0a006 mov sl, r6
55ac: e1a07000 mov r7, r0
55b0: e3a08000 mov r8, #0 ; 0x0
55b4: ea000005 b 55d0 <_Objects_Extend_information+0x60>
for ( ; block < block_count; block++ ) {
if ( information->object_blocks[ block ] == NULL )
55b8: e5953034 ldr r3, [r5, #52]
55bc: e7933108 ldr r3, [r3, r8, lsl #2]
55c0: e3530000 cmp r3, #0 ; 0x0
55c4: 0a000003 beq 55d8 <_Objects_Extend_information+0x68>
break;
else
index_base += information->allocation_size;
55c8: e08aa009 add sl, sl, r9
if ( information->maximum < minimum_index )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
55cc: e2888001 add r8, r8, #1 ; 0x1
55d0: e1580007 cmp r8, r7
55d4: 3afffff7 bcc 55b8 <_Objects_Extend_information+0x48>
/*
* If the index_base is the maximum we need to grow the tables.
*/
if (index_base >= information->maximum ) {
55d8: e15a0004 cmp sl, r4
55dc: 3a000056 bcc 573c <_Objects_Extend_information+0x1cc>
/*
* Allocate the tables and break it up.
*/
if ( information->auto_extend ) {
55e0: e5d52012 ldrb r2, [r5, #18]
* Up the block count and maximum
*/
block_count++;
maximum = information->maximum + information->allocation_size;
55e4: e5953014 ldr r3, [r5, #20]
/*
* Allocate the tables and break it up.
*/
if ( information->auto_extend ) {
55e8: e3520000 cmp r2, #0 ; 0x0
* Up the block count and maximum
*/
block_count++;
maximum = information->maximum + information->allocation_size;
55ec: e0843003 add r3, r4, r3
55f0: e58d3004 str r3, [sp, #4]
/*
* Up the block count and maximum
*/
block_count++;
55f4: e2874001 add r4, r7, #1 ; 0x1
55f8: e0832006 add r2, r3, r6
/*
* Allocate the tables and break it up.
*/
if ( information->auto_extend ) {
55fc: 0a000007 beq 5620 <_Objects_Extend_information+0xb0>
object_blocks = (void**)
5600: e3a03003 mov r3, #3 ; 0x3
5604: e0202493 mla r0, r3, r4, r2
5608: e1a00100 lsl r0, r0, #2
560c: eb0007e6 bl 75ac <_Workspace_Allocate>
block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
((maximum + minimum_index) * sizeof(Objects_Control *))
);
if ( !object_blocks )
5610: e3500000 cmp r0, #0 ; 0x0
5614: e58d0000 str r0, [sp]
5618: 1a000005 bne 5634 <_Objects_Extend_information+0xc4>
561c: ea000078 b 5804 <_Objects_Extend_information+0x294> <== NOT EXECUTED
return;
}
else {
object_blocks = (void**)
5620: e3a03003 mov r3, #3 ; 0x3
5624: e0202493 mla r0, r3, r4, r2
5628: e1a00100 lsl r0, r0, #2
562c: eb0007e2 bl 75bc <_Workspace_Allocate_or_fatal_error>
5630: e58d0000 str r0, [sp]
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
5634: e1d531b0 ldrh r3, [r5, #16]
/*
* Break the block into the various sections.
*
*/
inactive_per_block = (uint32_t *) _Addresses_Add_offset(
5638: e59d1000 ldr r1, [sp]
563c: e1a02104 lsl r2, r4, #2
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
5640: e1530006 cmp r3, r6
/*
* Break the block into the various sections.
*
*/
inactive_per_block = (uint32_t *) _Addresses_Add_offset(
5644: e081b002 add fp, r1, r2
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
5648: 93a03000 movls r3, #0 ; 0x0
564c: e08b9002 add r9, fp, r2
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
5650: 91a02003 movls r2, r3
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
5654: 9a000011 bls 56a0 <_Objects_Extend_information+0x130>
/*
* 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,
5658: e1a04107 lsl r4, r7, #2
565c: e5951034 ldr r1, [r5, #52]
5660: e1a02004 mov r2, r4
5664: e59d0000 ldr r0, [sp]
5668: eb001633 bl af3c <memcpy>
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
566c: e1a02004 mov r2, r4
5670: e5951030 ldr r1, [r5, #48]
5674: e1a0000b mov r0, fp
5678: eb00162f bl af3c <memcpy>
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
567c: e1d521b0 ldrh r2, [r5, #16]
5680: e0862002 add r2, r6, r2
5684: e1a02102 lsl r2, r2, #2
5688: e1a00009 mov r0, r9
568c: e595101c ldr r1, [r5, #28]
5690: eb001629 bl af3c <memcpy>
5694: ea000003 b 56a8 <_Objects_Extend_information+0x138>
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
5698: e7892103 str r2, [r9, r3, lsl #2]
else {
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
569c: e2833001 add r3, r3, #1 ; 0x1
56a0: e1530006 cmp r3, r6
56a4: 3afffffb bcc 5698 <_Objects_Extend_information+0x128>
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
56a8: e3a03000 mov r3, #0 ; 0x0
inactive_per_block[block_count] = 0;
56ac: e78b3107 str r3, [fp, r7, lsl #2]
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
56b0: e59dc000 ldr ip, [sp]
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
56b4: e5952014 ldr r2, [r5, #20]
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
56b8: e78c3107 str r3, [ip, r7, lsl #2]
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
56bc: e08a0002 add r0, sl, r2
56c0: e089110a add r1, r9, sl, lsl #2
56c4: e1a0200a mov r2, sl
56c8: ea000000 b 56d0 <_Objects_Extend_information+0x160>
index++ ) {
local_table[ index ] = NULL;
56cc: e5013004 str r3, [r1, #-4]
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
56d0: e1520000 cmp r2, r0
index++ ) {
56d4: e2811004 add r1, r1, #4 ; 0x4
56d8: e2822001 add r2, r2, #1 ; 0x1
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
56dc: 3afffffa bcc 56cc <_Objects_Extend_information+0x15c>
index++ ) {
local_table[ index ] = NULL;
}
_ISR_Disable( level );
56e0: e10f0000 mrs r0, CPSR
56e4: e38030c0 orr r3, r0, #192 ; 0xc0
56e8: e129f003 msr CPSR_fc, r3
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = maximum;
information->maximum_id = _Objects_Build_id(
56ec: e5953000 ldr r3, [r5]
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = maximum;
56f0: e59dc004 ldr ip, [sp, #4]
information->maximum_id = _Objects_Build_id(
56f4: e1d510b4 ldrh r1, [r5, #4]
56f8: e1a03c03 lsl r3, r3, #24
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = maximum;
56fc: e1a0280c lsl r2, ip, #16
information->maximum_id = _Objects_Build_id(
5700: e3833801 orr r3, r3, #65536 ; 0x10000
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = maximum;
5704: e1a02822 lsr r2, r2, #16
information->maximum_id = _Objects_Build_id(
5708: e1833d81 orr r3, r3, r1, lsl #27
_ISR_Disable( level );
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
570c: e59d1000 ldr r1, [sp]
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = maximum;
information->maximum_id = _Objects_Build_id(
5710: e1833002 orr r3, r3, r2
5714: e585300c str r3, [r5, #12]
_ISR_Disable( level );
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
5718: e585b030 str fp, [r5, #48]
local_table[ index ] = NULL;
}
_ISR_Disable( level );
old_tables = information->object_blocks;
571c: e5953034 ldr r3, [r5, #52]
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
5720: e585901c str r9, [r5, #28]
information->maximum = maximum;
5724: e1c521b0 strh r2, [r5, #16]
_ISR_Disable( level );
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
5728: e5851034 str r1, [r5, #52]
information->the_class,
_Objects_Local_node,
information->maximum
);
_ISR_Enable( level );
572c: e129f000 msr CPSR_fc, r0
if ( old_tables )
5730: e3530000 cmp r3, #0 ; 0x0
_Workspace_Free( old_tables );
5734: 11a00003 movne r0, r3
5738: 1b000797 blne 759c <_Workspace_Free>
/*
* Allocate the name table, and the objects
*/
if ( information->auto_extend ) {
573c: e5d53012 ldrb r3, [r5, #18]
5740: e3530000 cmp r3, #0 ; 0x0
5744: e5952014 ldr r2, [r5, #20]
5748: e5954034 ldr r4, [r5, #52]
574c: e5953018 ldr r3, [r5, #24]
5750: 0a000007 beq 5774 <_Objects_Extend_information+0x204>
information->object_blocks[ block ] =
5754: e0000392 mul r0, r2, r3
5758: eb000793 bl 75ac <_Workspace_Allocate>
_Workspace_Allocate(
(information->allocation_size * information->size)
);
if ( !information->object_blocks[ block ] )
575c: e5953034 ldr r3, [r5, #52]
/*
* Allocate the name table, and the objects
*/
if ( information->auto_extend ) {
information->object_blocks[ block ] =
5760: e7840108 str r0, [r4, r8, lsl #2]
_Workspace_Allocate(
(information->allocation_size * information->size)
);
if ( !information->object_blocks[ block ] )
5764: e7933108 ldr r3, [r3, r8, lsl #2]
5768: e3530000 cmp r3, #0 ; 0x0
576c: 1a000003 bne 5780 <_Objects_Extend_information+0x210>
5770: ea000023 b 5804 <_Objects_Extend_information+0x294> <== NOT EXECUTED
return;
}
else {
information->object_blocks[ block ] =
5774: e0000392 mul r0, r2, r3
5778: eb00078f bl 75bc <_Workspace_Allocate_or_fatal_error>
577c: e7840108 str r0, [r4, r8, lsl #2]
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
5780: e5953034 ldr r3, [r5, #52]
5784: e28d4008 add r4, sp, #8 ; 0x8
5788: e7931108 ldr r1, [r3, r8, lsl #2]
578c: e1a00004 mov r0, r4
5790: e2852014 add r2, r5, #20 ; 0x14
5794: e892000c ldm r2, {r2, r3}
5798: eb000f5a bl 9508 <_Chain_Initialize>
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
579c: e1a0600a mov r6, sl
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
57a0: e1a08108 lsl r8, r8, #2
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
57a4: e2857020 add r7, r5, #32 ; 0x20
57a8: ea000008 b 57d0 <_Objects_Extend_information+0x260>
index = index_base;
while ( (the_object = (Objects_Control *) _Chain_Get( &Inactive ) ) != NULL ) {
the_object->id = _Objects_Build_id(
57ac: e5953000 ldr r3, [r5]
57b0: e1d520b4 ldrh r2, [r5, #4]
57b4: e1a03c03 lsl r3, r3, #24
57b8: e3833801 orr r3, r3, #65536 ; 0x10000
57bc: e1833d82 orr r3, r3, r2, lsl #27
57c0: e1833006 orr r3, r3, r6
57c4: e58c3008 str r3, [ip, #8]
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
57c8: ebfffd5d bl 4d44 <_Chain_Append>
index++;
57cc: e2866001 add r6, r6, #1 ; 0x1
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ( (the_object = (Objects_Control *) _Chain_Get( &Inactive ) ) != NULL ) {
57d0: e1a00004 mov r0, r4
57d4: eb000f3e bl 94d4 <_Chain_Get>
57d8: e250c000 subs ip, r0, #0 ; 0x0
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
57dc: e1a0100c mov r1, ip
57e0: e1a00007 mov r0, r7
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ( (the_object = (Objects_Control *) _Chain_Get( &Inactive ) ) != NULL ) {
57e4: 1afffff0 bne 57ac <_Objects_Extend_information+0x23c>
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
57e8: e5952030 ldr r2, [r5, #48]
57ec: e5953014 ldr r3, [r5, #20]
57f0: e7823008 str r3, [r2, r8]
information->inactive += information->allocation_size;
57f4: e1d522bc ldrh r2, [r5, #44]
57f8: e5953014 ldr r3, [r5, #20]
57fc: e0833002 add r3, r3, r2
5800: e1c532bc strh r3, [r5, #44]
}
5804: e28dd014 add sp, sp, #20 ; 0x14
5808: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc}
00005908 <_Objects_Get_isr_disable>:
#if defined(RTEMS_MULTIPROCESSING)
index = id - information->minimum_id + 1;
#else
/* index = _Objects_Get_index( id ); */
index = id & 0x0000ffff;
5908: e1a01801 lsl r1, r1, #16
Objects_Information *information,
Objects_Id id,
Objects_Locations *location,
ISR_Level *level_p
)
{
590c: e92d4010 push {r4, lr}
#if defined(RTEMS_MULTIPROCESSING)
index = id - information->minimum_id + 1;
#else
/* index = _Objects_Get_index( id ); */
index = id & 0x0000ffff;
5910: e1a01821 lsr r1, r1, #16
Objects_Information *information,
Objects_Id id,
Objects_Locations *location,
ISR_Level *level_p
)
{
5914: e1a04003 mov r4, r3
index = id & 0x0000ffff;
/* This should work but doesn't always :( */
/* index = (uint16_t ) id; */
#endif
_ISR_Disable( level );
5918: e10fc000 mrs ip, CPSR
591c: e38c30c0 orr r3, ip, #192 ; 0xc0
5920: e129f003 msr CPSR_fc, r3
if ( information->maximum >= index ) {
5924: e1d031b0 ldrh r3, [r0, #16]
5928: e1530001 cmp r3, r1
592c: 3a00000a bcc 595c <_Objects_Get_isr_disable+0x54>
if ( (the_object = information->local_table[ index ]) != NULL ) {
5930: e590301c ldr r3, [r0, #28]
5934: e7930101 ldr r0, [r3, r1, lsl #2]
5938: e3500000 cmp r0, #0 ; 0x0
*location = OBJECTS_LOCAL;
593c: 13a03000 movne r3, #0 ; 0x0
5940: 15823000 strne r3, [r2]
*level_p = level;
5944: 1584c000 strne ip, [r4]
/* index = (uint16_t ) id; */
#endif
_ISR_Disable( level );
if ( information->maximum >= index ) {
if ( (the_object = information->local_table[ index ]) != NULL ) {
5948: 18bd8010 popne {r4, pc}
*location = OBJECTS_LOCAL;
*level_p = level;
return the_object;
}
_ISR_Enable( level );
594c: e129f00c msr CPSR_fc, ip <== NOT EXECUTED
*location = OBJECTS_ERROR;
5950: e3a03001 mov r3, #1 ; 0x1 <== NOT EXECUTED
5954: e5823000 str r3, [r2] <== NOT EXECUTED
5958: e8bd8010 pop {r4, pc} <== NOT EXECUTED
return NULL;
}
_ISR_Enable( level );
595c: e129f00c msr CPSR_fc, ip
*location = OBJECTS_ERROR;
5960: e3a03001 mov r3, #1 ; 0x1
5964: e5823000 str r3, [r2]
5968: e3a00000 mov r0, #0 ; 0x0
_Objects_MP_Is_remote( information, id, location, &the_object ); return the_object; #else return NULL; #endif }
596c: e8bd8010 pop {r4, pc}
00007200 <_Objects_Get_name_as_string>:
char *_Objects_Get_name_as_string(
Objects_Id id,
size_t length,
char *name
)
{
7200: e92d40f0 push {r4, r5, r6, r7, lr}
char lname[5];
Objects_Control *the_object;
Objects_Locations location;
Objects_Id tmpId;
if ( length == 0 )
7204: e2517000 subs r7, r1, #0 ; 0x0
char *_Objects_Get_name_as_string(
Objects_Id id,
size_t length,
char *name
)
{
7208: e24dd00c sub sp, sp, #12 ; 0xc
720c: e1a05002 mov r5, r2
char lname[5];
Objects_Control *the_object;
Objects_Locations location;
Objects_Id tmpId;
if ( length == 0 )
7210: 0a000036 beq 72f0 <_Objects_Get_name_as_string+0xf0>
return NULL;
if ( name == NULL )
7214: e3520000 cmp r2, #0 ; 0x0
7218: 0a000035 beq 72f4 <_Objects_Get_name_as_string+0xf4>
return NULL;
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
721c: e3500000 cmp r0, #0 ; 0x0
7220: 059f30d8 ldreq r3, [pc, #216] ; 7300 <_Objects_Get_name_as_string+0x100>
7224: 05933000 ldreq r3, [r3]
7228: 05934008 ldreq r4, [r3, #8]
722c: 11a04000 movne r4, r0
information = _Objects_Get_information_id( tmpId );
7230: e1a00004 mov r0, r4
7234: ebffffb5 bl 7110 <_Objects_Get_information_id>
if ( !information )
7238: e2506000 subs r6, r0, #0 ; 0x0
723c: 0a00002b beq 72f0 <_Objects_Get_name_as_string+0xf0>
return NULL;
the_object = _Objects_Get( information, tmpId, &location );
7240: e1a01004 mov r1, r4
7244: e28d2008 add r2, sp, #8 ; 0x8
7248: eb00002e bl 7308 <_Objects_Get>
switch ( location ) {
724c: e59d3008 ldr r3, [sp, #8]
7250: e3530000 cmp r3, #0 ; 0x0
7254: 1a000025 bne 72f0 <_Objects_Get_name_as_string+0xf0>
case OBJECTS_ERROR:
return NULL;
case OBJECTS_LOCAL:
if ( information->is_string ) {
7258: e5d6c038 ldrb ip, [r6, #56]
725c: e35c0000 cmp ip, #0 ; 0x0
7260: 0a000004 beq 7278 <_Objects_Get_name_as_string+0x78>
s = the_object->name.name_p;
7264: e590000c ldr r0, [r0, #12]
lname[ 4 ] = '\0';
s = lname;
}
d = name;
if ( s ) {
7268: e3500000 cmp r0, #0 ; 0x0
726c: 01a0e005 moveq lr, r5
7270: 1a00000a bne 72a0 <_Objects_Get_name_as_string+0xa0>
7274: ea000019 b 72e0 <_Objects_Get_name_as_string+0xe0> <== NOT EXECUTED
case OBJECTS_LOCAL:
if ( information->is_string ) {
s = the_object->name.name_p;
} else {
uint32_t u32_name = (uint32_t) the_object->name.name_u32;
7278: e590300c ldr r3, [r0, #12]
lname[ 0 ] = (u32_name >> 24) & 0xff;
727c: e1a02c23 lsr r2, r3, #24
lname[ 1 ] = (u32_name >> 16) & 0xff;
7280: e1a01823 lsr r1, r3, #16
lname[ 2 ] = (u32_name >> 8) & 0xff;
7284: e1a00423 lsr r0, r3, #8
if ( information->is_string ) {
s = the_object->name.name_p;
} else {
uint32_t u32_name = (uint32_t) the_object->name.name_u32;
lname[ 0 ] = (u32_name >> 24) & 0xff;
7288: e5cd2003 strb r2, [sp, #3]
lname[ 1 ] = (u32_name >> 16) & 0xff;
728c: e5cd1004 strb r1, [sp, #4]
lname[ 2 ] = (u32_name >> 8) & 0xff;
lname[ 3 ] = (u32_name >> 0) & 0xff;
7290: e5cd3006 strb r3, [sp, #6]
lname[ 4 ] = '\0';
7294: e5cdc007 strb ip, [sp, #7]
} else {
uint32_t u32_name = (uint32_t) the_object->name.name_u32;
lname[ 0 ] = (u32_name >> 24) & 0xff;
lname[ 1 ] = (u32_name >> 16) & 0xff;
lname[ 2 ] = (u32_name >> 8) & 0xff;
7298: e5cd0005 strb r0, [sp, #5]
lname[ 3 ] = (u32_name >> 0) & 0xff;
lname[ 4 ] = '\0';
729c: e28d0003 add r0, sp, #3 ; 0x3
s = lname;
}
d = name;
if ( s ) {
for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) {
72a0: e2471001 sub r1, r7, #1 ; 0x1
lname[ 0 ] = (u32_name >> 24) & 0xff;
lname[ 1 ] = (u32_name >> 16) & 0xff;
lname[ 2 ] = (u32_name >> 8) & 0xff;
lname[ 3 ] = (u32_name >> 0) & 0xff;
lname[ 4 ] = '\0';
72a4: e3a0c000 mov ip, #0 ; 0x0
}
d = name;
if ( s ) {
for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) {
*d = (isprint(*s)) ? *s : '*';
72a8: e59f4054 ldr r4, [pc, #84] ; 7304 <_Objects_Get_name_as_string+0x104>
72ac: ea000005 b 72c8 <_Objects_Get_name_as_string+0xc8>
72b0: e5943000 ldr r3, [r4]
72b4: e7d33002 ldrb r3, [r3, r2]
72b8: e3130097 tst r3, #151 ; 0x97
72bc: 03a0202a moveq r2, #42 ; 0x2a
72c0: e7c5200c strb r2, [r5, ip]
s = lname;
}
d = name;
if ( s ) {
for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) {
72c4: e28cc001 add ip, ip, #1 ; 0x1
72c8: e15c0001 cmp ip, r1
72cc: e085e00c add lr, r5, ip
72d0: 2a000002 bcs 72e0 <_Objects_Get_name_as_string+0xe0>
72d4: e7d0200c ldrb r2, [r0, ip]
72d8: e3520000 cmp r2, #0 ; 0x0
72dc: 1afffff3 bne 72b0 <_Objects_Get_name_as_string+0xb0>
*d = (isprint(*s)) ? *s : '*';
}
}
*d = '\0';
72e0: e3a03000 mov r3, #0 ; 0x0
72e4: e5ce3000 strb r3, [lr]
_Thread_Enable_dispatch();
72e8: eb00020a bl 7b18 <_Thread_Enable_dispatch>
72ec: ea000000 b 72f4 <_Objects_Get_name_as_string+0xf4>
return name;
72f0: e3a05000 mov r5, #0 ; 0x0
} return NULL; /* unreachable path */ }
72f4: e1a00005 mov r0, r5
72f8: e28dd00c add sp, sp, #12 ; 0xc
72fc: e8bd80f0 pop {r4, r5, r6, r7, pc}
00006dc4 <_Objects_Id_to_name>:
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
6dc4: e92d4030 push {r4, r5, lr}
Objects_Id tmpId;
Objects_Information *information;
Objects_Control *the_object = (Objects_Control *) 0;
Objects_Locations ignored_location;
if ( !name )
6dc8: e2515000 subs r5, r1, #0 ; 0x0
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
6dcc: e24dd004 sub sp, sp, #4 ; 0x4
Objects_Id tmpId;
Objects_Information *information;
Objects_Control *the_object = (Objects_Control *) 0;
Objects_Locations ignored_location;
if ( !name )
6dd0: 03a00001 moveq r0, #1 ; 0x1
6dd4: 0a00001b beq 6e48 <_Objects_Id_to_name+0x84>
return OBJECTS_INVALID_NAME;
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
6dd8: e3500000 cmp r0, #0 ; 0x0
6ddc: 059f3080 ldreq r3, [pc, #128] ; 6e64 <_Objects_Id_to_name+0xa0>
6de0: 05933000 ldreq r3, [r3]
6de4: 05931008 ldreq r1, [r3, #8]
6de8: 11a01000 movne r1, r0
*/
RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API(
Objects_Id id
)
{
return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS);
6dec: e1a03c21 lsr r3, r1, #24
6df0: e2030007 and r0, r3, #7 ; 0x7
*/
RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid(
uint32_t the_api
)
{
if ( !the_api || the_api > OBJECTS_APIS_LAST )
6df4: e2403001 sub r3, r0, #1 ; 0x1
6df8: e3530003 cmp r3, #3 ; 0x3
6dfc: 8a000010 bhi 6e44 <_Objects_Id_to_name+0x80>
6e00: ea000012 b 6e50 <_Objects_Id_to_name+0x8c>
if ( !_Objects_Information_table[ the_api ] )
return OBJECTS_INVALID_ID;
the_class = _Objects_Get_class( tmpId );
information = _Objects_Information_table[ the_api ][ the_class ];
6e04: e1a03da1 lsr r3, r1, #27
6e08: e7900103 ldr r0, [r0, r3, lsl #2]
if ( !information )
6e0c: e3500000 cmp r0, #0 ; 0x0
6e10: 0a00000b beq 6e44 <_Objects_Id_to_name+0x80>
return OBJECTS_INVALID_ID;
if ( information->is_string )
6e14: e5d04038 ldrb r4, [r0, #56]
6e18: e3540000 cmp r4, #0 ; 0x0
6e1c: 1a000008 bne 6e44 <_Objects_Id_to_name+0x80>
return OBJECTS_INVALID_ID;
the_object = _Objects_Get( information, tmpId, &ignored_location );
6e20: e1a0200d mov r2, sp
6e24: ebffffcb bl 6d58 <_Objects_Get>
if ( !the_object )
6e28: e3500000 cmp r0, #0 ; 0x0
6e2c: 0a000004 beq 6e44 <_Objects_Id_to_name+0x80>
return OBJECTS_INVALID_ID;
*name = the_object->name;
6e30: e590300c ldr r3, [r0, #12]
6e34: e5853000 str r3, [r5]
_Thread_Enable_dispatch();
6e38: eb000216 bl 7698 <_Thread_Enable_dispatch>
6e3c: e1a00004 mov r0, r4
6e40: ea000000 b 6e48 <_Objects_Id_to_name+0x84>
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
6e44: e3a00003 mov r0, #3 ; 0x3
}
6e48: e28dd004 add sp, sp, #4 ; 0x4
6e4c: e8bd8030 pop {r4, r5, pc}
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
if ( !_Objects_Information_table[ the_api ] )
6e50: e59f3010 ldr r3, [pc, #16] ; 6e68 <_Objects_Id_to_name+0xa4>
6e54: e7930100 ldr r0, [r3, r0, lsl #2]
6e58: e3500000 cmp r0, #0 ; 0x0
6e5c: 1affffe8 bne 6e04 <_Objects_Id_to_name+0x40>
6e60: eafffff7 b 6e44 <_Objects_Id_to_name+0x80> <== NOT EXECUTED
00005a98 <_Objects_Namespace_remove>:
)
{
/*
* If this is a string format name, then free the memory.
*/
if ( information->is_string && the_object->name.name_p )
5a98: e5d03038 ldrb r3, [r0, #56]
5a9c: e3530000 cmp r3, #0 ; 0x0
void _Objects_Namespace_remove(
Objects_Information *information,
Objects_Control *the_object
)
{
5aa0: e92d4010 push {r4, lr}
5aa4: e1a04001 mov r4, r1
/*
* If this is a string format name, then free the memory.
*/
if ( information->is_string && the_object->name.name_p )
5aa8: 0a000002 beq 5ab8 <_Objects_Namespace_remove+0x20>
5aac: e591000c ldr r0, [r1, #12] <== NOT EXECUTED
5ab0: e3500000 cmp r0, #0 ; 0x0 <== NOT EXECUTED
_Workspace_Free( (void *)the_object->name.name_p );
5ab4: 1b0006b8 blne 759c <_Workspace_Free> <== NOT EXECUTED
/*
* Clear out either format.
*/
the_object->name.name_p = NULL;
5ab8: e3a03000 mov r3, #0 ; 0x0
the_object->name.name_u32 = 0;
5abc: e584300c str r3, [r4, #12]
}
5ac0: e8bd8010 pop {r4, pc}
00007734 <_Objects_Set_name>:
bool _Objects_Set_name(
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
7734: e92d40f0 push {r4, r5, r6, r7, lr}
7738: e1a04000 mov r4, r0
773c: e1a07001 mov r7, r1
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length ) + 1;
7740: e1a00002 mov r0, r2
7744: e1d413ba ldrh r1, [r4, #58]
bool _Objects_Set_name(
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
7748: e1a06002 mov r6, r2
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length ) + 1;
774c: eb001ade bl e2cc <strnlen>
if ( information->is_string ) {
7750: e5d43038 ldrb r3, [r4, #56]
7754: e3530000 cmp r3, #0 ; 0x0
{
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length ) + 1;
7758: e2804001 add r4, r0, #1 ; 0x1
if ( information->is_string ) {
775c: 0a000013 beq 77b0 <_Objects_Set_name+0x7c>
char *d;
d = _Workspace_Allocate( length );
7760: e1a00004 mov r0, r4 <== NOT EXECUTED
7764: eb0006c3 bl 9278 <_Workspace_Allocate> <== NOT EXECUTED
if ( !d )
7768: e2505000 subs r5, r0, #0 ; 0x0 <== NOT EXECUTED
776c: 01a00005 moveq r0, r5 <== NOT EXECUTED
7770: 08bd80f0 popeq {r4, r5, r6, r7, pc} <== NOT EXECUTED
return FALSE;
if ( the_object->name.name_p ) {
7774: e597000c ldr r0, [r7, #12] <== NOT EXECUTED
7778: e3500000 cmp r0, #0 ; 0x0 <== NOT EXECUTED
777c: 0a000002 beq 778c <_Objects_Set_name+0x58> <== NOT EXECUTED
_Workspace_Free( (void *)the_object->name.name_p );
7780: eb0006b8 bl 9268 <_Workspace_Free> <== NOT EXECUTED
the_object->name.name_p = NULL;
7784: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
7788: e587300c str r3, [r7, #12] <== NOT EXECUTED
}
strncpy( d, name, length );
778c: e1a01006 mov r1, r6 <== NOT EXECUTED
7790: e1a00005 mov r0, r5 <== NOT EXECUTED
7794: e1a02004 mov r2, r4 <== NOT EXECUTED
7798: eb001a88 bl e1c0 <strncpy> <== NOT EXECUTED
d[ length ] = '\0';
779c: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
77a0: e7c53004 strb r3, [r5, r4] <== NOT EXECUTED
the_object->name.name_p = d;
77a4: e3a00001 mov r0, #1 ; 0x1 <== NOT EXECUTED
77a8: e587500c str r5, [r7, #12] <== NOT EXECUTED
77ac: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED
} else {
the_object->name.name_u32 = _Objects_Build_name(
77b0: e3540000 cmp r4, #0 ; 0x0
77b4: 03a0c202 moveq ip, #536870912 ; 0x20000000
77b8: 0a000015 beq 7814 <_Objects_Set_name+0xe0>
77bc: e5d63000 ldrb r3, [r6]
77c0: e3540001 cmp r4, #1 ; 0x1
77c4: e1a0cc03 lsl ip, r3, #24
77c8: 0a000011 beq 7814 <_Objects_Set_name+0xe0>
77cc: e5d63001 ldrb r3, [r6, #1]
77d0: e3540002 cmp r4, #2 ; 0x2
77d4: e1a01803 lsl r1, r3, #16
77d8: 9a00000a bls 7808 <_Objects_Set_name+0xd4>
77dc: e3540003 cmp r4, #3 ; 0x3
77e0: e5d63002 ldrb r3, [r6, #2]
77e4: 85d60003 ldrbhi r0, [r6, #3]
77e8: e1a02403 lsl r2, r3, #8
77ec: 93a00020 movls r0, #32 ; 0x20
77f0: e18c3001 orr r3, ip, r1
77f4: e1833002 orr r3, r3, r2
77f8: e1833000 orr r3, r3, r0
77fc: e587300c str r3, [r7, #12]
7800: e3a00001 mov r0, #1 ; 0x1
);
}
return TRUE;
}
7804: e8bd80f0 pop {r4, r5, r6, r7, pc}
strncpy( d, name, length );
d[ length ] = '\0';
the_object->name.name_p = d;
} else {
the_object->name.name_u32 = _Objects_Build_name(
7808: e3a00020 mov r0, #32 ; 0x20
780c: e3a02a02 mov r2, #8192 ; 0x2000
7810: eafffff6 b 77f0 <_Objects_Set_name+0xbc>
7814: e3a01602 mov r1, #2097152 ; 0x200000
7818: eafffffa b 7808 <_Objects_Set_name+0xd4>
00009004 <_Protected_heap_Get_information>:
bool _Protected_heap_Get_information(
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
9004: e92d4070 push {r4, r5, r6, lr}
Heap_Get_information_status status;
if ( !the_heap )
9008: e2506000 subs r6, r0, #0 ; 0x0
bool _Protected_heap_Get_information(
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
900c: e1a04001 mov r4, r1
Heap_Get_information_status status;
if ( !the_heap )
9010: 0a00000d beq 904c <_Protected_heap_Get_information+0x48>
return false;
if ( !the_info )
9014: e3510000 cmp r1, #0 ; 0x0
9018: 0a00000b beq 904c <_Protected_heap_Get_information+0x48>
return false;
_RTEMS_Lock_allocator();
901c: e59f5030 ldr r5, [pc, #48] ; 9054 <_Protected_heap_Get_information+0x50>
9020: e5950000 ldr r0, [r5]
9024: ebfff9df bl 77a8 <_API_Mutex_Lock>
status = _Heap_Get_information( the_heap, the_info );
9028: e1a01004 mov r1, r4
902c: e1a00006 mov r0, r6
9030: eb000ef1 bl cbfc <_Heap_Get_information>
9034: e1a04000 mov r4, r0
_RTEMS_Unlock_allocator();
9038: e5950000 ldr r0, [r5]
903c: ebfff9f5 bl 7818 <_API_Mutex_Unlock>
if ( status == HEAP_GET_INFORMATION_SUCCESSFUL )
9040: e2740001 rsbs r0, r4, #1 ; 0x1
9044: 33a00000 movcc r0, #0 ; 0x0
9048: e8bd8070 pop {r4, r5, r6, pc}
904c: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED
return true;
return false;
}
9050: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED
00004710 <_RTEMS_tasks_Initialize_user_tasks_body>:
rtems_status_code return_value;
rtems_initialization_tasks_table *user_tasks;
rtems_api_configuration_table *api_configuration;
api_configuration = _Configuration_Table->RTEMS_api_configuration;
4710: e59f3094 ldr r3, [pc, #148] ; 47ac <_RTEMS_tasks_Initialize_user_tasks_body+0x9c>
4714: e5933000 ldr r3, [r3]
*
* Output parameters: NONE
*/
void _RTEMS_tasks_Initialize_user_tasks_body( void )
{
4718: e92d40f0 push {r4, r5, r6, r7, lr}
rtems_status_code return_value;
rtems_initialization_tasks_table *user_tasks;
rtems_api_configuration_table *api_configuration;
api_configuration = _Configuration_Table->RTEMS_api_configuration;
471c: e5933040 ldr r3, [r3, #64]
/*
* NOTE: This is slightly different from the Ada implementation.
*/
user_tasks = api_configuration->User_initialization_tasks_table;
4720: e593002c ldr r0, [r3, #44]
maximum = api_configuration->number_of_initialization_tasks;
4724: e5936028 ldr r6, [r3, #40]
if ( !user_tasks || maximum == 0 )
4728: e3560000 cmp r6, #0 ; 0x0
472c: 13500000 cmpne r0, #0 ; 0x0
*
* Output parameters: NONE
*/
void _RTEMS_tasks_Initialize_user_tasks_body( void )
{
4730: e24dd00c sub sp, sp, #12 ; 0xc
*/
user_tasks = api_configuration->User_initialization_tasks_table;
maximum = api_configuration->number_of_initialization_tasks;
if ( !user_tasks || maximum == 0 )
4734: 13a03000 movne r3, #0 ; 0x0
4738: 03a03001 moveq r3, #1 ; 0x1
return;
473c: 11a04000 movne r4, r0
4740: 11a05003 movne r5, r3
for ( index=0 ; index < maximum ; index++ ) {
return_value = rtems_task_create(
4744: 128d7008 addne r7, sp, #8 ; 0x8
*/
user_tasks = api_configuration->User_initialization_tasks_table;
maximum = api_configuration->number_of_initialization_tasks;
if ( !user_tasks || maximum == 0 )
4748: 1a000013 bne 479c <_RTEMS_tasks_Initialize_user_tasks_body+0x8c>
474c: ea000014 b 47a4 <_RTEMS_tasks_Initialize_user_tasks_body+0x94><== NOT EXECUTED
return;
for ( index=0 ; index < maximum ; index++ ) {
return_value = rtems_task_create(
4750: e594300c ldr r3, [r4, #12]
4754: e88d0088 stm sp, {r3, r7}
4758: e8940005 ldm r4, {r0, r2}
475c: e5941008 ldr r1, [r4, #8]
4760: e5943014 ldr r3, [r4, #20]
4764: ebffff63 bl 44f8 <rtems_task_create>
user_tasks[ index ].mode_set,
user_tasks[ index ].attribute_set,
&id
);
if ( !rtems_is_status_successful( return_value ) )
4768: e2502000 subs r2, r0, #0 ; 0x0
476c: 1a000006 bne 478c <_RTEMS_tasks_Initialize_user_tasks_body+0x7c>
_Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, TRUE, return_value );
return_value = rtems_task_start(
4770: e5942018 ldr r2, [r4, #24]
4774: e5941010 ldr r1, [r4, #16]
4778: e59d0008 ldr r0, [sp, #8]
477c: eb00000b bl 47b0 <rtems_task_start>
id,
user_tasks[ index ].entry_point,
user_tasks[ index ].argument
);
if ( !rtems_is_status_successful( return_value ) )
4780: e2502000 subs r2, r0, #0 ; 0x0
);
if ( !rtems_is_status_successful( return_value ) )
_Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, TRUE, return_value );
return_value = rtems_task_start(
4784: e284401c add r4, r4, #28 ; 0x1c
id,
user_tasks[ index ].entry_point,
user_tasks[ index ].argument
);
if ( !rtems_is_status_successful( return_value ) )
4788: 0a000002 beq 4798 <_RTEMS_tasks_Initialize_user_tasks_body+0x88>
_Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, TRUE, return_value );
478c: e3a00001 mov r0, #1 ; 0x1
4790: e1a01000 mov r1, r0
4794: eb000333 bl 5468 <_Internal_error_Occurred>
maximum = api_configuration->number_of_initialization_tasks;
if ( !user_tasks || maximum == 0 )
return;
for ( index=0 ; index < maximum ; index++ ) {
4798: e2855001 add r5, r5, #1 ; 0x1
479c: e1550006 cmp r5, r6
47a0: 3affffea bcc 4750 <_RTEMS_tasks_Initialize_user_tasks_body+0x40>
);
if ( !rtems_is_status_successful( return_value ) )
_Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, TRUE, return_value );
}
}
47a4: e28dd00c add sp, sp, #12 ; 0xc
47a8: e8bd80f0 pop {r4, r5, r6, r7, pc}
000044d8 <_Semaphore_Translate_core_mutex_return_code>:
};
rtems_status_code _Semaphore_Translate_core_mutex_return_code (
uint32_t status
)
{
44d8: e59f3004 ldr r3, [pc, #4] ; 44e4 <_Semaphore_Translate_core_mutex_return_code+0xc>
#if defined(RTEMS_DEBUG)
if ( status > CORE_MUTEX_STATUS_LAST )
return RTEMS_INTERNAL_ERROR;
#endif
return _Semaphore_Translate_core_mutex_return_code_[status];
}
44dc: e7930100 ldr r0, [r3, r0, lsl #2]
44e0: e12fff1e bx lr
00005118 <_TOD_Get>:
*/
void _TOD_Get(
struct timespec *time
)
{
5118: e92d4070 push {r4, r5, r6, lr}
ISR_Level level;
struct timespec offset;
/* assume time checked by caller */
offset.tv_sec = 0;
511c: e3a03000 mov r3, #0 ; 0x0
*/
void _TOD_Get(
struct timespec *time
)
{
5120: e24dd008 sub sp, sp, #8 ; 0x8
struct timespec offset;
/* assume time checked by caller */
offset.tv_sec = 0;
offset.tv_nsec = 0;
5124: e58d3004 str r3, [sp, #4]
*/
void _TOD_Get(
struct timespec *time
)
{
5128: e1a05000 mov r5, r0
ISR_Level level;
struct timespec offset;
/* assume time checked by caller */
offset.tv_sec = 0;
512c: e58d3000 str r3, [sp]
offset.tv_nsec = 0;
/* _TOD_Now is a proper POSIX time */
_ISR_Disable( level );
5130: e10f6000 mrs r6, CPSR
5134: e38630c0 orr r3, r6, #192 ; 0xc0
5138: e129f003 msr CPSR_fc, r3
*time = _TOD_Now;
if ( _Watchdog_Nanoseconds_since_tick_handler )
513c: e59f3038 ldr r3, [pc, #56] ; 517c <_TOD_Get+0x64>
5140: e5932000 ldr r2, [r3]
offset.tv_sec = 0;
offset.tv_nsec = 0;
/* _TOD_Now is a proper POSIX time */
_ISR_Disable( level );
*time = _TOD_Now;
5144: e59f3034 ldr r3, [pc, #52] ; 5180 <_TOD_Get+0x68>
5148: e8930018 ldm r3, {r3, r4}
if ( _Watchdog_Nanoseconds_since_tick_handler )
514c: e3520000 cmp r2, #0 ; 0x0
offset.tv_sec = 0;
offset.tv_nsec = 0;
/* _TOD_Now is a proper POSIX time */
_ISR_Disable( level );
*time = _TOD_Now;
5150: e8800018 stm r0, {r3, r4}
if ( _Watchdog_Nanoseconds_since_tick_handler )
5154: 0a000002 beq 5164 <_TOD_Get+0x4c>
offset.tv_nsec = (*_Watchdog_Nanoseconds_since_tick_handler)();
5158: e1a0e00f mov lr, pc <== NOT EXECUTED
515c: e12fff12 bx r2 <== NOT EXECUTED
5160: e58d0004 str r0, [sp, #4] <== NOT EXECUTED
_ISR_Enable( level );
5164: e129f006 msr CPSR_fc, r6
_Timespec_Add_to( time, &offset );
5168: e1a00005 mov r0, r5
516c: e1a0100d mov r1, sp
5170: eb000794 bl 6fc8 <_Timespec_Add_to>
}
5174: e28dd008 add sp, sp, #8 ; 0x8
5178: e8bd8070 pop {r4, r5, r6, pc}
00009688 <_TOD_Get_uptime>:
*/
void _TOD_Get_uptime(
struct timespec *uptime
)
{
9688: e92d4070 push {r4, r5, r6, lr}
ISR_Level level;
struct timespec offset;
/* assume uptime checked by caller */
offset.tv_sec = 0;
968c: e3a03000 mov r3, #0 ; 0x0
*/
void _TOD_Get_uptime(
struct timespec *uptime
)
{
9690: e24dd008 sub sp, sp, #8 ; 0x8
struct timespec offset;
/* assume uptime checked by caller */
offset.tv_sec = 0;
offset.tv_nsec = 0;
9694: e58d3004 str r3, [sp, #4]
*/
void _TOD_Get_uptime(
struct timespec *uptime
)
{
9698: e1a05000 mov r5, r0
ISR_Level level;
struct timespec offset;
/* assume uptime checked by caller */
offset.tv_sec = 0;
969c: e58d3000 str r3, [sp]
offset.tv_nsec = 0;
_ISR_Disable( level );
96a0: e10f6000 mrs r6, CPSR
96a4: e38630c0 orr r3, r6, #192 ; 0xc0
96a8: e129f003 msr CPSR_fc, r3
*uptime = _TOD_Uptime;
if ( _Watchdog_Nanoseconds_since_tick_handler )
96ac: e59f3038 ldr r3, [pc, #56] ; 96ec <_TOD_Get_uptime+0x64>
96b0: e5932000 ldr r2, [r3]
offset.tv_sec = 0;
offset.tv_nsec = 0;
_ISR_Disable( level );
*uptime = _TOD_Uptime;
96b4: e59f3034 ldr r3, [pc, #52] ; 96f0 <_TOD_Get_uptime+0x68>
96b8: e8930018 ldm r3, {r3, r4}
if ( _Watchdog_Nanoseconds_since_tick_handler )
96bc: e3520000 cmp r2, #0 ; 0x0
offset.tv_sec = 0;
offset.tv_nsec = 0;
_ISR_Disable( level );
*uptime = _TOD_Uptime;
96c0: e8800018 stm r0, {r3, r4}
if ( _Watchdog_Nanoseconds_since_tick_handler )
96c4: 0a000002 beq 96d4 <_TOD_Get_uptime+0x4c>
offset.tv_nsec = (*_Watchdog_Nanoseconds_since_tick_handler)();
96c8: e1a0e00f mov lr, pc <== NOT EXECUTED
96cc: e12fff12 bx r2 <== NOT EXECUTED
96d0: e58d0004 str r0, [sp, #4] <== NOT EXECUTED
_ISR_Enable( level );
96d4: e129f006 msr CPSR_fc, r6
_Timespec_Add_to( uptime, &offset );
96d8: e1a00005 mov r0, r5
96dc: e1a0100d mov r1, sp
96e0: ebfff638 bl 6fc8 <_Timespec_Add_to>
}
96e4: e28dd008 add sp, sp, #8 ; 0x8
96e8: e8bd8070 pop {r4, r5, r6, pc}
0000607c <_Thread_Delay_ended>:
void _Thread_Delay_ended(
Objects_Id id,
void *ignored
)
{
607c: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED
6080: e24dd004 sub sp, sp, #4 ; 0x4 <== NOT EXECUTED
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
6084: e1a0100d mov r1, sp <== NOT EXECUTED
6088: eb000067 bl 622c <_Thread_Get> <== NOT EXECUTED
switch ( location ) {
608c: e59d3000 ldr r3, [sp] <== NOT EXECUTED
6090: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED
6094: 1a000005 bne 60b0 <_Thread_Delay_ended+0x34> <== NOT EXECUTED
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
6098: e59f1018 ldr r1, [pc, #24] ; 60b8 <_Thread_Delay_ended+0x3c><== NOT EXECUTED
609c: ebffff59 bl 5e08 <_Thread_Clear_state> <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
60a0: e59f2014 ldr r2, [pc, #20] ; 60bc <_Thread_Delay_ended+0x40><== NOT EXECUTED
60a4: e5923000 ldr r3, [r2] <== NOT EXECUTED
60a8: e2433001 sub r3, r3, #1 ; 0x1 <== NOT EXECUTED
60ac: e5823000 str r3, [r2] <== NOT EXECUTED
case OBJECTS_LOCAL:
_Thread_Unblock( the_thread );
_Thread_Unnest_dispatch();
break;
}
}
60b0: e28dd004 add sp, sp, #4 ; 0x4 <== NOT EXECUTED
60b4: e8bd8000 pop {pc} <== NOT EXECUTED
0000622c <_Thread_Get>:
Thread_Control *_Thread_Get (
Objects_Id id,
Objects_Locations *location
)
{
622c: e92d4010 push {r4, lr}
uint32_t the_class;
Objects_Information **api_information;
Objects_Information *information;
Thread_Control *tp = (Thread_Control *) 0;
if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) {
6230: e2504000 subs r4, r0, #0 ; 0x0
Thread_Control *_Thread_Get (
Objects_Id id,
Objects_Locations *location
)
{
6234: e1a0c001 mov ip, r1
uint32_t the_class;
Objects_Information **api_information;
Objects_Information *information;
Thread_Control *tp = (Thread_Control *) 0;
if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) {
6238: 1a000007 bne 625c <_Thread_Get+0x30>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
623c: e59f3080 ldr r3, [pc, #128] ; 62c4 <_Thread_Get+0x98>
6240: e5932000 ldr r2, [r3]
6244: e2822001 add r2, r2, #1 ; 0x1
6248: e5832000 str r2, [r3]
_Thread_Disable_dispatch();
*location = OBJECTS_LOCAL;
tp = _Thread_Executing;
624c: e59f3074 ldr r3, [pc, #116] ; 62c8 <_Thread_Get+0x9c>
Objects_Information *information;
Thread_Control *tp = (Thread_Control *) 0;
if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) {
_Thread_Disable_dispatch();
*location = OBJECTS_LOCAL;
6250: e5814000 str r4, [r1]
tp = _Thread_Executing;
6254: e5930000 ldr r0, [r3]
6258: e8bd8010 pop {r4, pc}
*/
RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API(
Objects_Id id
)
{
return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS);
625c: e1a03c24 lsr r3, r4, #24
6260: e2031007 and r1, r3, #7 ; 0x7
*/
RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid(
uint32_t the_api
)
{
if ( !the_api || the_api > OBJECTS_APIS_LAST )
6264: e2413001 sub r3, r1, #1 ; 0x1
6268: e3530003 cmp r3, #3 ; 0x3
626c: 9a000010 bls 62b4 <_Thread_Get+0x88>
goto done;
}
the_class = _Objects_Get_class( id );
if ( the_class != 1 ) { /* threads are always first class :) */
*location = OBJECTS_ERROR;
6270: e3a03001 mov r3, #1 ; 0x1 <== NOT EXECUTED
6274: e58c3000 str r3, [ip] <== NOT EXECUTED
6278: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED
627c: e8bd8010 pop {r4, pc} <== NOT EXECUTED
goto done;
}
api_information = _Objects_Information_table[ the_api ];
6280: e59f3044 ldr r3, [pc, #68] ; 62cc <_Thread_Get+0xa0>
6284: e7930101 ldr r0, [r3, r1, lsl #2]
if ( !api_information ) {
6288: e3500000 cmp r0, #0 ; 0x0
628c: 0a000002 beq 629c <_Thread_Get+0x70>
*location = OBJECTS_ERROR;
goto done;
}
information = api_information[ the_class ];
6290: e5900004 ldr r0, [r0, #4]
if ( !information ) {
6294: e3500000 cmp r0, #0 ; 0x0
6298: 1a000001 bne 62a4 <_Thread_Get+0x78>
*location = OBJECTS_ERROR;
629c: e58c2000 str r2, [ip] <== NOT EXECUTED
62a0: e8bd8010 pop {r4, pc} <== NOT EXECUTED
goto done;
}
tp = (Thread_Control *) _Objects_Get( information, id, location );
62a4: e1a01004 mov r1, r4
62a8: e1a0200c mov r2, ip
done:
return tp;
}
62ac: e8bd4010 pop {r4, lr}
if ( !information ) {
*location = OBJECTS_ERROR;
goto done;
}
tp = (Thread_Control *) _Objects_Get( information, id, location );
62b0: eafffdae b 5970 <_Objects_Get>
*location = OBJECTS_ERROR;
goto done;
}
the_class = _Objects_Get_class( id );
if ( the_class != 1 ) { /* threads are always first class :) */
62b4: e1a02da4 lsr r2, r4, #27
62b8: e3520001 cmp r2, #1 ; 0x1
62bc: 0affffef beq 6280 <_Thread_Get+0x54>
62c0: eaffffea b 6270 <_Thread_Get+0x44> <== NOT EXECUTED
0000a658 <_Thread_Handler>:
#if defined(__USE_INIT_FINI__) || defined(__USE__MAIN__)
static char doneConstructors;
char doneCons;
#endif
executing = _Thread_Executing;
a658: e59f30b0 ldr r3, [pc, #176] ; a710 <_Thread_Handler+0xb8>
*
* Output parameters: NONE
*/
void _Thread_Handler( void )
{
a65c: e92d4030 push {r4, r5, lr}
#if defined(__USE_INIT_FINI__) || defined(__USE__MAIN__)
static char doneConstructors;
char doneCons;
#endif
executing = _Thread_Executing;
a660: e5935000 ldr r5, [r3]
/*
* have to put level into a register for those cpu's that use
* inline asm here
*/
level = executing->Start.isr_level;
a664: e59530b8 ldr r3, [r5, #184]
_ISR_Set_level(level);
a668: e3a02000 mov r2, #0 ; 0x0
a66c: e10f2000 mrs r2, CPSR
a670: e3c220c0 bic r2, r2, #192 ; 0xc0
a674: e1822003 orr r2, r2, r3
a678: e121f002 msr CPSR_c, r2
#if defined(__USE_INIT_FINI__) || defined(__USE__MAIN__)
doneCons = doneConstructors;
a67c: e59f2090 ldr r2, [pc, #144] ; a714 <_Thread_Handler+0xbc>
doneConstructors = 1;
a680: e3a03001 mov r3, #1 ; 0x1
level = executing->Start.isr_level;
_ISR_Set_level(level);
#if defined(__USE_INIT_FINI__) || defined(__USE__MAIN__)
doneCons = doneConstructors;
a684: e5d24000 ldrb r4, [r2]
* 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 );
a688: e1a00005 mov r0, r5
level = executing->Start.isr_level;
_ISR_Set_level(level);
#if defined(__USE_INIT_FINI__) || defined(__USE__MAIN__)
doneCons = doneConstructors;
doneConstructors = 1;
a68c: e5c23000 strb r3, [r2]
* 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 );
a690: ebfff29a bl 7100 <_User_extensions_Thread_begin>
/*
* At this point, the dispatch disable level BETTER be 1.
*/
_Thread_Enable_dispatch();
a694: ebffeedb bl 6208 <_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) */
a698: e3540000 cmp r4, #0 ; 0x0
{
_init ();
a69c: 0bffd69f bleq 120 <_init>
#if defined(__USE__MAIN__)
if (!doneCons && _main)
__main ();
#endif
switch ( executing->Start.prototype ) {
a6a0: e59530a0 ldr r3, [r5, #160]
a6a4: e3530003 cmp r3, #3 ; 0x3
a6a8: 979ff103 ldrls pc, [pc, r3, lsl #2]
a6ac: ea000011 b a6f8 <_Thread_Handler+0xa0> <== NOT EXECUTED
a6b0: 0000a6c0 .word 0x0000a6c0 <== NOT EXECUTED
a6b4: 0000a6c8 .word 0x0000a6c8 <== NOT EXECUTED
a6b8: 0000a6d8 .word 0x0000a6d8 <== NOT EXECUTED
a6bc: 0000a6e4 .word 0x0000a6e4 <== NOT EXECUTED
case THREAD_START_NUMERIC:
executing->Wait.return_argument =
a6c0: e59500a8 ldr r0, [r5, #168]
a6c4: ea000000 b a6cc <_Thread_Handler+0x74>
(*(Thread_Entry_numeric) executing->Start.entry_point)(
executing->Start.numeric_argument
);
break;
case THREAD_START_POINTER:
executing->Wait.return_argument =
a6c8: e59500a4 ldr r0, [r5, #164] <== NOT EXECUTED
a6cc: e1a0e00f mov lr, pc
a6d0: e595f09c ldr pc, [r5, #156]
a6d4: ea000006 b a6f4 <_Thread_Handler+0x9c>
(*(Thread_Entry_pointer) executing->Start.entry_point)(
executing->Start.pointer_argument
);
break;
case THREAD_START_BOTH_POINTER_FIRST:
executing->Wait.return_argument =
a6d8: e28500a4 add r0, r5, #164 ; 0xa4 <== NOT EXECUTED
a6dc: e8900003 ldm r0, {r0, r1} <== NOT EXECUTED
a6e0: ea000001 b a6ec <_Thread_Handler+0x94> <== NOT EXECUTED
executing->Start.pointer_argument,
executing->Start.numeric_argument
);
break;
case THREAD_START_BOTH_NUMERIC_FIRST:
executing->Wait.return_argument =
a6e4: e59500a8 ldr r0, [r5, #168] <== NOT EXECUTED
a6e8: e59510a4 ldr r1, [r5, #164] <== NOT EXECUTED
a6ec: e1a0e00f mov lr, pc <== NOT EXECUTED
a6f0: e595f09c ldr pc, [r5, #156] <== NOT EXECUTED
a6f4: e5850028 str r0, [r5, #40]
* 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 );
a6f8: e1a00005 mov r0, r5
a6fc: ebfff28e bl 713c <_User_extensions_Thread_exitted>
_Internal_error_Occurred(
a700: e3a00000 mov r0, #0 ; 0x0
a704: e3a01001 mov r1, #1 ; 0x1
a708: e3a02006 mov r2, #6 ; 0x6
a70c: ebffeb55 bl 5468 <_Internal_error_Occurred>
000062d4 <_Thread_Initialize>:
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
62d4: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr}
/*
* Allocate and Initialize the stack for this thread.
*/
if ( !stack_area ) {
62d8: e2526000 subs r6, r2, #0 ; 0x0
Thread_CPU_budget_algorithms budget_algorithm,
Thread_CPU_budget_algorithm_callout budget_callout,
uint32_t isr_level,
Objects_Name name
)
{
62dc: e1a09000 mov r9, r0
62e0: e1a05001 mov r5, r1
62e4: e1a04003 mov r4, r3
62e8: e59d8024 ldr r8, [sp, #36]
62ec: e59da02c ldr sl, [sp, #44]
62f0: e5dd7028 ldrb r7, [sp, #40]
/*
* Allocate and Initialize the stack for this thread.
*/
if ( !stack_area ) {
62f4: 1a00000e bne 6334 <_Thread_Initialize+0x60>
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
62f8: e1a00001 mov r0, r1
62fc: e1a01003 mov r1, r3
6300: eb000292 bl 6d50 <_Thread_Stack_Allocate>
if ( !actual_stack_size || actual_stack_size < stack_size )
6304: e1500004 cmp r0, r4
6308: 23a03000 movcs r3, #0 ; 0x0
630c: 33a03001 movcc r3, #1 ; 0x1
6310: e3500000 cmp r0, #0 ; 0x0
6314: 03833001 orreq r3, r3, #1 ; 0x1
6318: e3530000 cmp r3, #0 ; 0x0
return FALSE; /* stack allocation failed */
stack = the_thread->Start.stack;
the_thread->Start.core_allocated_stack = TRUE;
631c: 03a03001 moveq r3, #1 ; 0x1
if ( !stack_area ) {
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
if ( !actual_stack_size || actual_stack_size < stack_size )
6320: e1a01000 mov r1, r0
return FALSE; /* stack allocation failed */
stack = the_thread->Start.stack;
the_thread->Start.core_allocated_stack = TRUE;
6324: 05c530c0 strbeq r3, [r5, #192]
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;
6328: 059520cc ldreq r2, [r5, #204]
if ( !stack_area ) {
actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size );
if ( !actual_stack_size || actual_stack_size < stack_size )
632c: 0a000004 beq 6344 <_Thread_Initialize+0x70>
6330: ea000017 b 6394 <_Thread_Initialize+0xc0> <== NOT EXECUTED
stack = the_thread->Start.stack;
the_thread->Start.core_allocated_stack = TRUE;
} else {
stack = stack_area;
actual_stack_size = stack_size;
the_thread->Start.core_allocated_stack = FALSE;
6334: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
6338: e5c130c0 strb r3, [r1, #192] <== NOT EXECUTED
633c: e1a02006 mov r2, r6 <== NOT EXECUTED
6340: e1a01004 mov r1, r4 <== NOT EXECUTED
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
6344: e59f3128 ldr r3, [pc, #296] ; 6474 <_Thread_Initialize+0x1a0>
6348: e5930000 ldr r0, [r3]
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
634c: e3a03000 mov r3, #0 ; 0x0
6350: e3500000 cmp r0, #0 ; 0x0
Stack_Control *the_stack,
void *starting_address,
size_t size
)
{
the_stack->area = starting_address;
6354: e58520c8 str r2, [r5, #200]
the_stack->size = size;
6358: e58510c4 str r1, [r5, #196]
/*
* Clear the libc reent hook.
*/
the_thread->libc_reent = NULL;
635c: e5853100 str r3, [r5, #256]
6360: e5853050 str r3, [r5, #80]
the_watchdog->routine = routine;
6364: e5853064 str r3, [r5, #100]
the_watchdog->id = id;
6368: e5853068 str r3, [r5, #104]
the_watchdog->user_data = user_data;
636c: e585306c str r3, [r5, #108]
(void) _Workspace_Free( fp_area );
#endif
_Thread_Stack_Free( the_thread );
return FALSE;
6370: 01a06000 moveq r6, r0
/*
* Allocate the extensions area for this thread
*/
if ( _Thread_Maximum_extensions ) {
6374: 0a000008 beq 639c <_Thread_Initialize+0xc8>
extensions_area = _Workspace_Allocate(
6378: e2800001 add r0, r0, #1 ; 0x1 <== NOT EXECUTED
637c: e1a00100 lsl r0, r0, #2 <== NOT EXECUTED
6380: eb000489 bl 75ac <_Workspace_Allocate> <== NOT EXECUTED
(_Thread_Maximum_extensions + 1) * sizeof( void * )
);
if ( !extensions_area ) {
6384: e2506000 subs r6, r0, #0 ; 0x0 <== NOT EXECUTED
6388: 1a000003 bne 639c <_Thread_Initialize+0xc8> <== NOT EXECUTED
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( fp_area )
(void) _Workspace_Free( fp_area );
#endif
_Thread_Stack_Free( the_thread );
638c: e1a00005 mov r0, r5 <== NOT EXECUTED
6390: eb000289 bl 6dbc <_Thread_Stack_Free> <== NOT EXECUTED
6394: e1a00006 mov r0, r6 <== NOT EXECUTED
6398: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} <== NOT EXECUTED
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
639c: e3560000 cmp r6, #0 ; 0x0
return FALSE;
}
} else
extensions_area = NULL;
the_thread->extensions = (void **) extensions_area;
63a0: e5856110 str r6, [r5, #272]
* create the extension long after tasks have been created
* so they cannot rely on the thread create user extension
* call.
*/
if ( the_thread->extensions ) {
63a4: 0a00000a beq 63d4 <_Thread_Initialize+0x100>
63a8: e3a02000 mov r2, #0 ; 0x0 <== NOT EXECUTED
uint32_t i;
for ( i = 0; i < (_Thread_Maximum_extensions + 1); i++ )
63ac: e59f00c0 ldr r0, [pc, #192] ; 6474 <_Thread_Initialize+0x1a0><== NOT EXECUTED
the_thread->extensions[i] = NULL;
63b0: e1a01002 mov r1, r2 <== NOT EXECUTED
63b4: ea000002 b 63c4 <_Thread_Initialize+0xf0> <== NOT EXECUTED
63b8: e5953110 ldr r3, [r5, #272] <== NOT EXECUTED
63bc: e7831102 str r1, [r3, r2, lsl #2] <== NOT EXECUTED
* call.
*/
if ( the_thread->extensions ) {
uint32_t i;
for ( i = 0; i < (_Thread_Maximum_extensions + 1); i++ )
63c0: e2822001 add r2, r2, #1 ; 0x1 <== NOT EXECUTED
63c4: e5903000 ldr r3, [r0] <== NOT EXECUTED
63c8: e2833001 add r3, r3, #1 ; 0x1 <== NOT EXECUTED
63cc: e1520003 cmp r2, r3 <== NOT EXECUTED
63d0: 3afffff8 bcc 63b8 <_Thread_Initialize+0xe4> <== NOT EXECUTED
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
63d4: e59d3030 ldr r3, [sp, #48]
switch ( budget_algorithm ) {
63d8: e35a0002 cmp sl, #2 ; 0x2
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
the_thread->Start.budget_callout = budget_callout;
63dc: e58530b4 str r3, [r5, #180]
switch ( budget_algorithm ) {
case THREAD_CPU_BUDGET_ALGORITHM_NONE:
case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE:
break;
case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE:
the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice;
63e0: 059f3090 ldreq r3, [pc, #144] ; 6478 <_Thread_Initialize+0x1a4>
63e4: 05933000 ldreq r3, [r3]
63e8: 05853078 streq r3, [r5, #120]
break;
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
}
the_thread->Start.isr_level = isr_level;
63ec: e59d3034 ldr r3, [sp, #52]
the_thread->current_state = STATES_DORMANT;
the_thread->Wait.queue = NULL;
63f0: e3a04000 mov r4, #0 ; 0x0
/*
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
63f4: e5c570ac strb r7, [r5, #172]
break;
}
the_thread->Start.isr_level = isr_level;
the_thread->current_state = STATES_DORMANT;
63f8: e3a07001 mov r7, #1 ; 0x1
break;
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
break;
}
the_thread->Start.isr_level = isr_level;
63fc: e58530b8 str r3, [r5, #184]
the_thread->Wait.queue = NULL; the_thread->resource_count = 0; the_thread->suspend_count = 0; the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority );
6400: e1a01008 mov r1, r8
6404: e1a00005 mov r0, r5
/*
* General initialization
*/
the_thread->Start.is_preemptible = is_preemptible;
the_thread->Start.budget_algorithm = budget_algorithm;
6408: e585a0b0 str sl, [r5, #176]
break;
}
the_thread->Start.isr_level = isr_level;
the_thread->current_state = STATES_DORMANT;
640c: e5857010 str r7, [r5, #16]
the_thread->Wait.queue = NULL;
6410: e5854044 str r4, [r5, #68]
the_thread->resource_count = 0;
6414: e585401c str r4, [r5, #28]
the_thread->suspend_count = 0;
6418: e5854070 str r4, [r5, #112]
the_thread->real_priority = priority;
641c: e5858018 str r8, [r5, #24]
the_thread->Start.initial_priority = priority;
6420: e58580bc str r8, [r5, #188]
_Thread_Set_priority( the_thread, priority );
6424: eb0001b7 bl 6b08 <_Thread_Set_priority>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
6428: e1d530b8 ldrh r3, [r5, #8]
642c: e599201c ldr r2, [r9, #28]
* Initialize the CPU usage statistics
*/
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
the_thread->cpu_time_used.tv_sec = 0;
the_thread->cpu_time_used.tv_nsec = 0;
6430: e5854088 str r4, [r5, #136]
6434: e7825103 str r5, [r2, r3, lsl #2]
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
6438: e59d3038 ldr r3, [sp, #56]
* 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 );
643c: e1a00005 mov r0, r5
6440: e585300c str r3, [r5, #12]
/*
* Initialize the CPU usage statistics
*/
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
the_thread->cpu_time_used.tv_sec = 0;
6444: e5854084 str r4, [r5, #132]
* 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 );
6448: eb00035f bl 71cc <_User_extensions_Thread_create>
if ( !extension_status ) {
644c: e1500004 cmp r0, r4
6450: 11a00007 movne r0, r7
6454: 18bd87f0 popne {r4, r5, r6, r7, r8, r9, sl, pc}
if ( extensions_area )
6458: e3560000 cmp r6, #0 ; 0x0 <== NOT EXECUTED
(void) _Workspace_Free( extensions_area );
645c: 11a00006 movne r0, r6 <== NOT EXECUTED
6460: 1b00044d blne 759c <_Workspace_Free> <== NOT EXECUTED
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( fp_area )
(void) _Workspace_Free( fp_area );
#endif
_Thread_Stack_Free( the_thread );
6464: e1a00005 mov r0, r5 <== NOT EXECUTED
6468: eb000253 bl 6dbc <_Thread_Stack_Free> <== NOT EXECUTED
646c: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED
return FALSE;
}
return TRUE;
}
6470: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} <== NOT EXECUTED
00007740 <_Thread_Restart>:
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
if ( !_States_Is_dormant( the_thread->current_state ) ) {
7740: e5903010 ldr r3, [r0, #16]
7744: e3130001 tst r3, #1 ; 0x1
bool _Thread_Restart(
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
7748: e92d4070 push {r4, r5, r6, lr}
774c: e1a04000 mov r4, r0
7750: e1a05001 mov r5, r1
7754: e1a06002 mov r6, r2
if ( !_States_Is_dormant( the_thread->current_state ) ) {
7758: 13a00000 movne r0, #0 ; 0x0
775c: 18bd8070 popne {r4, r5, r6, pc}
_Thread_Set_transient( the_thread );
7760: eb000081 bl 796c <_Thread_Set_transient>
_Thread_Reset( the_thread, pointer_argument, numeric_argument );
7764: e1a01005 mov r1, r5
7768: e1a02006 mov r2, r6
776c: e1a00004 mov r0, r4
7770: eb000ced bl ab2c <_Thread_Reset>
_Thread_Load_environment( the_thread );
7774: e1a00004 mov r0, r4
7778: eb000c0d bl a7b4 <_Thread_Load_environment>
_Thread_Ready( the_thread );
777c: e1a00004 mov r0, r4
7780: eb000ca6 bl aa20 <_Thread_Ready>
_User_extensions_Thread_restart( the_thread );
7784: e1a00004 mov r0, r4
7788: eb0001e3 bl 7f1c <_User_extensions_Thread_restart>
if ( _Thread_Is_executing ( the_thread ) )
778c: e59f301c ldr r3, [pc, #28] ; 77b0 <_Thread_Restart+0x70>
7790: e5933000 ldr r3, [r3]
7794: e1540003 cmp r4, r3
7798: 13a00001 movne r0, #1 ; 0x1
779c: 18bd8070 popne {r4, r5, r6, pc}
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( _Thread_Executing->fp_context != NULL )
_Context_Restore_fp( &_Thread_Executing->fp_context );
#endif
_CPU_Context_Restart_self( &_Thread_Executing->Registers );
77a0: e28400d0 add r0, r4, #208 ; 0xd0
77a4: eb0002ec bl 835c <_CPU_Context_restore>
77a8: e3a00001 mov r0, #1 ; 0x1 <== NOT EXECUTED
return TRUE;
}
return FALSE;
}
77ac: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED
00008470 <_Thread_Resume>:
void _Thread_Resume(
Thread_Control *the_thread,
bool force
)
{
8470: e92d4030 push {r4, r5, lr}
8474: e20110ff and r1, r1, #255 ; 0xff
8478: e1a04000 mov r4, r0
ISR_Level level;
States_Control current_state;
_ISR_Disable( level );
847c: e10f5000 mrs r5, CPSR
8480: e38530c0 orr r3, r5, #192 ; 0xc0
8484: e129f003 msr CPSR_fc, r3
if ( force == TRUE )
8488: e3510000 cmp r1, #0 ; 0x0
the_thread->suspend_count = 0;
else
the_thread->suspend_count--;
848c: 05903070 ldreq r3, [r0, #112]
States_Control current_state;
_ISR_Disable( level );
if ( force == TRUE )
the_thread->suspend_count = 0;
8490: 13a03000 movne r3, #0 ; 0x0
else
the_thread->suspend_count--;
8494: 02433001 subeq r3, r3, #1 ; 0x1
8498: e5803070 str r3, [r0, #112]
if ( the_thread->suspend_count > 0 ) {
849c: e5903070 ldr r3, [r0, #112]
84a0: e3530000 cmp r3, #0 ; 0x0
84a4: 0a000001 beq 84b0 <_Thread_Resume+0x40>
_ISR_Enable( level );
84a8: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED
84ac: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED
return;
}
current_state = the_thread->current_state;
84b0: e5903010 ldr r3, [r0, #16]
if ( current_state & STATES_SUSPENDED ) {
84b4: e3130002 tst r3, #2 ; 0x2
84b8: 0a000028 beq 8560 <_Thread_Resume+0xf0>
84bc: e3c33002 bic r3, r3, #2 ; 0x2
current_state =
the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state);
if ( _States_Is_ready( current_state ) ) {
84c0: e3530000 cmp r3, #0 ; 0x0
return;
}
current_state = the_thread->current_state;
if ( current_state & STATES_SUSPENDED ) {
current_state =
84c4: e5803010 str r3, [r0, #16]
the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state);
if ( _States_Is_ready( current_state ) ) {
84c8: 1a000024 bne 8560 <_Thread_Resume+0xf0>
RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
84cc: e5900090 ldr r0, [r0, #144]
84d0: e1d429b6 ldrh r2, [r4, #150]
84d4: e1d030b0 ldrh r3, [r0]
_Priority_Add_to_bit_map( &the_thread->Priority_map );
_Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node);
84d8: e594108c ldr r1, [r4, #140]
84dc: e1833002 orr r3, r3, r2
84e0: e1c030b0 strh r3, [r0]
_Priority_Major_bit_map |= the_priority_map->ready_major;
84e4: e59fc07c ldr ip, [pc, #124] ; 8568 <_Thread_Resume+0xf8>
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
84e8: e2813004 add r3, r1, #4 ; 0x4
84ec: e5843000 str r3, [r4]
84f0: e1d429b4 ldrh r2, [r4, #148]
84f4: e1dc30b0 ldrh r3, [ip]
old_last_node = the_chain->last;
84f8: e5910008 ldr r0, [r1, #8]
84fc: e1833002 orr r3, r3, r2
the_chain->last = the_node;
8500: e5814008 str r4, [r1, #8]
8504: e1cc30b0 strh r3, [ip]
old_last_node->next = the_node; the_node->previous = old_last_node;
8508: e5840004 str r0, [r4, #4]
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
850c: e5804000 str r4, [r0]
_ISR_Flash( level );
8510: e10f3000 mrs r3, CPSR
8514: e129f005 msr CPSR_fc, r5
8518: e129f003 msr CPSR_fc, r3
if ( the_thread->current_priority < _Thread_Heir->current_priority ) {
851c: e59f1048 ldr r1, [pc, #72] ; 856c <_Thread_Resume+0xfc>
8520: e5913000 ldr r3, [r1]
8524: e5942014 ldr r2, [r4, #20]
8528: e5933014 ldr r3, [r3, #20]
852c: e1520003 cmp r2, r3
8530: 2a00000a bcs 8560 <_Thread_Resume+0xf0>
_Thread_Heir = the_thread;
if ( _Thread_Executing->is_preemptible ||
8534: e59f3034 ldr r3, [pc, #52] ; 8570 <_Thread_Resume+0x100>
8538: e5933000 ldr r3, [r3]
853c: e5d33076 ldrb r3, [r3, #118]
8540: e3530000 cmp r3, #0 ; 0x0
_Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node);
_ISR_Flash( level );
if ( the_thread->current_priority < _Thread_Heir->current_priority ) {
_Thread_Heir = the_thread;
8544: e5814000 str r4, [r1]
if ( _Thread_Executing->is_preemptible ||
8548: 1a000001 bne 8554 <_Thread_Resume+0xe4>
854c: e3520000 cmp r2, #0 ; 0x0
8550: 1a000002 bne 8560 <_Thread_Resume+0xf0>
the_thread->current_priority == 0 )
_Context_Switch_necessary = TRUE;
8554: e59f3018 ldr r3, [pc, #24] ; 8574 <_Thread_Resume+0x104>
8558: e3a02001 mov r2, #1 ; 0x1
855c: e5c32000 strb r2, [r3]
}
}
}
_ISR_Enable( level );
8560: e129f005 msr CPSR_fc, r5
8564: e8bd8030 pop {r4, r5, pc}
00006b08 <_Thread_Set_priority>:
void _Thread_Set_priority(
Thread_Control *the_thread,
Priority_Control new_priority
)
{
6b08: e92d4070 push {r4, r5, r6, lr}
Priority_Bit_map_control mask;
major = _Priority_Major( new_priority );
minor = _Priority_Minor( new_priority );
the_priority_map->minor =
6b0c: e1a05601 lsl r5, r1, #12
6b10: e1a05825 lsr r5, r5, #16
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
6b14: e3a02902 mov r2, #32768 ; 0x8000
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
mask = _Priority_Mask( minor );
6b18: e201400f and r4, r1, #15 ; 0xf
6b1c: e1a04452 asr r4, r2, r4
minor = _Priority_Minor( new_priority );
the_priority_map->minor =
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
6b20: e1a02552 asr r2, r2, r5
the_thread->current_priority = new_priority; the_thread->ready = &_Thread_Ready_chain[ new_priority ];
6b24: e59f3048 ldr r3, [pc, #72] ; 6b74 <_Thread_Set_priority+0x6c>
6b28: e593c000 ldr ip, [r3]
6b2c: e3a0300c mov r3, #12 ; 0xc
6b30: e026c193 mla r6, r3, r1, ip
6b34: e1a02802 lsl r2, r2, #16
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
mask = _Priority_Mask( minor );
6b38: e1a04804 lsl r4, r4, #16
Priority_Bit_map_control mask;
major = _Priority_Major( new_priority );
minor = _Priority_Minor( new_priority );
the_priority_map->minor =
6b3c: e59fc034 ldr ip, [pc, #52] ; 6b78 <_Thread_Set_priority+0x70>
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
6b40: e1a02822 lsr r2, r2, #16
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
mask = _Priority_Mask( minor );
6b44: e1a04824 lsr r4, r4, #16
Priority_Bit_map_control mask;
major = _Priority_Major( new_priority );
minor = _Priority_Minor( new_priority );
the_priority_map->minor =
6b48: e08cc085 add ip, ip, r5, lsl #1
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
mask = _Priority_Mask( minor );
the_priority_map->ready_minor = mask;
the_priority_map->block_minor = ~mask;
6b4c: e1e03004 mvn r3, r4
the_priority_map->minor =
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
6b50: e1e05002 mvn r5, r2
mask = _Priority_Mask( minor );
the_priority_map->ready_minor = mask;
the_priority_map->block_minor = ~mask;
6b54: e1c039ba strh r3, [r0, #154]
6b58: e580608c str r6, [r0, #140]
Priority_Bit_map_control mask;
major = _Priority_Major( new_priority );
minor = _Priority_Minor( new_priority );
the_priority_map->minor =
6b5c: e580c090 str ip, [r0, #144]
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
the_priority_map->ready_major = mask;
the_priority_map->block_major = ~mask;
6b60: e1c059b8 strh r5, [r0, #152]
void _Thread_Set_priority(
Thread_Control *the_thread,
Priority_Control new_priority
)
{
the_thread->current_priority = new_priority;
6b64: e5801014 str r1, [r0, #20]
the_priority_map->minor =
&_Priority_Bit_map[ _Priority_Bits_index(major) ];
mask = _Priority_Mask( major );
the_priority_map->ready_major = mask;
6b68: e1c029b4 strh r2, [r0, #148]
the_priority_map->block_major = ~mask;
mask = _Priority_Mask( minor );
the_priority_map->ready_minor = mask;
6b6c: e1c049b6 strh r4, [r0, #150]
the_thread->ready = &_Thread_Ready_chain[ new_priority ];
_Priority_Initialize_information( &the_thread->Priority_map, new_priority );
}
6b70: e8bd8070 pop {r4, r5, r6, pc}
00006d50 <_Thread_Stack_Allocate>:
* Call ONLY the CPU table stack allocate hook, _or_ the
* the RTEMS workspace allocate. This is so the stack free
* routine can call the correct deallocation routine.
*/
if ( _Configuration_Table->stack_allocate_hook ) {
6d50: e59f305c ldr r3, [pc, #92] ; 6db4 <_Thread_Stack_Allocate+0x64>
6d54: e5933000 ldr r3, [r3]
6d58: e5932020 ldr r2, [r3, #32]
size_t _Thread_Stack_Allocate(
Thread_Control *the_thread,
size_t stack_size
)
{
6d5c: e59f3054 ldr r3, [pc, #84] ; 6db8 <_Thread_Stack_Allocate+0x68>
6d60: e5933000 ldr r3, [r3]
6d64: e92d4030 push {r4, r5, lr}
6d68: e1510003 cmp r1, r3
6d6c: 21a04001 movcs r4, r1
6d70: 31a04003 movcc r4, r3
* Call ONLY the CPU table stack allocate hook, _or_ the
* the RTEMS workspace allocate. This is so the stack free
* routine can call the correct deallocation routine.
*/
if ( _Configuration_Table->stack_allocate_hook ) {
6d74: e3520000 cmp r2, #0 ; 0x0
size_t _Thread_Stack_Allocate(
Thread_Control *the_thread,
size_t stack_size
)
{
6d78: e1a05000 mov r5, r0
* Call ONLY the CPU table stack allocate hook, _or_ the
* the RTEMS workspace allocate. This is so the stack free
* routine can call the correct deallocation routine.
*/
if ( _Configuration_Table->stack_allocate_hook ) {
6d7c: 0a000003 beq 6d90 <_Thread_Stack_Allocate+0x40>
stack_addr = (*_Configuration_Table->stack_allocate_hook)( the_stack_size );
6d80: e1a00004 mov r0, r4 <== NOT EXECUTED
6d84: e1a0e00f mov lr, pc <== NOT EXECUTED
6d88: e12fff12 bx r2 <== NOT EXECUTED
6d8c: ea000002 b 6d9c <_Thread_Stack_Allocate+0x4c> <== NOT EXECUTED
RTEMS_INLINE_ROUTINE uint32_t _Stack_Adjust_size (
size_t size
)
{
return size + CPU_STACK_ALIGNMENT;
6d90: e2844004 add r4, r4, #4 ; 0x4
* get and keep the stack adjust factor, the stack alignment, and
* the context initialization sequence in sync.
*/
the_stack_size = _Stack_Adjust_size( the_stack_size );
stack_addr = _Workspace_Allocate( the_stack_size );
6d94: e1a00004 mov r0, r4
6d98: eb000203 bl 75ac <_Workspace_Allocate>
6d9c: e1a03000 mov r3, r0
the_stack_size = 0;
the_thread->Start.stack = stack_addr;
return the_stack_size;
}
6da0: e3500000 cmp r0, #0 ; 0x0
6da4: 11a00004 movne r0, r4
6da8: 03a00000 moveq r0, #0 ; 0x0
}
if ( !stack_addr )
the_stack_size = 0;
the_thread->Start.stack = stack_addr;
6dac: e58530cc str r3, [r5, #204]
return the_stack_size;
}
6db0: e8bd8030 pop {r4, r5, pc}
00006dbc <_Thread_Stack_Free>:
{
/*
* If the API provided the stack space, then don't free it.
*/
if ( !the_thread->Start.core_allocated_stack )
6dbc: e5d030c0 ldrb r3, [r0, #192]
6dc0: e3530000 cmp r3, #0 ; 0x0
*/
void _Thread_Stack_Free(
Thread_Control *the_thread
)
{
6dc4: e52de004 push {lr} ; (str lr, [sp, #-4]!)
/*
* If the API provided the stack space, then don't free it.
*/
if ( !the_thread->Start.core_allocated_stack )
6dc8: 049df004 popeq {pc} ; (ldreq pc, [sp], #4)
* Call ONLY the CPU table stack free hook, or the
* the RTEMS workspace free. This is so the free
* routine properly matches the allocation of the stack.
*/
if ( _Configuration_Table->stack_free_hook )
6dcc: e59f3028 ldr r3, [pc, #40] ; 6dfc <_Thread_Stack_Free+0x40>
6dd0: e5933000 ldr r3, [r3]
6dd4: e5933024 ldr r3, [r3, #36]
6dd8: e3530000 cmp r3, #0 ; 0x0
6ddc: 0a000003 beq 6df0 <_Thread_Stack_Free+0x34>
(*_Configuration_Table->stack_free_hook)(
6de0: e59000c8 ldr r0, [r0, #200] <== NOT EXECUTED
6de4: e1a0e00f mov lr, pc <== NOT EXECUTED
6de8: e12fff13 bx r3 <== NOT EXECUTED
6dec: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED
the_thread->Start.Initial_stack.area
);
else
_Workspace_Free( the_thread->Start.Initial_stack.area );
6df0: e59000c8 ldr r0, [r0, #200]
}
6df4: e49de004 pop {lr} ; (ldr lr, [sp], #4)
if ( _Configuration_Table->stack_free_hook )
(*_Configuration_Table->stack_free_hook)(
the_thread->Start.Initial_stack.area
);
else
_Workspace_Free( the_thread->Start.Initial_stack.area );
6df8: ea0001e7 b 759c <_Workspace_Free>
00006e90 <_Thread_Tickle_timeslice>:
void _Thread_Tickle_timeslice( void )
{
Thread_Control *executing;
executing = _Thread_Executing;
6e90: e59f3088 ldr r3, [pc, #136] ; 6f20 <_Thread_Tickle_timeslice+0x90>
*
* Output parameters: NONE
*/
void _Thread_Tickle_timeslice( void )
{
6e94: e92d4010 push {r4, lr}
Thread_Control *executing;
executing = _Thread_Executing;
6e98: e5934000 ldr r4, [r3]
/*
* If the thread is not preemptible or is not ready, then
* just return.
*/
if ( !executing->is_preemptible )
6e9c: e5d43076 ldrb r3, [r4, #118]
6ea0: e3530000 cmp r3, #0 ; 0x0
6ea4: 08bd8010 popeq {r4, pc}
return;
if ( !_States_Is_ready( executing->current_state ) )
6ea8: e5943010 ldr r3, [r4, #16]
6eac: e3530000 cmp r3, #0 ; 0x0
6eb0: 18bd8010 popne {r4, pc}
/*
* The cpu budget algorithm determines what happens next.
*/
switch ( executing->budget_algorithm ) {
6eb4: e594307c ldr r3, [r4, #124]
6eb8: e3530001 cmp r3, #1 ; 0x1
6ebc: 38bd8010 popcc {r4, pc}
6ec0: e3530002 cmp r3, #2 ; 0x2
6ec4: 9a000002 bls 6ed4 <_Thread_Tickle_timeslice+0x44>
6ec8: e3530003 cmp r3, #3 ; 0x3 <== NOT EXECUTED
6ecc: 18bd8010 popne {r4, pc} <== NOT EXECUTED
6ed0: ea000009 b 6efc <_Thread_Tickle_timeslice+0x6c> <== NOT EXECUTED
case THREAD_CPU_BUDGET_ALGORITHM_NONE:
break;
case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE:
case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE:
if ( (int)(--executing->cpu_time_budget) <= 0 ) {
6ed4: e5943078 ldr r3, [r4, #120]
6ed8: e2433001 sub r3, r3, #1 ; 0x1
6edc: e3530000 cmp r3, #0 ; 0x0
6ee0: e5843078 str r3, [r4, #120]
6ee4: c8bd8010 popgt {r4, pc}
_Thread_Reset_timeslice();
6ee8: eb000bb0 bl 9db0 <_Thread_Reset_timeslice>
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
6eec: e59f3030 ldr r3, [pc, #48] ; 6f24 <_Thread_Tickle_timeslice+0x94>
6ef0: e5933000 ldr r3, [r3]
6ef4: e5843078 str r3, [r4, #120]
6ef8: e8bd8010 pop {r4, pc}
}
break;
case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT:
if ( --executing->cpu_time_budget == 0 )
6efc: e5943078 ldr r3, [r4, #120] <== NOT EXECUTED
6f00: e2433001 sub r3, r3, #1 ; 0x1 <== NOT EXECUTED
6f04: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED
6f08: e5843078 str r3, [r4, #120] <== NOT EXECUTED
6f0c: 18bd8010 popne {r4, pc} <== NOT EXECUTED
(*executing->budget_callout)( executing );
6f10: e1a00004 mov r0, r4 <== NOT EXECUTED
6f14: e1a0e00f mov lr, pc <== NOT EXECUTED
6f18: e594f080 ldr pc, [r4, #128] <== NOT EXECUTED
6f1c: e8bd8010 pop {r4, pc} <== NOT EXECUTED
00005c1c <_Thread_blocking_operation_Cancel>:
/*
* If the sync state is timed out, this is very likely not needed.
* But better safe than sorry when it comes to critical sections.
*/
if ( _Watchdog_Is_active( &the_thread->Timer ) ) {
5c1c: e5913050 ldr r3, [r1, #80] <== NOT EXECUTED
5c20: e3530002 cmp r3, #2 ; 0x2 <== NOT EXECUTED
#endif
/*
* The thread is not waiting on anything after this completes.
*/
the_thread->Wait.queue = NULL;
5c24: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
void _Thread_blocking_operation_Cancel(
Thread_blocking_operation_States sync_state,
Thread_Control *the_thread,
ISR_Level level
)
{
5c28: e92d4010 push {r4, lr} <== NOT EXECUTED
#endif
/*
* The thread is not waiting on anything after this completes.
*/
the_thread->Wait.queue = NULL;
5c2c: e5813044 str r3, [r1, #68] <== NOT EXECUTED
void _Thread_blocking_operation_Cancel(
Thread_blocking_operation_States sync_state,
Thread_Control *the_thread,
ISR_Level level
)
{
5c30: e1a04001 mov r4, r1 <== NOT EXECUTED
/*
* If the sync state is timed out, this is very likely not needed.
* But better safe than sorry when it comes to critical sections.
*/
if ( _Watchdog_Is_active( &the_thread->Timer ) ) {
5c34: 1a000005 bne 5c50 <_Thread_blocking_operation_Cancel+0x34> <== NOT EXECUTED
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
5c38: e2833003 add r3, r3, #3 ; 0x3 <== NOT EXECUTED
5c3c: e5813050 str r3, [r1, #80] <== NOT EXECUTED
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
5c40: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED
(void) _Watchdog_Remove( &the_thread->Timer );
5c44: e2810048 add r0, r1, #72 ; 0x48 <== NOT EXECUTED
5c48: eb000605 bl 7464 <_Watchdog_Remove> <== NOT EXECUTED
5c4c: ea000000 b 5c54 <_Thread_blocking_operation_Cancel+0x38> <== NOT EXECUTED
} else
_ISR_Enable( level );
5c50: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
5c54: e59f1008 ldr r1, [pc, #8] ; 5c64 <_Thread_blocking_operation_Cancel+0x48><== NOT EXECUTED
5c58: e1a00004 mov r0, r4 <== NOT EXECUTED
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
5c5c: e8bd4010 pop {r4, lr} <== NOT EXECUTED
5c60: ea000068 b 5e08 <_Thread_Clear_state> <== NOT EXECUTED
0000679c <_Thread_queue_Enqueue_priority>:
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
679c: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr}
67a0: e1a0c001 mov ip, r1
Priority_Control priority;
States_Control block_state;
_Chain_Initialize_empty( &the_thread->Wait.Block2n );
priority = the_thread->current_priority;
67a4: e5915014 ldr r5, [r1, #20]
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
67a8: e281303c add r3, r1, #60 ; 0x3c
67ac: e58c3038 str r3, [ip, #56]
the_chain->permanent_null = NULL;
67b0: e3a03000 mov r3, #0 ; 0x0
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
67b4: e1a04000 mov r4, r0
67b8: e58c303c str r3, [ip, #60]
RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number (
Priority_Control the_priority
)
{
return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER);
67bc: e1a00325 lsr r0, r5, #6
_Chain_Initialize_empty( &the_thread->Wait.Block2n );
priority = the_thread->current_priority;
header_index = _Thread_queue_Header_number( priority );
header = &the_thread_queue->Queues.Priority[ header_index ];
67c0: e283300c add r3, r3, #12 ; 0xc
67c4: e0264093 mla r6, r3, r0, r4
block_state = the_thread_queue->state;
if ( _Thread_queue_Is_reverse_search( priority ) )
67c8: e3150020 tst r5, #32 ; 0x20
the_chain->last = _Chain_Head(the_chain);
67cc: e2811038 add r1, r1, #56 ; 0x38
67d0: e58c1040 str r1, [ip, #64]
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
67d4: e1a09002 mov r9, r2
_Chain_Initialize_empty( &the_thread->Wait.Block2n );
priority = the_thread->current_priority;
header_index = _Thread_queue_Header_number( priority );
header = &the_thread_queue->Queues.Priority[ header_index ];
block_state = the_thread_queue->state;
67d8: e5948038 ldr r8, [r4, #56]
the_thread->Wait.queue = the_thread_queue;
_ISR_Enable( level );
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
67dc: 159fa19c ldrne sl, [pc, #412] ; 6980 <_Thread_queue_Enqueue_priority+0x1e4>
_ISR_Disable( level );
search_thread = (Thread_Control *) header->last;
67e0: 12860008 addne r0, r6, #8 ; 0x8
priority = the_thread->current_priority;
header_index = _Thread_queue_Header_number( priority );
header = &the_thread_queue->Queues.Priority[ header_index ];
block_state = the_thread_queue->state;
if ( _Thread_queue_Is_reverse_search( priority ) )
67e4: 1a00002d bne 68a0 <_Thread_queue_Enqueue_priority+0x104>
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
67e8: e3a03003 mov r3, #3 ; 0x3
67ec: e0030390 mul r3, r0, r3
67f0: e2833001 add r3, r3, #1 ; 0x1
67f4: e0840103 add r0, r4, r3, lsl #2
goto restart_reverse_search;
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->first;
67f8: e1a07006 mov r7, r6
if ( _Thread_queue_Is_reverse_search( priority ) )
goto restart_reverse_search;
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
67fc: e10f6000 mrs r6, CPSR
6800: e38630c0 orr r3, r6, #192 ; 0xc0
6804: e129f003 msr CPSR_fc, r3
search_thread = (Thread_Control *) header->first;
6808: e3e02000 mvn r2, #0 ; 0x0
680c: e5971000 ldr r1, [r7]
6810: ea000011 b 685c <_Thread_queue_Enqueue_priority+0xc0>
while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
search_priority = search_thread->current_priority;
6814: e5912014 ldr r2, [r1, #20]
if ( priority <= search_priority )
6818: e1550002 cmp r5, r2
681c: 9a000010 bls 6864 <_Thread_queue_Enqueue_priority+0xc8>
break;
#if ( CPU_UNROLL_ENQUEUE_PRIORITY == TRUE )
search_thread = (Thread_Control *) search_thread->Object.Node.next;
6820: e5911000 ldr r1, [r1]
if ( _Chain_Is_tail( header, (Chain_Node *)search_thread ) )
6824: e1510000 cmp r1, r0
6828: 0a00000d beq 6864 <_Thread_queue_Enqueue_priority+0xc8>
break;
search_priority = search_thread->current_priority;
682c: e5912014 ldr r2, [r1, #20]
if ( priority <= search_priority )
6830: e1550002 cmp r5, r2
6834: 9a00000a bls 6864 <_Thread_queue_Enqueue_priority+0xc8>
break;
#endif
_ISR_Flash( level );
6838: e10f3000 mrs r3, CPSR
683c: e129f006 msr CPSR_fc, r6
6840: e129f003 msr CPSR_fc, r3
if ( !_States_Are_set( search_thread->current_state, block_state) ) {
6844: e5913010 ldr r3, [r1, #16]
6848: e1180003 tst r8, r3
684c: 1a000001 bne 6858 <_Thread_queue_Enqueue_priority+0xbc>
_ISR_Enable( level );
6850: e129f006 msr CPSR_fc, r6 <== NOT EXECUTED
6854: eaffffe8 b 67fc <_Thread_queue_Enqueue_priority+0x60> <== NOT EXECUTED
goto restart_forward_search;
}
search_thread =
6858: e5911000 ldr r1, [r1]
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->first;
while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
685c: e1510000 cmp r1, r0
6860: 1affffeb bne 6814 <_Thread_queue_Enqueue_priority+0x78>
}
search_thread =
(Thread_Control *)search_thread->Object.Node.next;
}
if ( the_thread_queue->sync_state !=
6864: e5943030 ldr r3, [r4, #48]
6868: e3530001 cmp r3, #1 ; 0x1
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->first;
while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
686c: e1a00006 mov r0, r6
}
search_thread =
(Thread_Control *)search_thread->Object.Node.next;
}
if ( the_thread_queue->sync_state !=
6870: 1a00003f bne 6974 <_Thread_queue_Enqueue_priority+0x1d8>
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
6874: e3a03000 mov r3, #0 ; 0x0
if ( priority == search_priority )
6878: e1550002 cmp r5, r2
if ( the_thread_queue->sync_state !=
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
687c: e5843030 str r3, [r4, #48]
if ( priority == search_priority )
6880: 0a000031 beq 694c <_Thread_queue_Enqueue_priority+0x1b0>
goto equal_priority;
search_node = (Chain_Node *) search_thread;
previous_node = search_node->previous;
6884: e5913004 ldr r3, [r1, #4]
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
6888: e88c000a stm ip, {r1, r3}
the_node->previous = previous_node; previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
688c: e58c4044 str r4, [ip, #68]
previous_node = search_node->previous;
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
the_node->previous = previous_node;
previous_node->next = the_node;
6890: e583c000 str ip, [r3]
search_node->previous = the_node;
6894: e581c004 str ip, [r1, #4]
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
6898: e129f006 msr CPSR_fc, r6
689c: ea000032 b 696c <_Thread_queue_Enqueue_priority+0x1d0>
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
68a0: e5da3000 ldrb r3, [sl]
68a4: e2832001 add r2, r3, #1 ; 0x1
_ISR_Disable( level );
68a8: e10f7000 mrs r7, CPSR
68ac: e38730c0 orr r3, r7, #192 ; 0xc0
68b0: e129f003 msr CPSR_fc, r3
search_thread = (Thread_Control *) header->last;
68b4: e5901000 ldr r1, [r0]
68b8: ea000011 b 6904 <_Thread_queue_Enqueue_priority+0x168>
while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
search_priority = search_thread->current_priority;
68bc: e5912014 ldr r2, [r1, #20]
if ( priority >= search_priority )
68c0: e1550002 cmp r5, r2
68c4: 2a000010 bcs 690c <_Thread_queue_Enqueue_priority+0x170>
break;
#if ( CPU_UNROLL_ENQUEUE_PRIORITY == TRUE )
search_thread = (Thread_Control *) search_thread->Object.Node.previous;
68c8: e5911004 ldr r1, [r1, #4]
if ( _Chain_Is_head( header, (Chain_Node *)search_thread ) )
68cc: e1510006 cmp r1, r6
68d0: 0a00000d beq 690c <_Thread_queue_Enqueue_priority+0x170>
break;
search_priority = search_thread->current_priority;
68d4: e5912014 ldr r2, [r1, #20]
if ( priority >= search_priority )
68d8: e1550002 cmp r5, r2
68dc: 2a00000a bcs 690c <_Thread_queue_Enqueue_priority+0x170>
break;
#endif
_ISR_Flash( level );
68e0: e10f3000 mrs r3, CPSR
68e4: e129f007 msr CPSR_fc, r7
68e8: e129f003 msr CPSR_fc, r3
if ( !_States_Are_set( search_thread->current_state, block_state) ) {
68ec: e5913010 ldr r3, [r1, #16]
68f0: e1180003 tst r8, r3
68f4: 1a000001 bne 6900 <_Thread_queue_Enqueue_priority+0x164>
_ISR_Enable( level );
68f8: e129f007 msr CPSR_fc, r7 <== NOT EXECUTED
68fc: eaffffe7 b 68a0 <_Thread_queue_Enqueue_priority+0x104> <== NOT EXECUTED
goto restart_reverse_search;
}
search_thread = (Thread_Control *)
6900: e5911004 ldr r1, [r1, #4]
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->last;
while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
6904: e1510006 cmp r1, r6
6908: 1affffeb bne 68bc <_Thread_queue_Enqueue_priority+0x120>
}
search_thread = (Thread_Control *)
search_thread->Object.Node.previous;
}
if ( the_thread_queue->sync_state !=
690c: e5943030 ldr r3, [r4, #48]
6910: e3530001 cmp r3, #1 ; 0x1
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->last;
while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
6914: e1a00007 mov r0, r7
}
search_thread = (Thread_Control *)
search_thread->Object.Node.previous;
}
if ( the_thread_queue->sync_state !=
6918: 1a000015 bne 6974 <_Thread_queue_Enqueue_priority+0x1d8>
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
691c: e3a03000 mov r3, #0 ; 0x0
if ( priority == search_priority )
6920: e1550002 cmp r5, r2
if ( the_thread_queue->sync_state !=
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
6924: e5843030 str r3, [r4, #48]
if ( priority == search_priority )
6928: 0a000007 beq 694c <_Thread_queue_Enqueue_priority+0x1b0>
goto equal_priority;
search_node = (Chain_Node *) search_thread;
next_node = search_node->next;
692c: e5913000 ldr r3, [r1]
the_node = (Chain_Node *) the_thread;
the_node->next = next_node;
the_node->previous = search_node;
6930: e58c1004 str r1, [ip, #4]
search_node = (Chain_Node *) search_thread;
next_node = search_node->next;
the_node = (Chain_Node *) the_thread;
the_node->next = next_node;
6934: e58c3000 str r3, [ip]
the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
6938: e58c4044 str r4, [ip, #68]
next_node = search_node->next;
the_node = (Chain_Node *) the_thread;
the_node->next = next_node;
the_node->previous = search_node;
search_node->next = the_node;
693c: e581c000 str ip, [r1]
next_node->previous = the_node;
6940: e583c004 str ip, [r3, #4]
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
6944: e129f007 msr CPSR_fc, r7
6948: ea000007 b 696c <_Thread_queue_Enqueue_priority+0x1d0>
694c: e281303c add r3, r1, #60 ; 0x3c
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
equal_priority: /* add at end of priority group */
search_node = _Chain_Tail( &search_thread->Wait.Block2n );
previous_node = search_node->previous;
6950: e5932004 ldr r2, [r3, #4]
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
6954: e58c3000 str r3, [ip]
the_node->previous = previous_node;
6958: e58c2004 str r2, [ip, #4]
previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
695c: e58c4044 str r4, [ip, #68]
previous_node = search_node->previous;
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
the_node->previous = previous_node;
previous_node->next = the_node;
6960: e582c000 str ip, [r2]
search_node->previous = the_node;
6964: e583c004 str ip, [r3, #4]
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
6968: e129f000 msr CPSR_fc, r0
696c: e3a00001 mov r0, #1 ; 0x1
6970: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc}
* For example, the blocking thread could have been given * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level;
6974: e5890000 str r0, [r9] <== NOT EXECUTED
return the_thread_queue->sync_state;
6978: e5940030 ldr r0, [r4, #48] <== NOT EXECUTED
}
697c: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} <== NOT EXECUTED
000066f4 <_Thread_queue_Enqueue_with_handler>:
void _Thread_queue_Enqueue_with_handler(
Thread_queue_Control *the_thread_queue,
Watchdog_Interval timeout,
Thread_queue_Timeout_callout handler
)
{
66f4: e92d40f0 push {r4, r5, r6, r7, lr} <== NOT EXECUTED
Thread_queue_Control *,
Thread_Control *,
ISR_Level *
);
the_thread = _Thread_Executing;
66f8: e59f308c ldr r3, [pc, #140] ; 678c <_Thread_queue_Enqueue_with_handler+0x98><== NOT EXECUTED
66fc: e5934000 ldr r4, [r3] <== NOT EXECUTED
void _Thread_queue_Enqueue_with_handler(
Thread_queue_Control *the_thread_queue,
Watchdog_Interval timeout,
Thread_queue_Timeout_callout handler
)
{
6700: e1a05000 mov r5, r0 <== NOT EXECUTED
6704: e1a07001 mov r7, r1 <== NOT EXECUTED
6708: e24dd004 sub sp, sp, #4 ; 0x4 <== NOT EXECUTED
else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state );
670c: e1a00004 mov r0, r4 <== NOT EXECUTED
6710: e5951038 ldr r1, [r5, #56] <== NOT EXECUTED
void _Thread_queue_Enqueue_with_handler(
Thread_queue_Control *the_thread_queue,
Watchdog_Interval timeout,
Thread_queue_Timeout_callout handler
)
{
6714: e1a06002 mov r6, r2 <== NOT EXECUTED
else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state );
6718: eb000117 bl 6b7c <_Thread_Set_state> <== NOT EXECUTED
/*
* If the thread wants to timeout, then schedule its timer.
*/
if ( timeout ) {
671c: e3570000 cmp r7, #0 ; 0x0 <== NOT EXECUTED
6720: 0a000009 beq 674c <_Thread_queue_Enqueue_with_handler+0x58><== NOT EXECUTED
_Watchdog_Initialize(
6724: e5943008 ldr r3, [r4, #8] <== NOT EXECUTED
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
6728: e3a02000 mov r2, #0 ; 0x0 <== NOT EXECUTED
the_watchdog->routine = routine;
672c: e5846064 str r6, [r4, #100] <== NOT EXECUTED
the_watchdog->id = id;
6730: e5843068 str r3, [r4, #104] <== NOT EXECUTED
the_watchdog->user_data = user_data;
6734: e584206c str r2, [r4, #108] <== NOT EXECUTED
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
6738: e5847054 str r7, [r4, #84] <== NOT EXECUTED
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
673c: e5842050 str r2, [r4, #80] <== NOT EXECUTED
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
6740: e59f0048 ldr r0, [pc, #72] ; 6790 <_Thread_queue_Enqueue_with_handler+0x9c><== NOT EXECUTED
6744: e2841048 add r1, r4, #72 ; 0x48 <== NOT EXECUTED
6748: eb0002e9 bl 72f4 <_Watchdog_Insert> <== NOT EXECUTED
}
/*
* Now enqueue the thread per the discipline for this thread queue.
*/
if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY )
674c: e5951034 ldr r1, [r5, #52] <== NOT EXECUTED
6750: e59f203c ldr r2, [pc, #60] ; 6794 <_Thread_queue_Enqueue_with_handler+0xa0><== NOT EXECUTED
6754: e3510001 cmp r1, #1 ; 0x1 <== NOT EXECUTED
6758: e59f3038 ldr r3, [pc, #56] ; 6798 <_Thread_queue_Enqueue_with_handler+0xa4><== NOT EXECUTED
enqueue_p = _Thread_queue_Enqueue_priority;
else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */
enqueue_p = _Thread_queue_Enqueue_fifo;
sync_state = (*enqueue_p)( the_thread_queue, the_thread, &level );
675c: e1a00005 mov r0, r5 <== NOT EXECUTED
}
/*
* Now enqueue the thread per the discipline for this thread queue.
*/
if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY )
6760: 11a03002 movne r3, r2 <== NOT EXECUTED
enqueue_p = _Thread_queue_Enqueue_priority;
else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */
enqueue_p = _Thread_queue_Enqueue_fifo;
sync_state = (*enqueue_p)( the_thread_queue, the_thread, &level );
6764: e1a01004 mov r1, r4 <== NOT EXECUTED
6768: e1a0200d mov r2, sp <== NOT EXECUTED
676c: e1a0e00f mov lr, pc <== NOT EXECUTED
6770: e12fff13 bx r3 <== NOT EXECUTED
if ( sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
6774: e3500001 cmp r0, #1 ; 0x1 <== NOT EXECUTED
_Thread_blocking_operation_Cancel( sync_state, the_thread, level );
6778: 11a01004 movne r1, r4 <== NOT EXECUTED
677c: 159d2000 ldrne r2, [sp] <== NOT EXECUTED
6780: 1bfffd25 blne 5c1c <_Thread_blocking_operation_Cancel> <== NOT EXECUTED
}
6784: e28dd004 add sp, sp, #4 ; 0x4 <== NOT EXECUTED
6788: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED
0000a718 <_Thread_queue_Extract_fifo>:
void _Thread_queue_Extract_fifo(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread
)
{
a718: e92d4010 push {r4, lr}
a71c: e1a04001 mov r4, r1
ISR_Level level;
_ISR_Disable( level );
a720: e10f0000 mrs r0, CPSR
a724: e38030c0 orr r3, r0, #192 ; 0xc0
a728: e129f003 msr CPSR_fc, r3
if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) {
a72c: e59f3064 ldr r3, [pc, #100] ; a798 <_Thread_queue_Extract_fifo+0x80>
a730: e5912010 ldr r2, [r1, #16]
a734: e0023003 and r3, r2, r3
a738: e3530000 cmp r3, #0 ; 0x0
a73c: 1a000001 bne a748 <_Thread_queue_Extract_fifo+0x30>
_ISR_Enable( level );
a740: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
a744: e8bd8010 pop {r4, pc} <== NOT EXECUTED
_Chain_Extract_unprotected( &the_thread->Object.Node );
the_thread->Wait.queue = NULL;
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
a748: e5913050 ldr r3, [r1, #80]
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
a74c: e5942004 ldr r2, [r4, #4]
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
a750: e5911000 ldr r1, [r1]
a754: e3530002 cmp r3, #2 ; 0x2
return;
}
_Chain_Extract_unprotected( &the_thread->Object.Node );
the_thread->Wait.queue = NULL;
a758: e3a03000 mov r3, #0 ; 0x0
previous = the_node->previous; next->previous = previous; previous->next = next;
a75c: e5821000 str r1, [r2]
a760: e5843044 str r3, [r4, #68]
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
a764: e5812004 str r2, [r1, #4]
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
a768: 0a000001 beq a774 <_Thread_queue_Extract_fifo+0x5c>
_ISR_Enable( level );
a76c: e129f000 msr CPSR_fc, r0
a770: ea000004 b a788 <_Thread_queue_Extract_fifo+0x70>
a774: e3a03003 mov r3, #3 ; 0x3
a778: e5843050 str r3, [r4, #80]
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
a77c: e129f000 msr CPSR_fc, r0
(void) _Watchdog_Remove( &the_thread->Timer );
a780: e2840048 add r0, r4, #72 ; 0x48
a784: ebfff336 bl 7464 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
a788: e59f100c ldr r1, [pc, #12] ; a79c <_Thread_queue_Extract_fifo+0x84>
a78c: e1a00004 mov r0, r4
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
a790: e8bd4010 pop {r4, lr}
a794: eaffed9b b 5e08 <_Thread_Clear_state>
00009b78 <_Thread_queue_Extract_priority_helper>:
void _Thread_queue_Extract_priority_helper(
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
bool requeuing
)
{
9b78: e92d4070 push {r4, r5, r6, lr}
9b7c: e1a04001 mov r4, r1
9b80: e20260ff and r6, r2, #255 ; 0xff
Chain_Node *new_first_node;
Chain_Node *new_second_node;
Chain_Node *last_node;
the_node = (Chain_Node *) the_thread;
_ISR_Disable( level );
9b84: e10fc000 mrs ip, CPSR
9b88: e38c30c0 orr r3, ip, #192 ; 0xc0
9b8c: e129f003 msr CPSR_fc, r3
if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) {
9b90: e59f30b4 ldr r3, [pc, #180] ; 9c4c <_Thread_queue_Extract_priority_helper+0xd4>
9b94: e5912010 ldr r2, [r1, #16]
9b98: e0023003 and r3, r2, r3
9b9c: e3530000 cmp r3, #0 ; 0x0
9ba0: 1a000001 bne 9bac <_Thread_queue_Extract_priority_helper+0x34>
_ISR_Enable( level );
9ba4: e129f00c msr CPSR_fc, ip <== NOT EXECUTED
9ba8: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
9bac: e5911038 ldr r1, [r1, #56]
*/
next_node = the_node->next;
previous_node = the_node->previous;
if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) {
9bb0: e284303c add r3, r4, #60 ; 0x3c
9bb4: e1510003 cmp r1, r3
/*
* The thread was actually waiting on a thread queue so let's remove it.
*/
next_node = the_node->next;
9bb8: e894000c ldm r4, {r2, r3}
new_first_thread->Wait.Block2n.last = last_node;
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
}
} else {
previous_node->next = next_node;
next_node->previous = previous_node;
9bbc: 05823004 streq r3, [r2, #4]
new_first_thread->Wait.Block2n.last = last_node;
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
}
} else {
previous_node->next = next_node;
9bc0: 05832000 streq r2, [r3]
*/
next_node = the_node->next;
previous_node = the_node->previous;
if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) {
9bc4: 0a00000e beq 9c04 <_Thread_queue_Extract_priority_helper+0x8c>
new_first_node = the_thread->Wait.Block2n.first;
new_first_thread = (Thread_Control *) new_first_node;
last_node = the_thread->Wait.Block2n.last;
9bc8: e5945040 ldr r5, [r4, #64]
new_second_node = new_first_node->next;
9bcc: e5910000 ldr r0, [r1]
previous_node->next = new_first_node;
next_node->previous = new_first_node;
9bd0: e5821004 str r1, [r2, #4]
new_first_node = the_thread->Wait.Block2n.first;
new_first_thread = (Thread_Control *) new_first_node;
last_node = the_thread->Wait.Block2n.last;
new_second_node = new_first_node->next;
previous_node->next = new_first_node;
9bd4: e5831000 str r1, [r3]
next_node->previous = new_first_node;
new_first_node->next = next_node;
new_first_node->previous = previous_node;
9bd8: e881000c stm r1, {r2, r3}
if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) {
9bdc: e5942038 ldr r2, [r4, #56]
9be0: e5943040 ldr r3, [r4, #64]
9be4: e1520003 cmp r2, r3
9be8: 0a000005 beq 9c04 <_Thread_queue_Extract_priority_helper+0x8c>
new_second_node->previous =
_Chain_Head( &new_first_thread->Wait.Block2n );
new_first_thread->Wait.Block2n.first = new_second_node;
new_first_thread->Wait.Block2n.last = last_node;
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
9bec: e281203c add r2, r1, #60 ; 0x3c
new_first_node->next = next_node;
new_first_node->previous = previous_node;
if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) {
/* > two threads on 2-n */
new_second_node->previous =
9bf0: e2813038 add r3, r1, #56 ; 0x38
9bf4: e5803004 str r3, [r0, #4]
_Chain_Head( &new_first_thread->Wait.Block2n );
new_first_thread->Wait.Block2n.first = new_second_node;
9bf8: e5810038 str r0, [r1, #56]
new_first_thread->Wait.Block2n.last = last_node;
9bfc: e5815040 str r5, [r1, #64]
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
9c00: e5852000 str r2, [r5]
/*
* If we are not supposed to touch timers or the thread's state, return.
*/
if ( requeuing ) {
9c04: e3560000 cmp r6, #0 ; 0x0
9c08: 0a000001 beq 9c14 <_Thread_queue_Extract_priority_helper+0x9c>
_ISR_Enable( level );
9c0c: e129f00c msr CPSR_fc, ip
9c10: e8bd8070 pop {r4, r5, r6, pc}
return;
}
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
9c14: e5943050 ldr r3, [r4, #80]
9c18: e3530002 cmp r3, #2 ; 0x2
9c1c: 0a000001 beq 9c28 <_Thread_queue_Extract_priority_helper+0xb0>
_ISR_Enable( level );
9c20: e129f00c msr CPSR_fc, ip
9c24: ea000004 b 9c3c <_Thread_queue_Extract_priority_helper+0xc4>
9c28: e3a03003 mov r3, #3 ; 0x3 <== NOT EXECUTED
9c2c: e5843050 str r3, [r4, #80] <== NOT EXECUTED
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
9c30: e129f00c msr CPSR_fc, ip <== NOT EXECUTED
(void) _Watchdog_Remove( &the_thread->Timer );
9c34: e2840048 add r0, r4, #72 ; 0x48 <== NOT EXECUTED
9c38: ebfff609 bl 7464 <_Watchdog_Remove> <== NOT EXECUTED
9c3c: e59f100c ldr r1, [pc, #12] ; 9c50 <_Thread_queue_Extract_priority_helper+0xd8>
9c40: e1a00004 mov r0, r4
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
9c44: e8bd4070 pop {r4, r5, r6, lr}
9c48: eafff06e b 5e08 <_Thread_Clear_state>
00009c54 <_Thread_queue_Process_timeout>:
void _Thread_queue_Process_timeout(
Thread_Control *the_thread
)
{
Thread_queue_Control *the_thread_queue = the_thread->Wait.queue;
9c54: e5902044 ldr r2, [r0, #68]
* If it is not satisfied, then it is "nothing happened" and
* this is the "timeout" transition. After a request is satisfied,
* a timeout is not allowed to occur.
*/
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED &&
9c58: e5921030 ldr r1, [r2, #48]
9c5c: e3510000 cmp r1, #0 ; 0x0
9c60: 0a000009 beq 9c8c <_Thread_queue_Process_timeout+0x38>
9c64: e59f3034 ldr r3, [pc, #52] ; 9ca0 <_Thread_queue_Process_timeout+0x4c><== NOT EXECUTED
9c68: e5933000 ldr r3, [r3] <== NOT EXECUTED
9c6c: e1500003 cmp r0, r3 <== NOT EXECUTED
9c70: 1a000005 bne 9c8c <_Thread_queue_Process_timeout+0x38> <== NOT EXECUTED
_Thread_Is_executing( the_thread ) ) {
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) {
9c74: e3510003 cmp r1, #3 ; 0x3 <== NOT EXECUTED
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
9c78: 1592303c ldrne r3, [r2, #60] <== NOT EXECUTED
9c7c: 15803034 strne r3, [r0, #52] <== NOT EXECUTED
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
9c80: 13a03002 movne r3, #2 ; 0x2 <== NOT EXECUTED
9c84: 15823030 strne r3, [r2, #48] <== NOT EXECUTED
9c88: e12fff1e bx lr <== NOT EXECUTED
}
} else {
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
9c8c: e592303c ldr r3, [r2, #60]
_Thread_queue_Extract( the_thread->Wait.queue, the_thread );
9c90: e1a01000 mov r1, r0
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) {
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
}
} else {
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
9c94: e5803034 str r3, [r0, #52]
_Thread_queue_Extract( the_thread->Wait.queue, the_thread );
9c98: e5900044 ldr r0, [r0, #68]
9c9c: eaffffaf b 9b60 <_Thread_queue_Extract>
00008d44 <_Timespec_Divide_by_integer>:
/*
* For math simplicity just convert the timespec to nanoseconds
* in a 64-bit integer.
*/
t = time->tv_sec;
8d44: e5903000 ldr r3, [r0] <== NOT EXECUTED
t *= TOD_NANOSECONDS_PER_SECOND;
8d48: e59fc06c ldr ip, [pc, #108] ; 8dbc <_Timespec_Divide_by_integer+0x78><== NOT EXECUTED
void _Timespec_Divide_by_integer(
const struct timespec *time,
uint32_t iterations,
struct timespec *result
)
{
8d4c: e92d41f0 push {r4, r5, r6, r7, r8, lr} <== NOT EXECUTED
/*
* For math simplicity just convert the timespec to nanoseconds
* in a 64-bit integer.
*/
t = time->tv_sec;
8d50: e1a04fc3 asr r4, r3, #31 <== NOT EXECUTED
t *= TOD_NANOSECONDS_PER_SECOND;
8d54: e086539c umull r5, r6, ip, r3 <== NOT EXECUTED
8d58: e026649c mla r6, ip, r4, r6 <== NOT EXECUTED
t += time->tv_nsec;
8d5c: e5900004 ldr r0, [r0, #4] <== NOT EXECUTED
/*
* Divide to get nanoseconds per iteration
*/
t /= iterations;
8d60: e0957000 adds r7, r5, r0 <== NOT EXECUTED
8d64: e0a68fc0 adc r8, r6, r0, asr #31 <== NOT EXECUTED
8d68: e1a03001 mov r3, r1 <== NOT EXECUTED
8d6c: e3a04000 mov r4, #0 ; 0x0 <== NOT EXECUTED
void _Timespec_Divide_by_integer(
const struct timespec *time,
uint32_t iterations,
struct timespec *result
)
{
8d70: e1a06002 mov r6, r2 <== NOT EXECUTED
/*
* Divide to get nanoseconds per iteration
*/
t /= iterations;
8d74: e1a00007 mov r0, r7 <== NOT EXECUTED
8d78: e1a02003 mov r2, r3 <== NOT EXECUTED
8d7c: e1a01008 mov r1, r8 <== NOT EXECUTED
8d80: e1a03004 mov r3, r4 <== NOT EXECUTED
8d84: eb0032f6 bl 15964 <__udivdi3> <== NOT EXECUTED
/*
* Put it back in the timespec result
*/
result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND;
8d88: e59f202c ldr r2, [pc, #44] ; 8dbc <_Timespec_Divide_by_integer+0x78><== NOT EXECUTED
8d8c: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
/*
* Divide to get nanoseconds per iteration
*/
t /= iterations;
8d90: e1a04000 mov r4, r0 <== NOT EXECUTED
8d94: e1a05001 mov r5, r1 <== NOT EXECUTED
/*
* Put it back in the timespec result
*/
result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND;
8d98: eb0032f1 bl 15964 <__udivdi3> <== NOT EXECUTED
result->tv_nsec = t % TOD_NANOSECONDS_PER_SECOND;
8d9c: e1a01005 mov r1, r5 <== NOT EXECUTED
/*
* Put it back in the timespec result
*/
result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND;
8da0: e5860000 str r0, [r6] <== NOT EXECUTED
result->tv_nsec = t % TOD_NANOSECONDS_PER_SECOND;
8da4: e59f2010 ldr r2, [pc, #16] ; 8dbc <_Timespec_Divide_by_integer+0x78><== NOT EXECUTED
8da8: e1a00004 mov r0, r4 <== NOT EXECUTED
8dac: e3a03000 mov r3, #0 ; 0x0 <== NOT EXECUTED
8db0: eb003433 bl 15e84 <__umoddi3> <== NOT EXECUTED
8db4: e5860004 str r0, [r6, #4] <== NOT EXECUTED
}
8db8: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED
000093c8 <_User_extensions_Remove_set>:
*/
void _User_extensions_Remove_set (
User_extensions_Control *the_extension
)
{
93c8: e92d4010 push {r4, lr}
93cc: e1a04000 mov r4, r0
_Chain_Extract( &the_extension->Node );
93d0: eb000925 bl b86c <_Chain_Extract>
/*
* If a switch handler is present, remove it.
*/
if ( the_extension->Callouts.thread_switch != NULL )
93d4: e5943024 ldr r3, [r4, #36]
93d8: e3530000 cmp r3, #0 ; 0x0
93dc: 08bd8010 popeq {r4, pc}
_Chain_Extract( &the_extension->Switch.Node );
93e0: e2840008 add r0, r4, #8 ; 0x8 <== NOT EXECUTED
}
93e4: e8bd4010 pop {r4, lr} <== NOT EXECUTED
/*
* If a switch handler is present, remove it.
*/
if ( the_extension->Callouts.thread_switch != NULL )
_Chain_Extract( &the_extension->Switch.Node );
93e8: ea00091f b b86c <_Chain_Extract> <== NOT EXECUTED
00007224 <_User_extensions_Thread_delete>:
)
{
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
7224: e59f303c ldr r3, [pc, #60] ; 7268 <_User_extensions_Thread_delete+0x44>
*/
void _User_extensions_Thread_delete (
Thread_Control *the_thread
)
{
7228: e92d40f0 push {r4, r5, r6, r7, lr}
722c: e1a05000 mov r5, r0
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
7230: e1a07003 mov r7, r3
)
{
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
7234: e5934008 ldr r4, [r3, #8]
the_node = the_node->previous ) {
the_extension = (User_extensions_Control *) the_node;
if ( the_extension->Callouts.thread_delete != NULL )
(*the_extension->Callouts.thread_delete)(
7238: e59f602c ldr r6, [pc, #44] ; 726c <_User_extensions_Thread_delete+0x48>
723c: ea000005 b 7258 <_User_extensions_Thread_delete+0x34>
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
the_node = the_node->previous ) {
the_extension = (User_extensions_Control *) the_node;
if ( the_extension->Callouts.thread_delete != NULL )
7240: e5943020 ldr r3, [r4, #32]
7244: e3530000 cmp r3, #0 ; 0x0
(*the_extension->Callouts.thread_delete)(
7248: 15960000 ldrne r0, [r6]
724c: 11a0e00f movne lr, pc
7250: 112fff13 bxne r3
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
the_node = the_node->previous ) {
7254: e5944004 ldr r4, [r4, #4]
{
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
7258: e1540007 cmp r4, r7
the_node = the_node->previous ) {
the_extension = (User_extensions_Control *) the_node;
if ( the_extension->Callouts.thread_delete != NULL )
(*the_extension->Callouts.thread_delete)(
725c: e1a01005 mov r1, r5
{
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
7260: 1afffff6 bne 7240 <_User_extensions_Thread_delete+0x1c>
(*the_extension->Callouts.thread_delete)(
_Thread_Executing,
the_thread
);
}
}
7264: e8bd80f0 pop {r4, r5, r6, r7, pc}
000072f4 <_Watchdog_Insert>:
Watchdog_Control *after;
uint32_t insert_isr_nest_level;
Watchdog_Interval delta_interval;
insert_isr_nest_level = _ISR_Nest_level;
72f4: e59f30fc ldr r3, [pc, #252] ; 73f8 <_Watchdog_Insert+0x104>
void _Watchdog_Insert(
Chain_Control *header,
Watchdog_Control *the_watchdog
)
{
72f8: e92d41f0 push {r4, r5, r6, r7, r8, lr}
72fc: e1a0c001 mov ip, r1
7300: e1a07000 mov r7, r0
Watchdog_Control *after;
uint32_t insert_isr_nest_level;
Watchdog_Interval delta_interval;
insert_isr_nest_level = _ISR_Nest_level;
7304: e5934000 ldr r4, [r3]
_ISR_Disable( level );
7308: e10f5000 mrs r5, CPSR
730c: e38530c0 orr r3, r5, #192 ; 0xc0
7310: e129f003 msr CPSR_fc, r3
/*
* Check to see if the watchdog has just been inserted by a
* higher priority interrupt. If so, abandon this insert.
*/
if ( the_watchdog->state != WATCHDOG_INACTIVE ) {
7314: e5913008 ldr r3, [r1, #8]
7318: e3530000 cmp r3, #0 ; 0x0
731c: 0a000001 beq 7328 <_Watchdog_Insert+0x34>
_ISR_Enable( level );
7320: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED
7324: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED
return;
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
_Watchdog_Sync_count++;
7328: e59f30cc ldr r3, [pc, #204] ; 73fc <_Watchdog_Insert+0x108>
732c: e5932000 ldr r2, [r3]
7330: e2822001 add r2, r2, #1 ; 0x1
if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) {
goto exit_insert;
}
if ( _Watchdog_Sync_level > insert_isr_nest_level ) {
7334: e59f60c4 ldr r6, [pc, #196] ; 7400 <_Watchdog_Insert+0x10c>
_ISR_Enable( level );
return;
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
_Watchdog_Sync_count++;
7338: e5832000 str r2, [r3]
if ( the_watchdog->state != WATCHDOG_INACTIVE ) {
_ISR_Enable( level );
return;
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
733c: e3a03001 mov r3, #1 ; 0x1
7340: e5813008 str r3, [r1, #8]
if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) {
goto exit_insert;
}
if ( _Watchdog_Sync_level > insert_isr_nest_level ) {
7344: e1a08006 mov r8, r6
the_watchdog->state = WATCHDOG_BEING_INSERTED;
_Watchdog_Sync_count++;
restart:
delta_interval = the_watchdog->initial;
7348: e59c000c ldr r0, [ip, #12]
* cache *header!! * * Till Straumann, 7/2003 (gcc-3.2.2 -O4 on powerpc) * */ for ( after = (Watchdog_Control *) ((volatile Chain_Control *)header)->first ;
734c: e5971000 ldr r1, [r7]
;
after = _Watchdog_Next( after ) ) {
if ( delta_interval == 0 || !_Watchdog_Next( after ) )
7350: e3500000 cmp r0, #0 ; 0x0
7354: 0a000014 beq 73ac <_Watchdog_Insert+0xb8>
7358: e5913000 ldr r3, [r1]
735c: e3530000 cmp r3, #0 ; 0x0
7360: 0a000011 beq 73ac <_Watchdog_Insert+0xb8>
break;
if ( delta_interval < after->delta_interval ) {
7364: e5912010 ldr r2, [r1, #16]
7368: e1500002 cmp r0, r2
after->delta_interval -= delta_interval;
736c: 30603002 rsbcc r3, r0, r2
7370: 35813010 strcc r3, [r1, #16]
7374: 3a00000c bcc 73ac <_Watchdog_Insert+0xb8>
* used around this flash point allowed interrupts to execute
* which violated the design assumptions. The critical section
* mechanism used here WAS redesigned to address this.
*/
_ISR_Flash( level );
7378: e10f3000 mrs r3, CPSR
737c: e129f005 msr CPSR_fc, r5
7380: e129f003 msr CPSR_fc, r3
if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) {
7384: e59c3008 ldr r3, [ip, #8]
7388: e3530001 cmp r3, #1 ; 0x1
if ( delta_interval < after->delta_interval ) {
after->delta_interval -= delta_interval;
break;
}
delta_interval -= after->delta_interval;
738c: e0620000 rsb r0, r2, r0
* mechanism used here WAS redesigned to address this.
*/
_ISR_Flash( level );
if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) {
7390: 1a000010 bne 73d8 <_Watchdog_Insert+0xe4>
goto exit_insert;
}
if ( _Watchdog_Sync_level > insert_isr_nest_level ) {
7394: e5963000 ldr r3, [r6]
7398: e1530004 cmp r3, r4
_Watchdog_Sync_level = insert_isr_nest_level;
739c: 85884000 strhi r4, [r8]
73a0: 8affffe8 bhi 7348 <_Watchdog_Insert+0x54>
RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_Next(
Watchdog_Control *the_watchdog
)
{
return ( (Watchdog_Control *) the_watchdog->Node.next );
73a4: e5911000 ldr r1, [r1]
73a8: eaffffe8 b 7350 <_Watchdog_Insert+0x5c>
the_watchdog->delta_interval = delta_interval;
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
73ac: e59f3050 ldr r3, [pc, #80] ; 7404 <_Watchdog_Insert+0x110>
_Watchdog_Activate( the_watchdog );
the_watchdog->delta_interval = delta_interval;
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
73b0: e5912004 ldr r2, [r1, #4]
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
73b4: e5933000 ldr r3, [r3]
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
73b8: e5921000 ldr r1, [r2]
73bc: e58c3014 str r3, [ip, #20]
RTEMS_INLINE_ROUTINE void _Watchdog_Activate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_ACTIVE;
73c0: e3a03002 mov r3, #2 ; 0x2
after_node->next = the_node;
73c4: e582c000 str ip, [r2]
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
73c8: e98c000c stmib ip, {r2, r3}
}
}
_Watchdog_Activate( the_watchdog );
the_watchdog->delta_interval = delta_interval;
73cc: e58c0010 str r0, [ip, #16]
before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; before_node->previous = the_node;
73d0: e581c004 str ip, [r1, #4]
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
73d4: e58c1000 str r1, [ip]
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
exit_insert:
_Watchdog_Sync_level = insert_isr_nest_level;
73d8: e59f3020 ldr r3, [pc, #32] ; 7400 <_Watchdog_Insert+0x10c>
_Watchdog_Sync_count--;
73dc: e59f2018 ldr r2, [pc, #24] ; 73fc <_Watchdog_Insert+0x108>
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
exit_insert:
_Watchdog_Sync_level = insert_isr_nest_level;
73e0: e5834000 str r4, [r3]
_Watchdog_Sync_count--;
73e4: e5923000 ldr r3, [r2]
73e8: e2433001 sub r3, r3, #1 ; 0x1
73ec: e5823000 str r3, [r2]
_ISR_Enable( level );
73f0: e129f005 msr CPSR_fc, r5
73f4: e8bd81f0 pop {r4, r5, r6, r7, r8, pc}
000075bc <_Workspace_Allocate_or_fatal_error>:
* _Workspace_Allocate_or_fatal_error
*/
void *_Workspace_Allocate_or_fatal_error(
size_t size
)
{
75bc: e1a01000 mov r1, r0
75c0: e52de004 push {lr} ; (str lr, [sp, #-4]!)
*/
void *_Workspace_Allocate(
size_t size
)
{
return _Heap_Allocate( &_Workspace_Area, size );
75c4: e59f0014 ldr r0, [pc, #20] ; 75e0 <_Workspace_Allocate_or_fatal_error+0x24>
75c8: eb000849 bl 96f4 <_Heap_Allocate>
{
void *memory;
memory = _Workspace_Allocate( size );
if ( memory == NULL )
75cc: e3500000 cmp r0, #0 ; 0x0
75d0: 149df004 popne {pc} ; (ldrne pc, [sp], #4)
_Internal_error_Occurred(
75d4: e3a01001 mov r1, #1 ; 0x1 <== NOT EXECUTED
75d8: e3a02004 mov r2, #4 ; 0x4 <== NOT EXECUTED
75dc: ebfff7a1 bl 5468 <_Internal_error_Occurred> <== NOT EXECUTED
0000759c <_Workspace_Free>:
* _Workspace_Free
*/
bool _Workspace_Free(
void *block
)
{
759c: e1a01000 mov r1, r0
return _Heap_Free( &_Workspace_Area, block );
75a0: e59f0000 ldr r0, [pc, #0] ; 75a8 <_Workspace_Free+0xc>
75a4: ea000876 b 9784 <_Heap_Free>
000075e4 <_Workspace_Handler_initialization>:
*/
void _Workspace_Handler_initialization(
void *starting_address,
size_t size
)
{
75e4: e92d4030 push {r4, r5, lr}
uint32_t memory_available;
if ( !starting_address || !_Addresses_Is_aligned( starting_address ) )
75e8: e2504000 subs r4, r0, #0 ; 0x0
*/
void _Workspace_Handler_initialization(
void *starting_address,
size_t size
)
{
75ec: e1a05001 mov r5, r1
uint32_t memory_available;
if ( !starting_address || !_Addresses_Is_aligned( starting_address ) )
75f0: 0a000001 beq 75fc <_Workspace_Handler_initialization+0x18>
75f4: e2141003 ands r1, r4, #3 ; 0x3
75f8: 0a000003 beq 760c <_Workspace_Handler_initialization+0x28>
_Internal_error_Occurred(
75fc: e3a00000 mov r0, #0 ; 0x0
7600: e3a01001 mov r1, #1 ; 0x1
7604: e3a02002 mov r2, #2 ; 0x2
7608: ea00000e b 7648 <_Workspace_Handler_initialization+0x64>
INTERNAL_ERROR_CORE,
TRUE,
INTERNAL_ERROR_INVALID_WORKSPACE_ADDRESS
);
if ( _Configuration_Table->do_zero_of_workspace )
760c: e59f3038 ldr r3, [pc, #56] ; 764c <_Workspace_Handler_initialization+0x68>
7610: e5933000 ldr r3, [r3]
7614: e5d33028 ldrb r3, [r3, #40]
7618: e3530000 cmp r3, #0 ; 0x0
memset( starting_address, 0, size );
761c: 11a02005 movne r2, r5
7620: 1b000e84 blne b038 <memset>
memory_available = _Heap_Initialize(
7624: e1a01004 mov r1, r4
7628: e1a02005 mov r2, r5
762c: e59f001c ldr r0, [pc, #28] ; 7650 <_Workspace_Handler_initialization+0x6c>
7630: e3a03004 mov r3, #4 ; 0x4
7634: ebfff706 bl 5254 <_Heap_Initialize>
starting_address,
size,
CPU_HEAP_ALIGNMENT
);
if ( memory_available == 0 )
7638: e3500000 cmp r0, #0 ; 0x0
763c: 18bd8030 popne {r4, r5, pc}
_Internal_error_Occurred(
7640: e3a01001 mov r1, #1 ; 0x1 <== NOT EXECUTED
7644: e3a02003 mov r2, #3 ; 0x3 <== NOT EXECUTED
7648: ebfff786 bl 5468 <_Internal_error_Occurred>
00003ac8 <rtems_clock_get>:
rtems_status_code rtems_clock_get(
rtems_clock_get_options option,
void *time_buffer
)
{
3ac8: e92d4010 push {r4, lr}
if ( !time_buffer )
3acc: e2514000 subs r4, r1, #0 ; 0x0
3ad0: 03a00009 moveq r0, #9 ; 0x9
3ad4: 08bd8010 popeq {r4, pc}
return RTEMS_INVALID_ADDRESS;
switch ( option ) {
3ad8: e3500004 cmp r0, #4 ; 0x4
3adc: 979ff100 ldrls pc, [pc, r0, lsl #2]
3ae0: ea000004 b 3af8 <rtems_clock_get+0x30>
3ae4: 00003b00 .word 0x00003b00
3ae8: 00003b0c .word 0x00003b0c
3aec: 00003b18 .word 0x00003b18 <== NOT EXECUTED
3af0: 00003b20 .word 0x00003b20 <== NOT EXECUTED
3af4: 00003b30 .word 0x00003b30 <== NOT EXECUTED
3af8: e3a0000a mov r0, #10 ; 0xa
3afc: e8bd8010 pop {r4, pc}
case RTEMS_CLOCK_GET_TOD:
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
3b00: e1a00004 mov r0, r4
break;
}
return RTEMS_INVALID_NUMBER;
}
3b04: e8bd4010 pop {r4, lr}
if ( !time_buffer )
return RTEMS_INVALID_ADDRESS;
switch ( option ) {
case RTEMS_CLOCK_GET_TOD:
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
3b08: ea000025 b 3ba4 <rtems_clock_get_tod>
case RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH:
return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer);
3b0c: e1a00004 mov r0, r4
break;
}
return RTEMS_INVALID_NUMBER;
}
3b10: e8bd4010 pop {r4, lr}
switch ( option ) {
case RTEMS_CLOCK_GET_TOD:
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
case RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH:
return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer);
3b14: ea000008 b 3b3c <rtems_clock_get_seconds_since_epoch>
case RTEMS_CLOCK_GET_TICKS_SINCE_BOOT: {
rtems_interval *interval = (rtems_interval *)time_buffer;
*interval = rtems_clock_get_ticks_since_boot();
3b18: eb00001d bl 3b94 <rtems_clock_get_ticks_since_boot>
3b1c: ea000000 b 3b24 <rtems_clock_get+0x5c>
return RTEMS_SUCCESSFUL;
}
case RTEMS_CLOCK_GET_TICKS_PER_SECOND: {
rtems_interval *interval = (rtems_interval *)time_buffer;
*interval = rtems_clock_get_ticks_per_second();
3b20: eb000013 bl 3b74 <rtems_clock_get_ticks_per_second>
3b24: e5840000 str r0, [r4]
3b28: e3a00000 mov r0, #0 ; 0x0
3b2c: e8bd8010 pop {r4, pc}
return RTEMS_SUCCESSFUL;
}
case RTEMS_CLOCK_GET_TIME_VALUE:
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
3b30: e1a00004 mov r0, r4
break;
}
return RTEMS_INVALID_NUMBER;
}
3b34: e8bd4010 pop {r4, lr}
*interval = rtems_clock_get_ticks_per_second();
return RTEMS_SUCCESSFUL;
}
case RTEMS_CLOCK_GET_TIME_VALUE:
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
3b38: ea00004b b 3c6c <rtems_clock_get_tod_timeval>
00003b74 <rtems_clock_get_ticks_per_second>:
#include <rtems/score/thread.h>
#include <rtems/score/tod.h>
#include <rtems/score/watchdog.h>
rtems_interval rtems_clock_get_ticks_per_second(void)
{
3b74: e59f3010 ldr r3, [pc, #16] ; 3b8c <rtems_clock_get_ticks_per_second+0x18>
3b78: e52de004 push {lr} ; (str lr, [sp, #-4]!)
3b7c: e5931000 ldr r1, [r3]
3b80: e59f0008 ldr r0, [pc, #8] ; 3b90 <rtems_clock_get_ticks_per_second+0x1c>
3b84: eb00364d bl 114c0 <__aeabi_uidiv>
return TOD_MICROSECONDS_PER_SECOND / _TOD_Microseconds_per_tick; }
3b88: e49df004 pop {pc} ; (ldr pc, [sp], #4)
00009414 <rtems_debug_enable>:
void rtems_debug_enable (
rtems_debug_control to_be_enabled
)
{
_Debug_Level |= to_be_enabled;
9414: e59f300c ldr r3, [pc, #12] ; 9428 <rtems_debug_enable+0x14><== NOT EXECUTED
9418: e5932000 ldr r2, [r3] <== NOT EXECUTED
941c: e1800002 orr r0, r0, r2 <== NOT EXECUTED
9420: e5830000 str r0, [r3] <== NOT EXECUTED
}
9424: e12fff1e bx lr <== NOT EXECUTED
00009460 <rtems_io_initialize>:
void *argument
)
{
rtems_device_driver_entry callout;
if ( major >= _IO_Number_of_drivers )
9460: e59f3040 ldr r3, [pc, #64] ; 94a8 <rtems_io_initialize+0x48>
9464: e5933000 ldr r3, [r3]
9468: e1500003 cmp r0, r3
rtems_status_code rtems_io_initialize(
rtems_device_major_number major,
rtems_device_minor_number minor,
void *argument
)
{
946c: e92d4010 push {r4, lr}
9470: e1a04000 mov r4, r0
rtems_device_driver_entry callout;
if ( major >= _IO_Number_of_drivers )
9474: 23a0000a movcs r0, #10 ; 0xa
9478: 28bd8010 popcs {r4, pc}
return RTEMS_INVALID_NUMBER;
callout = _IO_Driver_address_table[major].initialization_entry;
947c: e3a03018 mov r3, #24 ; 0x18
9480: e00c0493 mul ip, r3, r4
9484: e59f3020 ldr r3, [pc, #32] ; 94ac <rtems_io_initialize+0x4c>
9488: e5933000 ldr r3, [r3]
948c: e793300c ldr r3, [r3, ip]
return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL;
9490: e3530000 cmp r3, #0 ; 0x0
9494: 01a00003 moveq r0, r3
9498: 08bd8010 popeq {r4, pc}
949c: e1a0e00f mov lr, pc
94a0: e12fff13 bx r3
}
94a4: e8bd8010 pop {r4, pc}
00006cf4 <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)
{
6cf4: e92d41f0 push {r4, r5, r6, r7, r8, lr}
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
6cf8: e2507000 subs r7, r0, #0 ; 0x0
6cfc: 08bd81f0 popeq {r4, r5, r6, r7, r8, pc}
return;
6d00: e59f6054 ldr r6, [pc, #84] ; 6d5c <rtems_iterate_over_all_threads+0x68>
for ( api_index = 1 ;
api_index <= OBJECTS_APIS_LAST ;
6d04: e2868010 add r8, r6, #16 ; 0x10
api_index++ ) {
if ( !_Objects_Information_table[ api_index ] )
6d08: e5963004 ldr r3, [r6, #4]
6d0c: e3530000 cmp r3, #0 ; 0x0
6d10: 0a00000d beq 6d4c <rtems_iterate_over_all_threads+0x58>
continue;
information = _Objects_Information_table[ api_index ][ 1 ];
6d14: e5935004 ldr r5, [r3, #4]
if ( information ) {
6d18: e3550000 cmp r5, #0 ; 0x0
6d1c: 13a04001 movne r4, #1 ; 0x1
6d20: 1a000006 bne 6d40 <rtems_iterate_over_all_threads+0x4c>
6d24: ea000008 b 6d4c <rtems_iterate_over_all_threads+0x58> <== NOT EXECUTED
for ( i=1 ; i <= information->maximum ; i++ ) {
the_thread = (Thread_Control *)information->local_table[ i ];
6d28: e595301c ldr r3, [r5, #28]
6d2c: e7933104 ldr r3, [r3, r4, lsl #2]
if ( !the_thread )
6d30: e2530000 subs r0, r3, #0 ; 0x0
api_index++ ) {
if ( !_Objects_Information_table[ api_index ] )
continue;
information = _Objects_Information_table[ api_index ][ 1 ];
if ( information ) {
for ( i=1 ; i <= information->maximum ; i++ ) {
6d34: e2844001 add r4, r4, #1 ; 0x1
the_thread = (Thread_Control *)information->local_table[ i ];
if ( !the_thread )
continue;
(*routine)(the_thread);
6d38: 11a0e00f movne lr, pc
6d3c: 112fff17 bxne r7
api_index++ ) {
if ( !_Objects_Information_table[ api_index ] )
continue;
information = _Objects_Information_table[ api_index ][ 1 ];
if ( information ) {
for ( i=1 ; i <= information->maximum ; i++ ) {
6d40: e1d531b0 ldrh r3, [r5, #16]
6d44: e1540003 cmp r4, r3
6d48: 9afffff6 bls 6d28 <rtems_iterate_over_all_threads+0x34>
6d4c: e2866004 add r6, r6, #4 ; 0x4
if ( !routine )
return;
for ( api_index = 1 ;
api_index <= OBJECTS_APIS_LAST ;
6d50: e1560008 cmp r6, r8
6d54: 1affffeb bne 6d08 <rtems_iterate_over_all_threads+0x14>
6d58: e8bd81f0 pop {r4, r5, r6, r7, r8, pc}
0000af04 <rtems_rate_monotonic_get_statistics>:
rtems_status_code rtems_rate_monotonic_get_statistics(
Objects_Id id,
rtems_rate_monotonic_period_statistics *statistics
)
{
af04: e92d4030 push {r4, r5, lr} <== NOT EXECUTED
Objects_Locations location;
Rate_monotonic_Control *the_period;
if ( !statistics )
af08: e2514000 subs r4, r1, #0 ; 0x0 <== NOT EXECUTED
rtems_status_code rtems_rate_monotonic_get_statistics(
Objects_Id id,
rtems_rate_monotonic_period_statistics *statistics
)
{
af0c: e24dd004 sub sp, sp, #4 ; 0x4 <== NOT EXECUTED
Objects_Locations location;
Rate_monotonic_Control *the_period;
if ( !statistics )
af10: 03a00009 moveq r0, #9 ; 0x9 <== NOT EXECUTED
af14: 0a000013 beq af68 <rtems_rate_monotonic_get_statistics+0x64><== NOT EXECUTED
af18: e1a01000 mov r1, r0 <== NOT EXECUTED
af1c: e1a0200d mov r2, sp <== NOT EXECUTED
af20: e59f0048 ldr r0, [pc, #72] ; af70 <rtems_rate_monotonic_get_statistics+0x6c><== NOT EXECUTED
af24: ebfff16c bl 74dc <_Objects_Get> <== NOT EXECUTED
return RTEMS_INVALID_ADDRESS;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
af28: e59d5000 ldr r5, [sp] <== NOT EXECUTED
af2c: e3550000 cmp r5, #0 ; 0x0 <== NOT EXECUTED
af30: 13a00004 movne r0, #4 ; 0x4 <== NOT EXECUTED
af34: 1a00000b bne af68 <rtems_rate_monotonic_get_statistics+0x64><== NOT EXECUTED
case OBJECTS_LOCAL:
*statistics = the_period->Statistics;
af38: e280c054 add ip, r0, #84 ; 0x54 <== NOT EXECUTED
af3c: e8bc000f ldm ip!, {r0, r1, r2, r3} <== NOT EXECUTED
af40: e1a0e004 mov lr, r4 <== NOT EXECUTED
af44: e8ae000f stmia lr!, {r0, r1, r2, r3} <== NOT EXECUTED
af48: e8bc000f ldm ip!, {r0, r1, r2, r3} <== NOT EXECUTED
af4c: e8ae000f stmia lr!, {r0, r1, r2, r3} <== NOT EXECUTED
af50: e8bc000f ldm ip!, {r0, r1, r2, r3} <== NOT EXECUTED
af54: e8ae000f stmia lr!, {r0, r1, r2, r3} <== NOT EXECUTED
af58: e89c0003 ldm ip, {r0, r1} <== NOT EXECUTED
af5c: e88e0003 stm lr, {r0, r1} <== NOT EXECUTED
_Thread_Enable_dispatch();
af60: ebfff383 bl 7d74 <_Thread_Enable_dispatch> <== NOT EXECUTED
af64: e1a00005 mov r0, r5 <== NOT EXECUTED
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
af68: e28dd004 add sp, sp, #4 ; 0x4 <== NOT EXECUTED
af6c: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED
0000af74 <rtems_rate_monotonic_get_status>:
rtems_status_code rtems_rate_monotonic_get_status(
Objects_Id id,
rtems_rate_monotonic_period_status *status
)
{
af74: e92d4070 push {r4, r5, r6, lr}
Objects_Locations location;
Rate_monotonic_Control *the_period;
if ( !status )
af78: e2515000 subs r5, r1, #0 ; 0x0
rtems_status_code rtems_rate_monotonic_get_status(
Objects_Id id,
rtems_rate_monotonic_period_status *status
)
{
af7c: e24dd00c sub sp, sp, #12 ; 0xc
Objects_Locations location;
Rate_monotonic_Control *the_period;
if ( !status )
af80: 03a00009 moveq r0, #9 ; 0x9
af84: 0a000021 beq b010 <rtems_rate_monotonic_get_status+0x9c>
af88: e1a01000 mov r1, r0
af8c: e28d2008 add r2, sp, #8 ; 0x8
af90: e59f0080 ldr r0, [pc, #128] ; b018 <rtems_rate_monotonic_get_status+0xa4>
af94: ebfff150 bl 74dc <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
af98: e59d3008 ldr r3, [sp, #8]
af9c: e3530000 cmp r3, #0 ; 0x0
afa0: e1a06000 mov r6, r0
afa4: 13a00004 movne r0, #4 ; 0x4
afa8: 1a000018 bne b010 <rtems_rate_monotonic_get_status+0x9c>
case OBJECTS_LOCAL:
status->owner = ((the_period->owner) ? the_period->owner->Object.id : 0);
afac: e5963050 ldr r3, [r6, #80] <== NOT EXECUTED
afb0: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED
afb4: 01a02003 moveq r2, r3 <== NOT EXECUTED
afb8: 15932008 ldrne r2, [r3, #8] <== NOT EXECUTED
status->state = the_period->state;
afbc: e5963038 ldr r3, [r6, #56] <== NOT EXECUTED
if ( status->state == RATE_MONOTONIC_INACTIVE ) {
afc0: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
case OBJECTS_LOCAL:
status->owner = ((the_period->owner) ? the_period->owner->Object.id : 0);
afc4: e885000c stm r5, {r2, r3} <== NOT EXECUTED
#else
status->since_last_period = 0;
#endif
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
status->executed_since_last_period.tv_sec = 0;
status->executed_since_last_period.tv_nsec = 0;
afc8: 05853014 streq r3, [r5, #20] <== NOT EXECUTED
status->owner = ((the_period->owner) ? the_period->owner->Object.id : 0);
status->state = the_period->state;
if ( status->state == RATE_MONOTONIC_INACTIVE ) {
#ifdef RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS
status->since_last_period.tv_sec = 0;
afcc: 05853008 streq r3, [r5, #8] <== NOT EXECUTED
status->since_last_period.tv_nsec = 0;
afd0: 0585300c streq r3, [r5, #12] <== NOT EXECUTED
#else
status->since_last_period = 0;
#endif
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
status->executed_since_last_period.tv_sec = 0;
afd4: 05853010 streq r3, [r5, #16] <== NOT EXECUTED
afd8: 0a00000a beq b008 <rtems_rate_monotonic_get_status+0x94> <== NOT EXECUTED
* This lets them share one single invocation of _TOD_Get_uptime().
*/
#if defined(RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS) || \
defined(RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS)
struct timespec uptime;
_TOD_Get_uptime( &uptime );
afdc: e1a0000d mov r0, sp <== NOT EXECUTED
afe0: ebffeee5 bl 6b7c <_TOD_Get_uptime> <== NOT EXECUTED
#endif
#ifdef RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS
_Timespec_Subtract(
afe4: e2860044 add r0, r6, #68 ; 0x44 <== NOT EXECUTED
afe8: e1a0100d mov r1, sp <== NOT EXECUTED
afec: e2852008 add r2, r5, #8 ; 0x8 <== NOT EXECUTED
aff0: ebfff78c bl 8e28 <_Timespec_Subtract> <== NOT EXECUTED
status->since_last_period =
_Watchdog_Ticks_since_boot - the_period->time_at_period;
#endif
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
_Timespec_Subtract(
aff4: e1a0100d mov r1, sp <== NOT EXECUTED
aff8: e2852010 add r2, r5, #16 ; 0x10 <== NOT EXECUTED
affc: e59f0018 ldr r0, [pc, #24] ; b01c <rtems_rate_monotonic_get_status+0xa8><== NOT EXECUTED
* This lets them share one single invocation of _TOD_Get_uptime().
*/
#if defined(RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS) || \
defined(RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS)
struct timespec uptime;
_TOD_Get_uptime( &uptime );
b000: e1a0400d mov r4, sp <== NOT EXECUTED
status->since_last_period =
_Watchdog_Ticks_since_boot - the_period->time_at_period;
#endif
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
_Timespec_Subtract(
b004: ebfff787 bl 8e28 <_Timespec_Subtract> <== NOT EXECUTED
the_period->owner->cpu_time_used -
the_period->owner_executed_at_period;
#endif
}
_Thread_Enable_dispatch();
b008: ebfff359 bl 7d74 <_Thread_Enable_dispatch> <== NOT EXECUTED
b00c: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
b010: e28dd00c add sp, sp, #12 ; 0xc
b014: e8bd8070 pop {r4, r5, r6, pc}
000057d0 <rtems_rate_monotonic_report_statistics>:
void rtems_rate_monotonic_report_statistics( void )
{
rtems_rate_monotonic_report_statistics_with_plugin( NULL, printk_plugin );
57d0: e59f1004 ldr r1, [pc, #4] ; 57dc <rtems_rate_monotonic_report_statistics+0xc><== NOT EXECUTED
57d4: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED
57d8: eaffff79 b 55c4 <rtems_rate_monotonic_report_statistics_with_plugin><== NOT EXECUTED
000055c4 <rtems_rate_monotonic_report_statistics_with_plugin>:
*/
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
55c4: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} <== NOT EXECUTED
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
55c8: e2515000 subs r5, r1, #0 ; 0x0 <== NOT EXECUTED
*/
void rtems_rate_monotonic_report_statistics_with_plugin(
void *context,
rtems_printk_plugin_t print
)
{
55cc: e24dd070 sub sp, sp, #112 ; 0x70 <== NOT EXECUTED
55d0: e1a06000 mov r6, r0 <== NOT EXECUTED
rtems_id id;
rtems_rate_monotonic_period_statistics the_stats;
rtems_rate_monotonic_period_status the_status;
char name[5];
if ( !print )
55d4: 0a000071 beq 57a0 <rtems_rate_monotonic_report_statistics_with_plugin+0x1dc><== NOT EXECUTED
return;
(*print)( context, "Period information by period\n" );
55d8: e59f11c8 ldr r1, [pc, #456] ; 57a8 <rtems_rate_monotonic_report_statistics_with_plugin+0x1e4><== NOT EXECUTED
55dc: e1a0e00f mov lr, pc <== NOT EXECUTED
55e0: e12fff15 bx r5 <== NOT EXECUTED
#if defined(RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS) (*print)( context, "--- CPU times are in seconds ---\n" );
55e4: e59f11c0 ldr r1, [pc, #448] ; 57ac <rtems_rate_monotonic_report_statistics_with_plugin+0x1e8><== NOT EXECUTED
55e8: e1a00006 mov r0, r6 <== NOT EXECUTED
55ec: e1a0e00f mov lr, pc <== NOT EXECUTED
55f0: e12fff15 bx r5 <== NOT EXECUTED
#endif #if defined(RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS) (*print)( context, "--- Wall times are in seconds ---\n" );
55f4: e59f11b4 ldr r1, [pc, #436] ; 57b0 <rtems_rate_monotonic_report_statistics_with_plugin+0x1ec><== NOT EXECUTED
55f8: e1a00006 mov r0, r6 <== NOT EXECUTED
55fc: e1a0e00f mov lr, pc <== NOT EXECUTED
5600: e12fff15 bx r5 <== NOT EXECUTED
Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED "
5604: e59f11a8 ldr r1, [pc, #424] ; 57b4 <rtems_rate_monotonic_report_statistics_with_plugin+0x1f0><== NOT EXECUTED
5608: e1a00006 mov r0, r6 <== NOT EXECUTED
560c: e1a0e00f mov lr, pc <== NOT EXECUTED
5610: e12fff15 bx r5 <== NOT EXECUTED
#ifdef RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS
" "
#endif
" WALL TIME\n"
);
(*print)( context, " "
5614: e1a00006 mov r0, r6 <== NOT EXECUTED
5618: e59f1198 ldr r1, [pc, #408] ; 57b8 <rtems_rate_monotonic_report_statistics_with_plugin+0x1f4><== NOT EXECUTED
561c: e1a0e00f mov lr, pc <== NOT EXECUTED
5620: e12fff15 bx r5 <== NOT EXECUTED
/*
* 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 ;
5624: e59f3190 ldr r3, [pc, #400] ; 57bc <rtems_rate_monotonic_report_statistics_with_plugin+0x1f8><== NOT EXECUTED
id <= _Rate_monotonic_Information.maximum_id ;
id++ ) {
status = rtems_rate_monotonic_get_statistics( id, &the_stats );
5628: e28d8010 add r8, sp, #16 ; 0x10 <== NOT EXECUTED
/*
* 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 ;
562c: e5937008 ldr r7, [r3, #8] <== NOT EXECUTED
*/
{
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
struct timespec cpu_average;
_Timespec_Divide_by_integer(
5630: e2889018 add r9, r8, #24 ; 0x18 <== NOT EXECUTED
5634: e28db060 add fp, sp, #96 ; 0x60 <== NOT EXECUTED
* print Wall time part of statistics
*/
{
#ifdef RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS
struct timespec wall_average;
_Timespec_Divide_by_integer(
5638: e288a030 add sl, r8, #48 ; 0x30 <== NOT EXECUTED
563c: ea000051 b 5788 <rtems_rate_monotonic_report_statistics_with_plugin+0x1c4><== NOT EXECUTED
* 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 );
5640: eb00162f bl af04 <rtems_rate_monotonic_get_statistics> <== NOT EXECUTED
if ( status != RTEMS_SUCCESSFUL )
5644: e2504000 subs r4, r0, #0 ; 0x0 <== NOT EXECUTED
5648: 1a00004d bne 5784 <rtems_rate_monotonic_report_statistics_with_plugin+0x1c0><== NOT EXECUTED
continue;
/* If the above passed, so should this but check it anyway */
status = rtems_rate_monotonic_get_status( id, &the_status );
564c: e28d1048 add r1, sp, #72 ; 0x48 <== NOT EXECUTED
5650: e1a00007 mov r0, r7 <== NOT EXECUTED
5654: eb001646 bl af74 <rtems_rate_monotonic_get_status> <== NOT EXECUTED
continue;
#endif
name[ 0 ] = '\0';
if ( the_status.owner ) {
5658: e59d0048 ldr r0, [sp, #72] <== NOT EXECUTED
565c: e3500000 cmp r0, #0 ; 0x0 <== NOT EXECUTED
#if defined(RTEMS_DEBUG)
if ( status != RTEMS_SUCCESSFUL )
continue;
#endif
name[ 0 ] = '\0';
5660: e5cd406b strb r4, [sp, #107] <== NOT EXECUTED
if ( the_status.owner ) {
rtems_object_get_name( the_status.owner, sizeof(name), name );
5664: 128d206b addne r2, sp, #107 ; 0x6b <== NOT EXECUTED
5668: 13a01005 movne r1, #5 ; 0x5 <== NOT EXECUTED
566c: 1b0000b4 blne 5944 <rtems_object_get_name> <== NOT EXECUTED
/*
* Print part of report line that is not dependent on granularity
*/
(*print)( context,
5670: e59d3010 ldr r3, [sp, #16] <== NOT EXECUTED
5674: e58d3000 str r3, [sp] <== NOT EXECUTED
5678: e59d3014 ldr r3, [sp, #20] <== NOT EXECUTED
567c: e1a02007 mov r2, r7 <== NOT EXECUTED
5680: e58d3004 str r3, [sp, #4] <== NOT EXECUTED
5684: e59f1134 ldr r1, [pc, #308] ; 57c0 <rtems_rate_monotonic_report_statistics_with_plugin+0x1fc><== NOT EXECUTED
5688: e28d306b add r3, sp, #107 ; 0x6b <== NOT EXECUTED
568c: e1a00006 mov r0, r6 <== NOT EXECUTED
5690: e1a0e00f mov lr, pc <== NOT EXECUTED
5694: e12fff15 bx r5 <== NOT EXECUTED
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
5698: e59d3010 ldr r3, [sp, #16] <== NOT EXECUTED
569c: e2531000 subs r1, r3, #0 ; 0x0 <== NOT EXECUTED
*/
{
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
struct timespec cpu_average;
_Timespec_Divide_by_integer(
56a0: e1a0200b mov r2, fp <== NOT EXECUTED
56a4: e1a00009 mov r0, r9 <== NOT EXECUTED
/*
* If the count is zero, don't print statistics
*/
if (the_stats.count == 0) {
56a8: 1a000004 bne 56c0 <rtems_rate_monotonic_report_statistics_with_plugin+0xfc><== NOT EXECUTED
(*print)( context, "\n" );
56ac: e1a00006 mov r0, r6 <== NOT EXECUTED
56b0: e59f110c ldr r1, [pc, #268] ; 57c4 <rtems_rate_monotonic_report_statistics_with_plugin+0x200><== NOT EXECUTED
56b4: e1a0e00f mov lr, pc <== NOT EXECUTED
56b8: e12fff15 bx r5 <== NOT EXECUTED
56bc: ea000030 b 5784 <rtems_rate_monotonic_report_statistics_with_plugin+0x1c0><== NOT EXECUTED
*/
{
#ifdef RTEMS_ENABLE_NANOSECOND_CPU_USAGE_STATISTICS
struct timespec cpu_average;
_Timespec_Divide_by_integer(
56c0: eb000d9f bl 8d44 <_Timespec_Divide_by_integer> <== NOT EXECUTED
&the_stats.total_cpu_time,
the_stats.count,
&cpu_average
);
(*print)( context,
56c4: e59d001c ldr r0, [sp, #28] <== NOT EXECUTED
56c8: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
56cc: eb003da3 bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
56d0: e59d3020 ldr r3, [sp, #32] <== NOT EXECUTED
56d4: e1a04000 mov r4, r0 <== NOT EXECUTED
56d8: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
56dc: e59d0024 ldr r0, [sp, #36] <== NOT EXECUTED
56e0: e58d3000 str r3, [sp] <== NOT EXECUTED
56e4: eb003d9d bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
56e8: e59d3060 ldr r3, [sp, #96] <== NOT EXECUTED
56ec: e58d0004 str r0, [sp, #4] <== NOT EXECUTED
56f0: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
56f4: e59d0064 ldr r0, [sp, #100] <== NOT EXECUTED
56f8: e58d3008 str r3, [sp, #8] <== NOT EXECUTED
56fc: eb003d97 bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
5700: e1a03004 mov r3, r4 <== NOT EXECUTED
5704: e58d000c str r0, [sp, #12] <== NOT EXECUTED
5708: e59f10b8 ldr r1, [pc, #184] ; 57c8 <rtems_rate_monotonic_report_statistics_with_plugin+0x204><== NOT EXECUTED
570c: e59d2018 ldr r2, [sp, #24] <== NOT EXECUTED
5710: e1a00006 mov r0, r6 <== NOT EXECUTED
5714: e1a0e00f mov lr, pc <== NOT EXECUTED
5718: e12fff15 bx r5 <== NOT EXECUTED
* print Wall time part of statistics
*/
{
#ifdef RTEMS_ENABLE_NANOSECOND_RATE_MONOTONIC_STATISTICS
struct timespec wall_average;
_Timespec_Divide_by_integer(
571c: e1a0200b mov r2, fp <== NOT EXECUTED
5720: e1a0000a mov r0, sl <== NOT EXECUTED
5724: e59d1010 ldr r1, [sp, #16] <== NOT EXECUTED
5728: eb000d85 bl 8d44 <_Timespec_Divide_by_integer> <== NOT EXECUTED
&the_stats.total_wall_time,
the_stats.count,
&wall_average
);
(*print)( context,
572c: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
5730: e59d0034 ldr r0, [sp, #52] <== NOT EXECUTED
5734: eb003d89 bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
5738: e59d3038 ldr r3, [sp, #56] <== NOT EXECUTED
573c: e1a04000 mov r4, r0 <== NOT EXECUTED
5740: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
5744: e59d003c ldr r0, [sp, #60] <== NOT EXECUTED
5748: e58d3000 str r3, [sp] <== NOT EXECUTED
574c: eb003d83 bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
5750: e59d3060 ldr r3, [sp, #96] <== NOT EXECUTED
5754: e58d0004 str r0, [sp, #4] <== NOT EXECUTED
5758: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED
575c: e59d0064 ldr r0, [sp, #100] <== NOT EXECUTED
5760: e58d3008 str r3, [sp, #8] <== NOT EXECUTED
5764: eb003d7d bl 14d60 <__aeabi_idiv> <== NOT EXECUTED
5768: e1a03004 mov r3, r4 <== NOT EXECUTED
576c: e58d000c str r0, [sp, #12] <== NOT EXECUTED
5770: e59f1054 ldr r1, [pc, #84] ; 57cc <rtems_rate_monotonic_report_statistics_with_plugin+0x208><== NOT EXECUTED
5774: e1a00006 mov r0, r6 <== NOT EXECUTED
5778: e59d2030 ldr r2, [sp, #48] <== NOT EXECUTED
577c: e1a0e00f mov lr, pc <== NOT EXECUTED
5780: e12fff15 bx r5 <== NOT EXECUTED
* 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++ ) {
5784: e2877001 add r7, r7, #1 ; 0x1 <== NOT EXECUTED
/*
* 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 ;
5788: e59f202c ldr r2, [pc, #44] ; 57bc <rtems_rate_monotonic_report_statistics_with_plugin+0x1f8><== NOT EXECUTED
578c: e592300c ldr r3, [r2, #12] <== NOT EXECUTED
5790: e1570003 cmp r7, r3 <== NOT EXECUTED
id++ ) {
status = rtems_rate_monotonic_get_statistics( id, &the_stats );
5794: e1a00007 mov r0, r7 <== NOT EXECUTED
5798: e1a01008 mov r1, r8 <== NOT EXECUTED
/*
* 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 ;
579c: 9affffa7 bls 5640 <rtems_rate_monotonic_report_statistics_with_plugin+0x7c><== NOT EXECUTED
the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall
);
#endif
}
}
}
57a0: e28dd070 add sp, sp, #112 ; 0x70 <== NOT EXECUTED
57a4: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED
000057e0 <rtems_rate_monotonic_reset_all_statistics>:
57e0: e59f303c ldr r3, [pc, #60] ; 5824 <rtems_rate_monotonic_reset_all_statistics+0x44><== NOT EXECUTED
57e4: e5932000 ldr r2, [r3] <== NOT EXECUTED
57e8: e2822001 add r2, r2, #1 ; 0x1 <== NOT EXECUTED
/*
* rtems_rate_monotonic_reset_all_statistics
*/
void rtems_rate_monotonic_reset_all_statistics( void )
{
57ec: e92d4030 push {r4, r5, lr} <== NOT EXECUTED
57f0: e5832000 str r2, [r3] <== NOT EXECUTED
/*
* Cycle through all possible ids and try to reset 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 ;
57f4: e59f302c ldr r3, [pc, #44] ; 5828 <rtems_rate_monotonic_reset_all_statistics+0x48><== NOT EXECUTED
id <= _Rate_monotonic_Information.maximum_id ;
57f8: e1a05003 mov r5, r3 <== NOT EXECUTED
/*
* Cycle through all possible ids and try to reset 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 ;
57fc: e5934008 ldr r4, [r3, #8] <== NOT EXECUTED
5800: ea000000 b 5808 <rtems_rate_monotonic_reset_all_statistics+0x28><== NOT EXECUTED
id <= _Rate_monotonic_Information.maximum_id ;
id++ ) {
status = rtems_rate_monotonic_reset_statistics( id );
5804: eb000008 bl 582c <rtems_rate_monotonic_reset_statistics> <== NOT EXECUTED
/*
* Cycle through all possible ids and try to reset 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 ;
5808: e595300c ldr r3, [r5, #12] <== NOT EXECUTED
580c: e1540003 cmp r4, r3 <== NOT EXECUTED
id++ ) {
status = rtems_rate_monotonic_reset_statistics( id );
5810: e1a00004 mov r0, r4 <== NOT EXECUTED
* Cycle through all possible ids and try to reset 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++ ) {
5814: e2844001 add r4, r4, #1 ; 0x1 <== NOT EXECUTED
/*
* Cycle through all possible ids and try to reset 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 ;
5818: 9afffff9 bls 5804 <rtems_rate_monotonic_reset_all_statistics+0x24><== NOT EXECUTED
/*
* Done so exit thread dispatching disabled critical section.
*/
_Thread_Enable_dispatch();
}
581c: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED
}
/*
* Done so exit thread dispatching disabled critical section.
*/
_Thread_Enable_dispatch();
5820: ea000953 b 7d74 <_Thread_Enable_dispatch> <== NOT EXECUTED
0000582c <rtems_rate_monotonic_reset_statistics>:
*/
rtems_status_code rtems_rate_monotonic_reset_statistics(
Objects_Id id
)
{
582c: e92d4030 push {r4, r5, lr} <== NOT EXECUTED
5830: e24dd004 sub sp, sp, #4 ; 0x4 <== NOT EXECUTED
5834: e1a01000 mov r1, r0 <== NOT EXECUTED
5838: e1a0200d mov r2, sp <== NOT EXECUTED
583c: e59f0048 ldr r0, [pc, #72] ; 588c <rtems_rate_monotonic_reset_statistics+0x60><== NOT EXECUTED
5840: eb000725 bl 74dc <_Objects_Get> <== NOT EXECUTED
Objects_Locations location;
Rate_monotonic_Control *the_period;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
5844: e59d5000 ldr r5, [sp] <== NOT EXECUTED
5848: e3550000 cmp r5, #0 ; 0x0 <== NOT EXECUTED
584c: e1a04000 mov r4, r0 <== NOT EXECUTED
5850: 13a00004 movne r0, #4 ; 0x4 <== NOT EXECUTED
5854: 1a00000a bne 5884 <rtems_rate_monotonic_reset_statistics+0x58><== NOT EXECUTED
case OBJECTS_LOCAL:
_Rate_monotonic_Reset_statistics( the_period );
5858: e1a01005 mov r1, r5 <== NOT EXECUTED
585c: e3a02038 mov r2, #56 ; 0x38 <== NOT EXECUTED
5860: e2840054 add r0, r4, #84 ; 0x54 <== NOT EXECUTED
5864: eb001d73 bl ce38 <memset> <== NOT EXECUTED
5868: e3e03102 mvn r3, #-2147483648 ; 0x80000000 <== NOT EXECUTED
586c: e5843078 str r3, [r4, #120] <== NOT EXECUTED
5870: e584305c str r3, [r4, #92] <== NOT EXECUTED
5874: e5843060 str r3, [r4, #96] <== NOT EXECUTED
5878: e5843074 str r3, [r4, #116] <== NOT EXECUTED
_Thread_Enable_dispatch();
587c: eb00093c bl 7d74 <_Thread_Enable_dispatch> <== NOT EXECUTED
5880: e1a00005 mov r0, r5 <== NOT EXECUTED
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
5884: e28dd004 add sp, sp, #4 ; 0x4 <== NOT EXECUTED
5888: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED
0000f63c <rtems_region_extend>:
rtems_status_code rtems_region_extend(
Objects_Id id,
void *starting_address,
uint32_t length
)
{
f63c: e92d40f0 push {r4, r5, r6, r7, lr}
Heap_Extend_status heap_status;
Objects_Locations location;
rtems_status_code return_status = RTEMS_INTERNAL_ERROR;
Region_Control *the_region;
if ( !starting_address )
f640: e2517000 subs r7, r1, #0 ; 0x0
rtems_status_code rtems_region_extend(
Objects_Id id,
void *starting_address,
uint32_t length
)
{
f644: e1a04000 mov r4, r0
f648: e24dd008 sub sp, sp, #8 ; 0x8
f64c: e1a06002 mov r6, r2
Heap_Extend_status heap_status;
Objects_Locations location;
rtems_status_code return_status = RTEMS_INTERNAL_ERROR;
Region_Control *the_region;
if ( !starting_address )
f650: 03a04009 moveq r4, #9 ; 0x9
f654: 0a000029 beq f700 <rtems_region_extend+0xc4>
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator(); /* to prevent deletion */
f658: e59f30ac ldr r3, [pc, #172] ; f70c <rtems_region_extend+0xd0>
f65c: e5930000 ldr r0, [r3]
f660: eb0008c6 bl 11980 <_API_Mutex_Lock>
RTEMS_INLINE_ROUTINE Region_Control *_Region_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Region_Control *)
f664: e1a01004 mov r1, r4
f668: e59f00a0 ldr r0, [pc, #160] ; f710 <rtems_region_extend+0xd4>
f66c: e1a0200d mov r2, sp
f670: eb000f3f bl 13374 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
f674: e59d5000 ldr r5, [sp]
f678: e3550000 cmp r5, #0 ; 0x0
f67c: e1a04000 mov r4, r0
f680: 0a000003 beq f694 <rtems_region_extend+0x58>
f684: e3550001 cmp r5, #1 ; 0x1
f688: 03a04004 moveq r4, #4 ; 0x4
f68c: 1a000017 bne f6f0 <rtems_region_extend+0xb4>
f690: ea000017 b f6f4 <rtems_region_extend+0xb8>
case OBJECTS_LOCAL:
heap_status = _Heap_Extend(
f694: e1a01007 mov r1, r7
f698: e1a02006 mov r2, r6
f69c: e2800068 add r0, r0, #104 ; 0x68
f6a0: e28d3004 add r3, sp, #4 ; 0x4
f6a4: eb000baf bl 12568 <_Heap_Extend>
starting_address,
length,
&amount_extended
);
switch ( heap_status ) {
f6a8: e3500001 cmp r0, #1 ; 0x1
f6ac: 03a04009 moveq r4, #9 ; 0x9
f6b0: 0a00000f beq f6f4 <rtems_region_extend+0xb8>
f6b4: 3a000002 bcc f6c4 <rtems_region_extend+0x88>
f6b8: e3500002 cmp r0, #2 ; 0x2
f6bc: 1a00000b bne f6f0 <rtems_region_extend+0xb4>
f6c0: ea000008 b f6e8 <rtems_region_extend+0xac>
case HEAP_EXTEND_SUCCESSFUL:
the_region->length += amount_extended;
f6c4: e59d1004 ldr r1, [sp, #4]
f6c8: e5942054 ldr r2, [r4, #84]
the_region->maximum_segment_size += amount_extended;
f6cc: e594305c ldr r3, [r4, #92]
&amount_extended
);
switch ( heap_status ) {
case HEAP_EXTEND_SUCCESSFUL:
the_region->length += amount_extended;
f6d0: e0822001 add r2, r2, r1
the_region->maximum_segment_size += amount_extended;
f6d4: e0833001 add r3, r3, r1
f6d8: e584305c str r3, [r4, #92]
&amount_extended
);
switch ( heap_status ) {
case HEAP_EXTEND_SUCCESSFUL:
the_region->length += amount_extended;
f6dc: e5842054 str r2, [r4, #84]
the_region->maximum_segment_size += amount_extended;
f6e0: e1a04005 mov r4, r5
f6e4: ea000002 b f6f4 <rtems_region_extend+0xb8>
return_status = RTEMS_SUCCESSFUL;
break;
f6e8: e3a04018 mov r4, #24 ; 0x18
f6ec: ea000000 b f6f4 <rtems_region_extend+0xb8>
f6f0: e3a04019 mov r4, #25 ; 0x19 <== NOT EXECUTED
case OBJECTS_ERROR:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
f6f4: e59f3010 ldr r3, [pc, #16] ; f70c <rtems_region_extend+0xd0>
f6f8: e5930000 ldr r0, [r3]
f6fc: eb0008bb bl 119f0 <_API_Mutex_Unlock>
return return_status; }
f700: e1a00004 mov r0, r4
f704: e28dd008 add sp, sp, #8 ; 0x8
f708: e8bd80f0 pop {r4, r5, r6, r7, pc}
0000fa38 <rtems_region_resize_segment>:
Objects_Id id,
void *segment,
size_t size,
size_t *old_size
)
{
fa38: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr}
uint32_t osize;
rtems_status_code return_status = RTEMS_INTERNAL_ERROR;
Heap_Resize_status status;
register Region_Control *the_region;
if ( !old_size )
fa3c: e253a000 subs sl, r3, #0 ; 0x0
Objects_Id id,
void *segment,
size_t size,
size_t *old_size
)
{
fa40: e24dd010 sub sp, sp, #16 ; 0x10
fa44: e1a04000 mov r4, r0
fa48: e1a06001 mov r6, r1
fa4c: e1a07002 mov r7, r2
uint32_t osize;
rtems_status_code return_status = RTEMS_INTERNAL_ERROR;
Heap_Resize_status status;
register Region_Control *the_region;
if ( !old_size )
fa50: 0a000029 beq fafc <rtems_region_resize_segment+0xc4>
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator();
fa54: e59f80b0 ldr r8, [pc, #176] ; fb0c <rtems_region_resize_segment+0xd4>
fa58: e5980000 ldr r0, [r8]
fa5c: eb0007c7 bl 11980 <_API_Mutex_Lock>
fa60: e1a01004 mov r1, r4
fa64: e59f00a4 ldr r0, [pc, #164] ; fb10 <rtems_region_resize_segment+0xd8>
fa68: e28d2008 add r2, sp, #8 ; 0x8
fa6c: eb000e40 bl 13374 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
fa70: e59d3008 ldr r3, [sp, #8]
fa74: e3530000 cmp r3, #0 ; 0x0
fa78: e1a05000 mov r5, r0
fa7c: 0a000005 beq fa98 <rtems_region_resize_segment+0x60>
fa80: e3530001 cmp r3, #1 ; 0x1
case OBJECTS_ERROR:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
fa84: e5980000 ldr r0, [r8]
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator();
the_region = _Region_Get( id, &location );
switch ( location ) {
fa88: 03a04004 moveq r4, #4 ; 0x4
fa8c: 13a04019 movne r4, #25 ; 0x19
case OBJECTS_ERROR:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
fa90: eb0007d6 bl 119f0 <_API_Mutex_Unlock>
fa94: ea000019 b fb00 <rtems_region_resize_segment+0xc8>
case OBJECTS_LOCAL:
_Region_Debug_Walk( the_region, 7 );
status = _Heap_Resize_block(
fa98: e28d3004 add r3, sp, #4 ; 0x4
fa9c: e28dc00c add ip, sp, #12 ; 0xc
faa0: e1a01006 mov r1, r6
faa4: e1a02007 mov r2, r7
faa8: e2800068 add r0, r0, #104 ; 0x68
faac: e58dc000 str ip, [sp]
fab0: eb000c2a bl 12b60 <_Heap_Resize_block>
segment,
(uint32_t) size,
&osize,
&avail_size
);
*old_size = (uint32_t) osize;
fab4: e59d3004 ldr r3, [sp, #4]
_Region_Debug_Walk( the_region, 8 );
if ( status == HEAP_RESIZE_SUCCESSFUL && avail_size > 0 )
fab8: e2504000 subs r4, r0, #0 ; 0x0
segment,
(uint32_t) size,
&osize,
&avail_size
);
*old_size = (uint32_t) osize;
fabc: e58a3000 str r3, [sl]
_Region_Debug_Walk( the_region, 8 );
if ( status == HEAP_RESIZE_SUCCESSFUL && avail_size > 0 )
fac0: 1a000005 bne fadc <rtems_region_resize_segment+0xa4>
fac4: e59d300c ldr r3, [sp, #12] <== NOT EXECUTED
fac8: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED
facc: 0a000002 beq fadc <rtems_region_resize_segment+0xa4> <== NOT EXECUTED
_Region_Process_queue( the_region ); /* unlocks allocator */
fad0: e1a00005 mov r0, r5 <== NOT EXECUTED
fad4: eb001d6a bl 17084 <_Region_Process_queue> <== NOT EXECUTED
fad8: ea000008 b fb00 <rtems_region_resize_segment+0xc8> <== NOT EXECUTED
else
_RTEMS_Unlock_allocator();
fadc: e59f3028 ldr r3, [pc, #40] ; fb0c <rtems_region_resize_segment+0xd4>
fae0: e5930000 ldr r0, [r3]
fae4: eb0007c1 bl 119f0 <_API_Mutex_Unlock>
return
fae8: e3540000 cmp r4, #0 ; 0x0
faec: 0a000003 beq fb00 <rtems_region_resize_segment+0xc8>
faf0: e3540001 cmp r4, #1 ; 0x1
faf4: 0284400c addeq r4, r4, #12 ; 0xc
faf8: 0a000000 beq fb00 <rtems_region_resize_segment+0xc8>
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
return return_status;
fafc: e3a04009 mov r4, #9 ; 0x9
}
fb00: e1a00004 mov r0, r4
fb04: e28dd010 add sp, sp, #16 ; 0x10
fb08: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc}
000040dc <rtems_semaphore_create>:
uint32_t count,
rtems_attribute attribute_set,
rtems_task_priority priority_ceiling,
rtems_id *id
)
{
40dc: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr}
register Semaphore_Control *the_semaphore;
CORE_mutex_Attributes the_mutex_attributes;
CORE_semaphore_Attributes the_semaphore_attributes;
if ( !rtems_is_name_valid( name ) )
40e0: e250a000 subs sl, r0, #0 ; 0x0
uint32_t count,
rtems_attribute attribute_set,
rtems_task_priority priority_ceiling,
rtems_id *id
)
{
40e4: e24dd018 sub sp, sp, #24 ; 0x18
40e8: e1a07001 mov r7, r1
40ec: e1a04002 mov r4, r2
40f0: e1a08003 mov r8, r3
40f4: e59d9038 ldr r9, [sp, #56]
register Semaphore_Control *the_semaphore;
CORE_mutex_Attributes the_mutex_attributes;
CORE_semaphore_Attributes the_semaphore_attributes;
if ( !rtems_is_name_valid( name ) )
40f8: 02800003 addeq r0, r0, #3 ; 0x3
40fc: 0a000062 beq 428c <rtems_semaphore_create+0x1b0>
return RTEMS_INVALID_NAME;
if ( !id )
4100: e3590000 cmp r9, #0 ; 0x0
4104: 03a00009 moveq r0, #9 ; 0x9
4108: 0a00005f beq 428c <rtems_semaphore_create+0x1b0>
return RTEMS_NOT_DEFINED;
} else
#endif
if ( _Attributes_Is_inherit_priority( attribute_set ) ||
410c: e21220c0 ands r2, r2, #192 ; 0xc0
4110: 0a000008 beq 4138 <rtems_semaphore_create+0x5c>
*/
RTEMS_INLINE_ROUTINE bool _Attributes_Is_binary_semaphore(
rtems_attribute attribute_set
)
{
return ((attribute_set & RTEMS_SEMAPHORE_CLASS) == RTEMS_BINARY_SEMAPHORE);
4114: e2043030 and r3, r4, #48 ; 0x30
_Attributes_Is_priority_ceiling( attribute_set ) ) {
if ( ! ( (_Attributes_Is_binary_semaphore( attribute_set ) ||
4118: e3530010 cmp r3, #16 ; 0x10
411c: 0a000001 beq 4128 <rtems_semaphore_create+0x4c>
4120: e3530020 cmp r3, #32 ; 0x20
4124: 1a000057 bne 4288 <rtems_semaphore_create+0x1ac>
4128: e3140004 tst r4, #4 ; 0x4
412c: 0a000055 beq 4288 <rtems_semaphore_create+0x1ac>
_Attributes_Is_priority( attribute_set ) ) )
return RTEMS_NOT_DEFINED;
}
if ( _Attributes_Is_inherit_priority( attribute_set ) &&
4130: e35200c0 cmp r2, #192 ; 0xc0
4134: 0a000053 beq 4288 <rtems_semaphore_create+0x1ac>
_Attributes_Is_priority_ceiling( attribute_set ) )
return RTEMS_NOT_DEFINED;
if ( !_Attributes_Is_counting_semaphore( attribute_set ) && ( count > 1 ) )
4138: e2146030 ands r6, r4, #48 ; 0x30
413c: 0a000002 beq 414c <rtems_semaphore_create+0x70>
4140: e3570001 cmp r7, #1 ; 0x1
4144: 83a0000a movhi r0, #10 ; 0xa
4148: 8a00004f bhi 428c <rtems_semaphore_create+0x1b0>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
414c: e59f2140 ldr r2, [pc, #320] ; 4294 <rtems_semaphore_create+0x1b8>
4150: e5923000 ldr r3, [r2]
4154: e2833001 add r3, r3, #1 ; 0x1
4158: e5823000 str r3, [r2]
* This function allocates a semaphore control block from
* the inactive chain of free semaphore control blocks.
*/
RTEMS_INLINE_ROUTINE Semaphore_Control *_Semaphore_Allocate( void )
{
return (Semaphore_Control *) _Objects_Allocate( &_Semaphore_Information );
415c: e59f0134 ldr r0, [pc, #308] ; 4298 <rtems_semaphore_create+0x1bc>
4160: eb0004da bl 54d0 <_Objects_Allocate>
_Thread_Disable_dispatch(); /* prevents deletion */
the_semaphore = _Semaphore_Allocate();
if ( !the_semaphore ) {
4164: e2505000 subs r5, r0, #0 ; 0x0
4168: 1a000002 bne 4178 <rtems_semaphore_create+0x9c>
_Thread_Enable_dispatch();
416c: eb000825 bl 6208 <_Thread_Enable_dispatch>
4170: e3a00005 mov r0, #5 ; 0x5
4174: ea000044 b 428c <rtems_semaphore_create+0x1b0>
* If it is not a counting semaphore, then it is either a
* simple binary semaphore or a more powerful mutex style binary
* semaphore.
*/
if ( !_Attributes_Is_counting_semaphore( attribute_set ) ) {
4178: e3560000 cmp r6, #0 ; 0x0
_Thread_Enable_dispatch();
return RTEMS_TOO_MANY;
}
#endif
the_semaphore->attribute_set = attribute_set;
417c: e5854010 str r4, [r5, #16]
* If it is not a counting semaphore, then it is either a
* simple binary semaphore or a more powerful mutex style binary
* semaphore.
*/
if ( !_Attributes_Is_counting_semaphore( attribute_set ) ) {
4180: 0a000029 beq 422c <rtems_semaphore_create+0x150>
CORE_mutex_Status mutex_status;
if ( _Attributes_Is_inherit_priority( attribute_set ) )
4184: e3140040 tst r4, #64 ; 0x40
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
4188: 13a03002 movne r3, #2 ; 0x2
*/
if ( !_Attributes_Is_counting_semaphore( attribute_set ) ) {
CORE_mutex_Status mutex_status;
if ( _Attributes_Is_inherit_priority( attribute_set ) )
418c: 1a000004 bne 41a4 <rtems_semaphore_create+0xc8>
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
else if ( _Attributes_Is_priority_ceiling( attribute_set ) )
4190: e3140080 tst r4, #128 ; 0x80
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING;
4194: 13a03003 movne r3, #3 ; 0x3
if ( !_Attributes_Is_counting_semaphore( attribute_set ) ) {
CORE_mutex_Status mutex_status;
if ( _Attributes_Is_inherit_priority( attribute_set ) )
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
else if ( _Attributes_Is_priority_ceiling( attribute_set ) )
4198: 1a000001 bne 41a4 <rtems_semaphore_create+0xc8>
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING;
else if ( _Attributes_Is_priority( attribute_set ) )
419c: e2143004 ands r3, r4, #4 ; 0x4
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY;
41a0: 13a03001 movne r3, #1 ; 0x1
else
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_FIFO;
if ( _Attributes_Is_binary_semaphore( attribute_set ) ) {
41a4: e3560010 cmp r6, #16 ; 0x10
else if ( _Attributes_Is_priority_ceiling( attribute_set ) )
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING;
else if ( _Attributes_Is_priority( attribute_set ) )
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY;
else
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_FIFO;
41a8: e58d3008 str r3, [sp, #8]
case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT:
the_mutex_attributes.only_owner_release = TRUE;
break;
}
} else {
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_BLOCKS;
41ac: 13a03002 movne r3, #2 ; 0x2
41b0: 158d3000 strne r3, [sp]
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY;
else
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_FIFO;
if ( _Attributes_Is_binary_semaphore( attribute_set ) ) {
41b4: 1a00000b bne 41e8 <rtems_semaphore_create+0x10c>
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
switch ( the_mutex_attributes.discipline ) {
41b8: e59d2008 ldr r2, [sp, #8]
else
the_mutex_attributes.discipline = CORE_MUTEX_DISCIPLINES_FIFO;
if ( _Attributes_Is_binary_semaphore( attribute_set ) ) {
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
41bc: e3a03000 mov r3, #0 ; 0x0
41c0: e58d3000 str r3, [sp]
switch ( the_mutex_attributes.discipline ) {
41c4: e3520003 cmp r2, #3 ; 0x3
41c8: 979ff102 ldrls pc, [pc, r2, lsl #2]
41cc: ea000007 b 41f0 <rtems_semaphore_create+0x114> <== NOT EXECUTED
41d0: 000041e8 .word 0x000041e8 <== NOT EXECUTED
41d4: 000041e8 .word 0x000041e8 <== NOT EXECUTED
41d8: 000041e0 .word 0x000041e0 <== NOT EXECUTED
41dc: 000041e0 .word 0x000041e0 <== NOT EXECUTED
case CORE_MUTEX_DISCIPLINES_PRIORITY:
the_mutex_attributes.only_owner_release = FALSE;
break;
case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING:
case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT:
the_mutex_attributes.only_owner_release = TRUE;
41e0: e3a03001 mov r3, #1 ; 0x1
41e4: ea000000 b 41ec <rtems_semaphore_create+0x110>
break;
}
} else {
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_BLOCKS;
the_mutex_attributes.only_owner_release = FALSE;
41e8: e3a03000 mov r3, #0 ; 0x0
41ec: e5cd3004 strb r3, [sp, #4]
}
the_mutex_attributes.priority_ceiling = priority_ceiling;
mutex_status = _CORE_mutex_Initialize(
41f0: e3570001 cmp r7, #1 ; 0x1
41f4: 13a02000 movne r2, #0 ; 0x0
41f8: 03a02001 moveq r2, #1 ; 0x1
41fc: e2850014 add r0, r5, #20 ; 0x14
4200: e1a0100d mov r1, sp
} else {
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_BLOCKS;
the_mutex_attributes.only_owner_release = FALSE;
}
the_mutex_attributes.priority_ceiling = priority_ceiling;
4204: e58d800c str r8, [sp, #12]
mutex_status = _CORE_mutex_Initialize(
4208: eb0002d9 bl 4d74 <_CORE_mutex_Initialize>
&the_semaphore->Core_control.mutex,
&the_mutex_attributes,
(count == 1) ? CORE_MUTEX_UNLOCKED : CORE_MUTEX_LOCKED
);
if ( mutex_status == CORE_MUTEX_STATUS_CEILING_VIOLATED ) {
420c: e3500006 cmp r0, #6 ; 0x6
4210: 1a000012 bne 4260 <rtems_semaphore_create+0x184>
*/
RTEMS_INLINE_ROUTINE void _Semaphore_Free (
Semaphore_Control *the_semaphore
)
{
_Objects_Free( &_Semaphore_Information, &the_semaphore->Object );
4214: e59f007c ldr r0, [pc, #124] ; 4298 <rtems_semaphore_create+0x1bc><== NOT EXECUTED
4218: e1a01005 mov r1, r5 <== NOT EXECUTED
421c: eb00057a bl 580c <_Objects_Free> <== NOT EXECUTED
_Semaphore_Free( the_semaphore );
_Thread_Enable_dispatch();
4220: eb0007f8 bl 6208 <_Thread_Enable_dispatch> <== NOT EXECUTED
4224: e3a00013 mov r0, #19 ; 0x13 <== NOT EXECUTED
4228: ea000017 b 428c <rtems_semaphore_create+0x1b0> <== NOT EXECUTED
return RTEMS_INVALID_PRIORITY;
}
} else {
if ( _Attributes_Is_priority( attribute_set ) )
422c: e3140004 tst r4, #4 ; 0x4
the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY;
4230: 13a03001 movne r3, #1 ; 0x1
/*
* The following are just to make Purify happy.
*/
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
4234: e3a0c000 mov ip, #0 ; 0x0
_Thread_Enable_dispatch();
return RTEMS_INVALID_PRIORITY;
}
} else {
if ( _Attributes_Is_priority( attribute_set ) )
the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY;
4238: 158d3014 strne r3, [sp, #20]
*/
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
the_mutex_attributes.priority_ceiling = PRIORITY_MINIMUM;
_CORE_semaphore_Initialize(
423c: e1a02007 mov r2, r7
/*
* This effectively disables limit checking.
*/
the_semaphore_attributes.maximum_count = 0xFFFFFFFF;
4240: e3e03000 mvn r3, #0 ; 0x0
*/
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
the_mutex_attributes.priority_ceiling = PRIORITY_MINIMUM;
_CORE_semaphore_Initialize(
4244: e2850014 add r0, r5, #20 ; 0x14
4248: e28d1010 add r1, sp, #16 ; 0x10
}
} else {
if ( _Attributes_Is_priority( attribute_set ) )
the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY;
else
the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;
424c: 058d6014 streq r6, [sp, #20]
/*
* This effectively disables limit checking.
*/
the_semaphore_attributes.maximum_count = 0xFFFFFFFF;
4250: e58d3010 str r3, [sp, #16]
/*
* The following are just to make Purify happy.
*/
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
the_mutex_attributes.priority_ceiling = PRIORITY_MINIMUM;
4254: e58dc00c str ip, [sp, #12]
/*
* The following are just to make Purify happy.
*/
the_mutex_attributes.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES;
4258: e58dc000 str ip, [sp]
the_mutex_attributes.priority_ceiling = PRIORITY_MINIMUM;
_CORE_semaphore_Initialize(
425c: eb000391 bl 50a8 <_CORE_semaphore_Initialize>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4260: e59f3030 ldr r3, [pc, #48] ; 4298 <rtems_semaphore_create+0x1bc>
4264: e5952008 ldr r2, [r5, #8]
4268: e593101c ldr r1, [r3, #28]
426c: e1d530b8 ldrh r3, [r5, #8]
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
4270: e585a00c str sl, [r5, #12]
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4274: e7815103 str r5, [r1, r3, lsl #2]
&_Semaphore_Information,
&the_semaphore->Object,
(Objects_Name) name
);
*id = the_semaphore->Object.id;
4278: e5892000 str r2, [r9]
the_semaphore->Object.id,
name,
0 /* Not used */
);
#endif
_Thread_Enable_dispatch();
427c: eb0007e1 bl 6208 <_Thread_Enable_dispatch>
4280: e3a00000 mov r0, #0 ; 0x0
4284: ea000000 b 428c <rtems_semaphore_create+0x1b0>
return RTEMS_SUCCESSFUL;
4288: e3a0000b mov r0, #11 ; 0xb
}
428c: e28dd018 add sp, sp, #24 ; 0x18
4290: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc}
0000fe18 <rtems_semaphore_flush>:
#endif
rtems_status_code rtems_semaphore_flush(
rtems_id id
)
{
fe18: e52de004 push {lr} ; (str lr, [sp, #-4]!)
fe1c: e24dd004 sub sp, sp, #4 ; 0x4
fe20: e1a01000 mov r1, r0
RTEMS_INLINE_ROUTINE Semaphore_Control *_Semaphore_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Semaphore_Control *)
fe24: e1a0200d mov r2, sp
fe28: e59f0048 ldr r0, [pc, #72] ; fe78 <rtems_semaphore_flush+0x60>
fe2c: eb000d61 bl 133b8 <_Objects_Get>
register Semaphore_Control *the_semaphore;
Objects_Locations location;
the_semaphore = _Semaphore_Get( id, &location );
switch ( location ) {
fe30: e59d2000 ldr r2, [sp]
fe34: e3520000 cmp r2, #0 ; 0x0
fe38: 13a00004 movne r0, #4 ; 0x4
fe3c: 1a00000b bne fe70 <rtems_semaphore_flush+0x58>
case OBJECTS_LOCAL:
if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) {
fe40: e5903010 ldr r3, [r0, #16]
fe44: e2131030 ands r1, r3, #48 ; 0x30
fe48: e2800014 add r0, r0, #20 ; 0x14
fe4c: 0a000003 beq fe60 <rtems_semaphore_flush+0x48>
_CORE_mutex_Flush(
fe50: e1a01002 mov r1, r2
fe54: e3a02001 mov r2, #1 ; 0x1
fe58: eb00082b bl 11f0c <_CORE_mutex_Flush>
fe5c: ea000001 b fe68 <rtems_semaphore_flush+0x50>
&the_semaphore->Core_control.mutex,
SEND_OBJECT_WAS_DELETED,
CORE_MUTEX_STATUS_UNSATISFIED_NOWAIT
);
} else {
_CORE_semaphore_Flush(
fe60: e3a02001 mov r2, #1 ; 0x1 <== NOT EXECUTED
fe64: eb0008f5 bl 12240 <_CORE_semaphore_Flush> <== NOT EXECUTED
&the_semaphore->Core_control.semaphore,
SEND_OBJECT_WAS_DELETED,
CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT
);
}
_Thread_Enable_dispatch();
fe68: eb000f78 bl 13c50 <_Thread_Enable_dispatch>
fe6c: e3a00000 mov r0, #0 ; 0x0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
fe70: e28dd004 add sp, sp, #4 ; 0x4
fe74: e8bd8000 pop {pc}
00004458 <rtems_semaphore_release>:
#endif
rtems_status_code rtems_semaphore_release(
rtems_id id
)
{
4458: e92d4010 push {r4, lr}
445c: e24dd004 sub sp, sp, #4 ; 0x4
RTEMS_INLINE_ROUTINE Semaphore_Control *_Semaphore_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Semaphore_Control *)
4460: e1a01000 mov r1, r0
4464: e1a04000 mov r4, r0
4468: e1a0200d mov r2, sp
446c: e59f0060 ldr r0, [pc, #96] ; 44d4 <rtems_semaphore_release+0x7c>
4470: eb00053e bl 5970 <_Objects_Get>
Objects_Locations location;
CORE_mutex_Status mutex_status;
CORE_semaphore_Status semaphore_status;
the_semaphore = _Semaphore_Get( id, &location );
switch ( location ) {
4474: e59dc000 ldr ip, [sp]
4478: e35c0000 cmp ip, #0 ; 0x0
447c: 13a00004 movne r0, #4 ; 0x4
4480: 1a000011 bne 44cc <rtems_semaphore_release+0x74>
case OBJECTS_LOCAL:
if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) {
4484: e5903010 ldr r3, [r0, #16]
4488: e2132030 ands r2, r3, #48 ; 0x30
448c: e2800014 add r0, r0, #20 ; 0x14
4490: 0a000007 beq 44b4 <rtems_semaphore_release+0x5c>
mutex_status = _CORE_mutex_Surrender(
4494: e1a01004 mov r1, r4
4498: e1a0200c mov r2, ip
449c: eb0002ac bl 4f54 <_CORE_mutex_Surrender>
44a0: e1a04000 mov r4, r0
&the_semaphore->Core_control.mutex,
id,
MUTEX_MP_SUPPORT
);
_Thread_Enable_dispatch();
44a4: eb000757 bl 6208 <_Thread_Enable_dispatch>
return _Semaphore_Translate_core_mutex_return_code( mutex_status );
44a8: e1a00004 mov r0, r4
44ac: eb000009 bl 44d8 <_Semaphore_Translate_core_mutex_return_code>
44b0: ea000005 b 44cc <rtems_semaphore_release+0x74>
} else {
semaphore_status = _CORE_semaphore_Surrender(
44b4: e1a01004 mov r1, r4 <== NOT EXECUTED
44b8: eb000305 bl 50d4 <_CORE_semaphore_Surrender> <== NOT EXECUTED
44bc: e1a04000 mov r4, r0 <== NOT EXECUTED
&the_semaphore->Core_control.semaphore,
id,
MUTEX_MP_SUPPORT
);
_Thread_Enable_dispatch();
44c0: eb000750 bl 6208 <_Thread_Enable_dispatch> <== NOT EXECUTED
return
44c4: e1a00004 mov r0, r4 <== NOT EXECUTED
44c8: eb000006 bl 44e8 <_Semaphore_Translate_core_semaphore_return_code><== NOT EXECUTED
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
44cc: e28dd004 add sp, sp, #4 ; 0x4
44d0: e8bd8010 pop {r4, pc}
00012fa4 <rtems_shutdown_executive>:
*/
void rtems_shutdown_executive(
uint32_t result
)
{
12fa4: e52de004 push {lr} ; (str lr, [sp, #-4]!)
if ( _System_state_Current != SYSTEM_STATE_SHUTDOWN ) {
12fa8: e59f2024 ldr r2, [pc, #36] ; 12fd4 <rtems_shutdown_executive+0x30> 12fac: e5923000 ldr r3, [r2] 12fb0: e3530004 cmp r3, #4 ; 0x4
*/
void rtems_shutdown_executive(
uint32_t result
)
{
12fb4: e24dd030 sub sp, sp, #48 ; 0x30 12fb8: 13a03004 movne r3, #4 ; 0x4
Context_Control *context_p = &context_area;
if ( _System_state_Is_up(_System_state_Get ()) )
context_p = &_Thread_Executing->Registers;
_Context_Switch( context_p, &_Thread_BSP_context );
12fbc: 11a0000d movne r0, sp 12fc0: 159f1010 ldrne r1, [pc, #16] ; 12fd8 <rtems_shutdown_executive+0x34> 12fc4: 15823000 strne r3, [r2] 12fc8: 1bffd1a1 blne 7654 <_CPU_Context_switch>
if ( _System_state_Current != SYSTEM_STATE_SHUTDOWN ) {
_System_state_Set( SYSTEM_STATE_SHUTDOWN );
_Thread_Stop_multitasking();
}
}
12fcc: e28dd030 add sp, sp, #48 ; 0x30 <== NOT EXECUTED
12fd0: e8bd8000 pop {pc} <== NOT EXECUTED
00004638 <rtems_task_delete>:
*/
rtems_status_code rtems_task_delete(
Objects_Id id
)
{
4638: e92d4070 push {r4, r5, r6, lr} <== NOT EXECUTED
register Thread_Control *the_thread;
Objects_Locations location;
Objects_Information *the_information;
_RTEMS_Lock_allocator();
463c: e59f6070 ldr r6, [pc, #112] ; 46b4 <rtems_task_delete+0x7c><== NOT EXECUTED
*/
rtems_status_code rtems_task_delete(
Objects_Id id
)
{
4640: e24dd004 sub sp, sp, #4 ; 0x4 <== NOT EXECUTED
4644: e1a04000 mov r4, r0 <== NOT EXECUTED
register Thread_Control *the_thread;
Objects_Locations location;
Objects_Information *the_information;
_RTEMS_Lock_allocator();
4648: e5960000 ldr r0, [r6] <== NOT EXECUTED
464c: eb000194 bl 4ca4 <_API_Mutex_Lock> <== NOT EXECUTED
the_thread = _Thread_Get( id, &location );
4650: e1a00004 mov r0, r4 <== NOT EXECUTED
4654: e1a0100d mov r1, sp <== NOT EXECUTED
4658: eb0006f3 bl 622c <_Thread_Get> <== NOT EXECUTED
switch ( location ) {
465c: e59d5000 ldr r5, [sp] <== NOT EXECUTED
4660: e3550000 cmp r5, #0 ; 0x0 <== NOT EXECUTED
Objects_Locations location;
Objects_Information *the_information;
_RTEMS_Lock_allocator();
the_thread = _Thread_Get( id, &location );
4664: e1a04000 mov r4, r0 <== NOT EXECUTED
switch ( location ) {
4668: 1a00000c bne 46a0 <rtems_task_delete+0x68> <== NOT EXECUTED
case OBJECTS_LOCAL:
the_information = _Objects_Get_information_id( the_thread->Object.id );
466c: e5900008 ldr r0, [r0, #8] <== NOT EXECUTED
4670: eb000482 bl 5880 <_Objects_Get_information_id> <== NOT EXECUTED
0 /* Not used */
);
}
#endif
_Thread_Close( the_information, the_thread );
4674: e1a01004 mov r1, r4 <== NOT EXECUTED
4678: eb00061a bl 5ee8 <_Thread_Close> <== NOT EXECUTED
467c: e5940008 ldr r0, [r4, #8] <== NOT EXECUTED
4680: eb00047e bl 5880 <_Objects_Get_information_id> <== NOT EXECUTED
4684: e1a01004 mov r1, r4 <== NOT EXECUTED
4688: eb00045f bl 580c <_Objects_Free> <== NOT EXECUTED
_RTEMS_tasks_Free( the_thread );
_RTEMS_Unlock_allocator();
468c: e5960000 ldr r0, [r6] <== NOT EXECUTED
4690: eb00019f bl 4d14 <_API_Mutex_Unlock> <== NOT EXECUTED
_Thread_Enable_dispatch();
4694: eb0006db bl 6208 <_Thread_Enable_dispatch> <== NOT EXECUTED
4698: e1a00005 mov r0, r5 <== NOT EXECUTED
469c: ea000002 b 46ac <rtems_task_delete+0x74> <== NOT EXECUTED
case OBJECTS_ERROR:
break;
}
_RTEMS_Unlock_allocator();
46a0: e5960000 ldr r0, [r6] <== NOT EXECUTED
46a4: eb00019a bl 4d14 <_API_Mutex_Unlock> <== NOT EXECUTED
46a8: e3a00004 mov r0, #4 ; 0x4 <== NOT EXECUTED
return RTEMS_INVALID_ID; }
46ac: e28dd004 add sp, sp, #4 ; 0x4 <== NOT EXECUTED
46b0: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED
0000619c <rtems_task_variable_add>:
rtems_status_code rtems_task_variable_add(
rtems_id tid,
void **ptr,
void (*dtor)(void *)
)
{
619c: e92d40f0 push {r4, r5, r6, r7, lr}
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *new;
if ( !ptr )
61a0: e2516000 subs r6, r1, #0 ; 0x0
rtems_status_code rtems_task_variable_add(
rtems_id tid,
void **ptr,
void (*dtor)(void *)
)
{
61a4: e24dd004 sub sp, sp, #4 ; 0x4
61a8: e1a07002 mov r7, r2
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *new;
if ( !ptr )
61ac: 03a00009 moveq r0, #9 ; 0x9
61b0: 0a000022 beq 6240 <rtems_task_variable_add+0xa4>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
61b4: e1a0100d mov r1, sp
61b8: eb000705 bl 7dd4 <_Thread_Get>
switch (location) {
61bc: e59d3000 ldr r3, [sp]
rtems_task_variable_t *tvp, *new;
if ( !ptr )
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
61c0: e1a05000 mov r5, r0
switch (location) {
61c4: e3530000 cmp r3, #0 ; 0x0
61c8: 13a00004 movne r0, #4 ; 0x4
case OBJECTS_LOCAL:
/*
* Figure out if the variable is already in this task's list.
*/
tvp = the_thread->task_variables;
61cc: 05954114 ldreq r4, [r5, #276]
if ( !ptr )
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
switch (location) {
61d0: 0a000008 beq 61f8 <rtems_task_variable_add+0x5c>
61d4: ea000019 b 6240 <rtems_task_variable_add+0xa4> <== NOT EXECUTED
/*
* Figure out if the variable is already in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
if (tvp->ptr == ptr) {
61d8: e5943004 ldr r3, [r4, #4]
61dc: e1530006 cmp r3, r6
61e0: 1a000003 bne 61f4 <rtems_task_variable_add+0x58>
tvp->dtor = dtor;
61e4: e5847010 str r7, [r4, #16]
_Thread_Enable_dispatch();
61e8: eb0006f0 bl 7db0 <_Thread_Enable_dispatch>
61ec: e3a00000 mov r0, #0 ; 0x0
61f0: ea000012 b 6240 <rtems_task_variable_add+0xa4>
return RTEMS_SUCCESSFUL;
}
tvp = (rtems_task_variable_t *)tvp->next;
61f4: e5944000 ldr r4, [r4]
case OBJECTS_LOCAL:
/*
* Figure out if the variable is already in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
61f8: e3540000 cmp r4, #0 ; 0x0
61fc: 1afffff5 bne 61d8 <rtems_task_variable_add+0x3c>
}
/*
* Now allocate memory for this task variable.
*/
new = (rtems_task_variable_t *)
6200: e3a00014 mov r0, #20 ; 0x14
6204: eb000c27 bl 92a8 <_Workspace_Allocate>
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
6208: e3500000 cmp r0, #0 ; 0x0
620c: 1a000002 bne 621c <rtems_task_variable_add+0x80>
_Thread_Enable_dispatch();
6210: eb0006e6 bl 7db0 <_Thread_Enable_dispatch>
6214: e3a0001a mov r0, #26 ; 0x1a
6218: ea000008 b 6240 <rtems_task_variable_add+0xa4>
}
new->gval = *ptr;
new->ptr = ptr;
new->dtor = dtor;
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
621c: e5952114 ldr r2, [r5, #276]
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
_Thread_Enable_dispatch();
return RTEMS_NO_MEMORY;
}
new->gval = *ptr;
6220: e5963000 ldr r3, [r6]
new->ptr = ptr;
new->dtor = dtor;
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
the_thread->task_variables = new;
6224: e5850114 str r0, [r5, #276]
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
_Thread_Enable_dispatch();
return RTEMS_NO_MEMORY;
}
new->gval = *ptr;
6228: e5803008 str r3, [r0, #8]
new->ptr = ptr;
622c: e5806004 str r6, [r0, #4]
new->dtor = dtor;
6230: e5807010 str r7, [r0, #16]
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
6234: e5802000 str r2, [r0]
the_thread->task_variables = new;
_Thread_Enable_dispatch();
6238: eb0006dc bl 7db0 <_Thread_Enable_dispatch>
623c: e1a00004 mov r0, r4
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
6240: e28dd004 add sp, sp, #4 ; 0x4
6244: e8bd80f0 pop {r4, r5, r6, r7, pc}
00006248 <rtems_task_variable_delete>:
rtems_status_code rtems_task_variable_delete(
rtems_id tid,
void **ptr
)
{
6248: e92d4010 push {r4, lr}
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *prev;
if ( !ptr )
624c: e2514000 subs r4, r1, #0 ; 0x0
rtems_status_code rtems_task_variable_delete(
rtems_id tid,
void **ptr
)
{
6250: e24dd004 sub sp, sp, #4 ; 0x4
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *prev;
if ( !ptr )
6254: 0a000018 beq 62bc <rtems_task_variable_delete+0x74>
return RTEMS_INVALID_ADDRESS;
prev = NULL;
the_thread = _Thread_Get (tid, &location);
6258: e1a0100d mov r1, sp
625c: eb0006dc bl 7dd4 <_Thread_Get>
switch (location) {
6260: e59d3000 ldr r3, [sp]
6264: e3530000 cmp r3, #0 ; 0x0
6268: 13a00004 movne r0, #4 ; 0x4
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
626c: 01a02003 moveq r2, r3
6270: 05901114 ldreq r1, [r0, #276]
return RTEMS_INVALID_ADDRESS;
prev = NULL;
the_thread = _Thread_Get (tid, &location);
switch (location) {
6274: 0a00000d beq 62b0 <rtems_task_variable_delete+0x68>
6278: ea000010 b 62c0 <rtems_task_variable_delete+0x78> <== NOT EXECUTED
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
while (tvp) {
if (tvp->ptr == ptr) {
627c: e5913004 ldr r3, [r1, #4]
6280: e1530004 cmp r3, r4
6284: 1a000007 bne 62a8 <rtems_task_variable_delete+0x60>
6288: e5913000 ldr r3, [r1]
if (prev)
628c: e3520000 cmp r2, #0 ; 0x0
prev->next = tvp->next;
else
the_thread->task_variables = (rtems_task_variable_t *)tvp->next;
6290: 05803114 streq r3, [r0, #276]
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
while (tvp) {
if (tvp->ptr == ptr) {
if (prev)
prev->next = tvp->next;
6294: 15823000 strne r3, [r2]
else
the_thread->task_variables = (rtems_task_variable_t *)tvp->next;
_RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp );
6298: eb000028 bl 6340 <_RTEMS_Tasks_Invoke_task_variable_dtor>
_Thread_Enable_dispatch();
629c: eb0006c3 bl 7db0 <_Thread_Enable_dispatch>
62a0: e3a00000 mov r0, #0 ; 0x0
62a4: ea000005 b 62c0 <rtems_task_variable_delete+0x78>
return RTEMS_SUCCESSFUL;
}
prev = tvp;
tvp = (rtems_task_variable_t *)tvp->next;
62a8: e1a02001 mov r2, r1
62ac: e5911000 ldr r1, [r1]
the_thread = _Thread_Get (tid, &location);
switch (location) {
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
while (tvp) {
62b0: e3510000 cmp r1, #0 ; 0x0
62b4: 1afffff0 bne 627c <rtems_task_variable_delete+0x34>
return RTEMS_SUCCESSFUL;
}
prev = tvp;
tvp = (rtems_task_variable_t *)tvp->next;
}
_Thread_Enable_dispatch();
62b8: eb0006bc bl 7db0 <_Thread_Enable_dispatch>
62bc: e3a00009 mov r0, #9 ; 0x9
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
62c0: e28dd004 add sp, sp, #4 ; 0x4
62c4: e8bd8010 pop {r4, pc}
000062c8 <rtems_task_variable_get>:
rtems_status_code rtems_task_variable_get(
rtems_id tid,
void **ptr,
void **result
)
{
62c8: e92d4030 push {r4, r5, lr}
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp;
if ( !ptr )
62cc: e2515000 subs r5, r1, #0 ; 0x0
rtems_status_code rtems_task_variable_get(
rtems_id tid,
void **ptr,
void **result
)
{
62d0: e24dd004 sub sp, sp, #4 ; 0x4
62d4: e1a04002 mov r4, r2
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp;
if ( !ptr )
62d8: 0a000015 beq 6334 <rtems_task_variable_get+0x6c>
return RTEMS_INVALID_ADDRESS;
if ( !result )
62dc: e3520000 cmp r2, #0 ; 0x0
62e0: 0a000013 beq 6334 <rtems_task_variable_get+0x6c>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
62e4: e1a0100d mov r1, sp
62e8: eb0006b9 bl 7dd4 <_Thread_Get>
switch (location) {
62ec: e59d3000 ldr r3, [sp]
62f0: e3530000 cmp r3, #0 ; 0x0
62f4: 13a00004 movne r0, #4 ; 0x4
case OBJECTS_LOCAL:
/*
* Figure out if the variable is in this task's list.
*/
tvp = the_thread->task_variables;
62f8: 05900114 ldreq r0, [r0, #276]
if ( !result )
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
switch (location) {
62fc: 0a000009 beq 6328 <rtems_task_variable_get+0x60>
6300: ea00000c b 6338 <rtems_task_variable_get+0x70> <== NOT EXECUTED
/*
* Figure out if the variable is in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
if (tvp->ptr == ptr) {
6304: e5903004 ldr r3, [r0, #4]
6308: e1530005 cmp r3, r5
630c: 1a000004 bne 6324 <rtems_task_variable_get+0x5c>
/*
* Should this return the current (i.e not the
* saved) value if `tid' is the current task?
*/
*result = tvp->tval;
6310: e590300c ldr r3, [r0, #12]
6314: e5843000 str r3, [r4]
_Thread_Enable_dispatch();
6318: eb0006a4 bl 7db0 <_Thread_Enable_dispatch>
631c: e3a00000 mov r0, #0 ; 0x0
6320: ea000004 b 6338 <rtems_task_variable_get+0x70>
return RTEMS_SUCCESSFUL;
}
tvp = (rtems_task_variable_t *)tvp->next;
6324: e5900000 ldr r0, [r0]
case OBJECTS_LOCAL:
/*
* Figure out if the variable is in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
6328: e3500000 cmp r0, #0 ; 0x0
632c: 1afffff4 bne 6304 <rtems_task_variable_get+0x3c>
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
tvp = (rtems_task_variable_t *)tvp->next;
}
_Thread_Enable_dispatch();
6330: eb00069e bl 7db0 <_Thread_Enable_dispatch>
return RTEMS_INVALID_ADDRESS;
6334: e3a00009 mov r0, #9 ; 0x9
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
6338: e28dd004 add sp, sp, #4 ; 0x4
633c: e8bd8030 pop {r4, r5, pc}
00010a00 <rtems_timer_fire_after>:
Objects_Id id,
rtems_interval ticks,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
10a00: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr}
Timer_Control *the_timer;
Objects_Locations location;
ISR_Level level;
if ( ticks == 0 )
10a04: e251a000 subs sl, r1, #0 ; 0x0
Objects_Id id,
rtems_interval ticks,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
10a08: e1a07000 mov r7, r0 10a0c: e24dd004 sub sp, sp, #4 ; 0x4 10a10: e1a06002 mov r6, r2 10a14: e1a08003 mov r8, r3
Timer_Control *the_timer;
Objects_Locations location;
ISR_Level level;
if ( ticks == 0 )
10a18: 03a0000a moveq r0, #10 ; 0xa
10a1c: 0a000022 beq 10aac <rtems_timer_fire_after+0xac>
return RTEMS_INVALID_NUMBER;
if ( !routine )
10a20: e3520000 cmp r2, #0 ; 0x0 10a24: 03a00009 moveq r0, #9 ; 0x9
10a28: 0a00001f beq 10aac <rtems_timer_fire_after+0xac>
RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Timer_Control *)
10a2c: e59f0080 ldr r0, [pc, #128] ; 10ab4 <rtems_timer_fire_after+0xb4> 10a30: e1a01007 mov r1, r7 10a34: e1a0200d mov r2, sp 10a38: eb000a5e bl 133b8 <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
10a3c: e59d3000 ldr r3, [sp] 10a40: e3530000 cmp r3, #0 ; 0x0 10a44: e1a04000 mov r4, r0 10a48: 13a00004 movne r0, #4 ; 0x4
10a4c: 1a000016 bne 10aac <rtems_timer_fire_after+0xac>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
10a50: e2845010 add r5, r4, #16 ; 0x10 10a54: e1a00005 mov r0, r5 10a58: eb001246 bl 15378 <_Watchdog_Remove>
_ISR_Disable( level );
10a5c: e10f2000 mrs r2, CPSR 10a60: e38230c0 orr r3, r2, #192 ; 0xc0 10a64: e129f003 msr CPSR_fc, r3
/*
* Check to see if the watchdog has just been inserted by a
* higher priority interrupt. If so, abandon this insert.
*/
if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) {
10a68: e5943018 ldr r3, [r4, #24] 10a6c: e3530000 cmp r3, #0 ; 0x0
10a70: 0a000001 beq 10a7c <rtems_timer_fire_after+0x7c>
_ISR_Enable( level );
10a74: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED 10a78: ea000009 b 10aa4 <rtems_timer_fire_after+0xa4> <== NOT EXECUTED
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
10a7c: e5843018 str r3, [r4, #24]
the_watchdog->routine = routine;
10a80: e584602c str r6, [r4, #44]
the_watchdog->id = id;
10a84: e5847030 str r7, [r4, #48]
the_watchdog->user_data = user_data;
10a88: e5848034 str r8, [r4, #52]
/*
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
the_timer->the_class = TIMER_INTERVAL;
10a8c: e5843038 str r3, [r4, #56]
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
_ISR_Enable( level );
10a90: e129f002 msr CPSR_fc, r2
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
10a94: e59f001c ldr r0, [pc, #28] ; 10ab8 <rtems_timer_fire_after+0xb8>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
10a98: e584a01c str sl, [r4, #28]
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
10a9c: e1a01005 mov r1, r5 10aa0: eb0011d8 bl 15208 <_Watchdog_Insert>
_Watchdog_Insert_ticks( &the_timer->Ticker, ticks );
_Thread_Enable_dispatch();
10aa4: eb000c69 bl 13c50 <_Thread_Enable_dispatch> 10aa8: e3a00000 mov r0, #0 ; 0x0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
10aac: e28dd004 add sp, sp, #4 ; 0x4
10ab0: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc}
00010c3c <rtems_timer_reset>:
*/
rtems_status_code rtems_timer_reset(
Objects_Id id
)
{
10c3c: e92d4030 push {r4, r5, lr}
10c40: e24dd004 sub sp, sp, #4 ; 0x4
10c44: e1a01000 mov r1, r0
10c48: e1a0200d mov r2, sp
10c4c: e59f00a4 ldr r0, [pc, #164] ; 10cf8 <rtems_timer_reset+0xbc>
10c50: eb0009d8 bl 133b8 <_Objects_Get>
Timer_Control *the_timer;
Objects_Locations location;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
10c54: e59d3000 ldr r3, [sp] 10c58: e3530000 cmp r3, #0 ; 0x0 10c5c: e1a04000 mov r4, r0 10c60: 13a00004 movne r0, #4 ; 0x4
10c64: 1a000021 bne 10cf0 <rtems_timer_reset+0xb4>
case OBJECTS_LOCAL:
switch ( the_timer->the_class ) {
10c68: e5943038 ldr r3, [r4, #56] 10c6c: e3530004 cmp r3, #4 ; 0x4 10c70: 979ff103 ldrls pc, [pc, r3, lsl #2]
10c74: ea00001b b 10ce8 <rtems_timer_reset+0xac> <== NOT EXECUTED 10c78: 00010c8c .word 0x00010c8c <== NOT EXECUTED 10c7c: 00010ca8 .word 0x00010ca8 <== NOT EXECUTED 10c80: 00010cdc .word 0x00010cdc <== NOT EXECUTED 10c84: 00010cdc .word 0x00010cdc <== NOT EXECUTED 10c88: 00010cdc .word 0x00010cdc <== NOT EXECUTED
case TIMER_INTERVAL:
_Watchdog_Remove( &the_timer->Ticker );
10c8c: e2844010 add r4, r4, #16 ; 0x10 10c90: e1a00004 mov r0, r4 10c94: eb0011b7 bl 15378 <_Watchdog_Remove>
_Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker );
10c98: e1a01004 mov r1, r4 10c9c: e59f0058 ldr r0, [pc, #88] ; 10cfc <rtems_timer_reset+0xc0> 10ca0: eb001158 bl 15208 <_Watchdog_Insert> 10ca4: ea00000f b 10ce8 <rtems_timer_reset+0xac>
break;
case TIMER_INTERVAL_ON_TASK:
if ( !_Timer_Server_schedule_operation ) {
10ca8: e59f5050 ldr r5, [pc, #80] ; 10d00 <rtems_timer_reset+0xc4> 10cac: e5953000 ldr r3, [r5] 10cb0: e3530000 cmp r3, #0 ; 0x0
10cb4: 1a000002 bne 10cc4 <rtems_timer_reset+0x88>
_Thread_Enable_dispatch();
10cb8: eb000be4 bl 13c50 <_Thread_Enable_dispatch> <== NOT EXECUTED 10cbc: e3a0000e mov r0, #14 ; 0xe <== NOT EXECUTED 10cc0: ea00000a b 10cf0 <rtems_timer_reset+0xb4> <== NOT EXECUTED
return RTEMS_INCORRECT_STATE;
}
_Watchdog_Remove( &the_timer->Ticker );
10cc4: e2840010 add r0, r4, #16 ; 0x10 10cc8: eb0011aa bl 15378 <_Watchdog_Remove>
(*_Timer_Server_schedule_operation)( the_timer );
10ccc: e1a00004 mov r0, r4 10cd0: e1a0e00f mov lr, pc 10cd4: e595f000 ldr pc, [r5] 10cd8: ea000002 b 10ce8 <rtems_timer_reset+0xac>
break;
case TIMER_TIME_OF_DAY:
case TIMER_TIME_OF_DAY_ON_TASK:
case TIMER_DORMANT:
_Thread_Enable_dispatch();
10cdc: eb000bdb bl 13c50 <_Thread_Enable_dispatch> 10ce0: e3a0000b mov r0, #11 ; 0xb 10ce4: ea000001 b 10cf0 <rtems_timer_reset+0xb4>
return RTEMS_NOT_DEFINED;
}
_Thread_Enable_dispatch();
10ce8: eb000bd8 bl 13c50 <_Thread_Enable_dispatch> 10cec: e3a00000 mov r0, #0 ; 0x0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
10cf0: e28dd004 add sp, sp, #4 ; 0x4
10cf4: e8bd8030 pop {r4, r5, pc}
00010d04 <rtems_timer_server_fire_after>:
Objects_Id id,
rtems_interval ticks,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
10d04: e92d41f0 push {r4, r5, r6, r7, r8, lr}
Timer_Control *the_timer;
Objects_Locations location;
ISR_Level level;
if ( !_Timer_Server )
10d08: e59fc0c4 ldr ip, [pc, #196] ; 10dd4 <rtems_timer_server_fire_after+0xd0> 10d0c: e59cc000 ldr ip, [ip] 10d10: e35c0000 cmp ip, #0 ; 0x0
Objects_Id id,
rtems_interval ticks,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
10d14: e1a06000 mov r6, r0 10d18: e24dd004 sub sp, sp, #4 ; 0x4 10d1c: e1a07001 mov r7, r1 10d20: e1a05002 mov r5, r2 10d24: e1a08003 mov r8, r3
Timer_Control *the_timer;
Objects_Locations location;
ISR_Level level;
if ( !_Timer_Server )
10d28: 03a0000e moveq r0, #14 ; 0xe
10d2c: 0a000026 beq 10dcc <rtems_timer_server_fire_after+0xc8>
return RTEMS_INCORRECT_STATE;
if ( !routine )
10d30: e3520000 cmp r2, #0 ; 0x0 10d34: 03a00009 moveq r0, #9 ; 0x9
10d38: 0a000023 beq 10dcc <rtems_timer_server_fire_after+0xc8>
return RTEMS_INVALID_ADDRESS;
if ( ticks == 0 )
10d3c: e3510000 cmp r1, #0 ; 0x0 10d40: 03a0000a moveq r0, #10 ; 0xa
10d44: 0a000020 beq 10dcc <rtems_timer_server_fire_after+0xc8>
10d48: e59f0088 ldr r0, [pc, #136] ; 10dd8 <rtems_timer_server_fire_after+0xd4> 10d4c: e1a01006 mov r1, r6 10d50: e1a0200d mov r2, sp 10d54: eb000997 bl 133b8 <_Objects_Get>
return RTEMS_INVALID_NUMBER;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
10d58: e59d3000 ldr r3, [sp] 10d5c: e3530000 cmp r3, #0 ; 0x0 10d60: e1a04000 mov r4, r0 10d64: 13a00004 movne r0, #4 ; 0x4
10d68: 1a000017 bne 10dcc <rtems_timer_server_fire_after+0xc8>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
10d6c: e2840010 add r0, r4, #16 ; 0x10 10d70: eb001180 bl 15378 <_Watchdog_Remove>
_ISR_Disable( level );
10d74: e10f1000 mrs r1, CPSR 10d78: e38130c0 orr r3, r1, #192 ; 0xc0 10d7c: e129f003 msr CPSR_fc, r3
/*
* Check to see if the watchdog has just been inserted by a
* higher priority interrupt. If so, abandon this insert.
*/
if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) {
10d80: e5942018 ldr r2, [r4, #24] 10d84: e3520000 cmp r2, #0 ; 0x0
10d88: 0a000001 beq 10d94 <rtems_timer_server_fire_after+0x90>
_ISR_Enable( level );
10d8c: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED 10d90: ea00000b b 10dc4 <rtems_timer_server_fire_after+0xc0> <== NOT EXECUTED
/*
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
the_timer->the_class = TIMER_INTERVAL_ON_TASK;
10d94: e3a03001 mov r3, #1 ; 0x1 10d98: e5843038 str r3, [r4, #56]
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
10d9c: e5842018 str r2, [r4, #24]
the_watchdog->routine = routine;
10da0: e584502c str r5, [r4, #44]
the_watchdog->id = id;
10da4: e5846030 str r6, [r4, #48]
the_watchdog->user_data = user_data;
10da8: e5848034 str r8, [r4, #52]
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = ticks;
10dac: e584701c str r7, [r4, #28]
_ISR_Enable( level );
10db0: e129f001 msr CPSR_fc, r1
/*
* _Timer_Server_schedule_operation != NULL because we checked that
* _Timer_Server was != NULL above. Both are set at the same time.
*/
(*_Timer_Server_schedule_operation)( the_timer );
10db4: e59f3020 ldr r3, [pc, #32] ; 10ddc <rtems_timer_server_fire_after+0xd8> 10db8: e1a00004 mov r0, r4 10dbc: e1a0e00f mov lr, pc 10dc0: e593f000 ldr pc, [r3]
_Thread_Enable_dispatch();
10dc4: eb000ba1 bl 13c50 <_Thread_Enable_dispatch> 10dc8: e3a00000 mov r0, #0 ; 0x0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
10dcc: e28dd004 add sp, sp, #4 ; 0x4
10dd0: e8bd81f0 pop {r4, r5, r6, r7, r8, pc}