=============================================================================== 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 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 * * 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 <== 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 _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 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 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 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 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 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 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 <== 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 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 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 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_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 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 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 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 3b1c: ea000000 b 3b24 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 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 =============================================================================== 00003b74 : #include #include #include rtems_interval rtems_clock_get_ticks_per_second(void) { 3b74: e59f3010 ldr r3, [pc, #16] ; 3b8c 3b78: e52de004 push {lr} ; (str lr, [sp, #-4]!) 3b7c: e5931000 ldr r1, [r3] 3b80: e59f0008 ldr r0, [pc, #8] ; 3b90 3b84: eb00364d bl 114c0 <__aeabi_uidiv> return TOD_MICROSECONDS_PER_SECOND / _TOD_Microseconds_per_tick; } 3b88: e49df004 pop {pc} ; (ldr pc, [sp], #4) =============================================================================== 00009414 : void rtems_debug_enable ( rtems_debug_control to_be_enabled ) { _Debug_Level |= to_be_enabled; 9414: e59f300c ldr r3, [pc, #12] ; 9428 <== 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 : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) 9460: e59f3040 ldr r3, [pc, #64] ; 94a8 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 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 : #include #include 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 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 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 6d24: ea000008 b 6d4c <== 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 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 6d58: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} =============================================================================== 0000af04 : 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 <== NOT EXECUTED af18: e1a01000 mov r1, r0 <== NOT EXECUTED af1c: e1a0200d mov r2, sp <== NOT EXECUTED af20: e59f0048 ldr r0, [pc, #72] ; af70 <== 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 <== 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_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 af88: e1a01000 mov r1, r0 af8c: e28d2008 add r2, sp, #8 ; 0x8 af90: e59f0080 ldr r0, [pc, #128] ; b018 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 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 <== 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 <== 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 : void rtems_rate_monotonic_report_statistics( void ) { rtems_rate_monotonic_report_statistics_with_plugin( NULL, printk_plugin ); 57d0: e59f1004 ldr r1, [pc, #4] ; 57dc <== NOT EXECUTED 57d4: e3a00000 mov r0, #0 ; 0x0 <== NOT EXECUTED 57d8: eaffff79 b 55c4 <== NOT EXECUTED =============================================================================== 000055c4 : */ 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 <== NOT EXECUTED return; (*print)( context, "Period information by period\n" ); 55d8: e59f11c8 ldr r1, [pc, #456] ; 57a8 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== 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 <== NOT EXECUTED if ( status != RTEMS_SUCCESSFUL ) 5644: e2504000 subs r4, r0, #0 ; 0x0 <== NOT EXECUTED 5648: 1a00004d bne 5784 <== 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 <== 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 <== 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 <== 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 <== NOT EXECUTED (*print)( context, "\n" ); 56ac: e1a00006 mov r0, r6 <== NOT EXECUTED 56b0: e59f110c ldr r1, [pc, #268] ; 57c4 <== NOT EXECUTED 56b4: e1a0e00f mov lr, pc <== NOT EXECUTED 56b8: e12fff15 bx r5 <== NOT EXECUTED 56bc: ea000030 b 5784 <== 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 <== 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 <== 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 <== 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 <== 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 : 57e0: e59f303c ldr r3, [pc, #60] ; 5824 <== 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 <== 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 <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_reset_statistics( id ); 5804: eb000008 bl 582c <== 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 <== 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_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 <== 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 <== 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 <== 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_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 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ f658: e59f30ac ldr r3, [pc, #172] ; f70c 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 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 f684: e3550001 cmp r5, #1 ; 0x1 f688: 03a04004 moveq r4, #4 ; 0x4 f68c: 1a000017 bne f6f0 f690: ea000017 b f6f4 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 f6b4: 3a000002 bcc f6c4 f6b8: e3500002 cmp r0, #2 ; 0x2 f6bc: 1a00000b bne f6f0 f6c0: ea000008 b f6e8 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 return_status = RTEMS_SUCCESSFUL; break; f6e8: e3a04018 mov r4, #24 ; 0x18 f6ec: ea000000 b f6f4 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 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 : 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 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); fa54: e59f80b0 ldr r8, [pc, #176] ; fb0c fa58: e5980000 ldr r0, [r8] fa5c: eb0007c7 bl 11980 <_API_Mutex_Lock> fa60: e1a01004 mov r1, r4 fa64: e59f00a4 ldr r0, [pc, #164] ; fb10 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 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 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 fac4: e59d300c ldr r3, [sp, #12] <== NOT EXECUTED fac8: e3530000 cmp r3, #0 ; 0x0 <== NOT EXECUTED facc: 0a000002 beq fadc <== 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 <== NOT EXECUTED else _RTEMS_Unlock_allocator(); fadc: e59f3028 ldr r3, [pc, #40] ; fb0c fae0: e5930000 ldr r0, [r3] fae4: eb0007c1 bl 119f0 <_API_Mutex_Unlock> return fae8: e3540000 cmp r4, #0 ; 0x0 faec: 0a000003 beq fb00 faf0: e3540001 cmp r4, #1 ; 0x1 faf4: 0284400c addeq r4, r4, #12 ; 0xc faf8: 0a000000 beq fb00 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 : 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 return RTEMS_INVALID_NAME; if ( !id ) 4100: e3590000 cmp r9, #0 ; 0x0 4104: 03a00009 moveq r0, #9 ; 0x9 4108: 0a00005f beq 428c 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_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 4120: e3530020 cmp r3, #32 ; 0x20 4124: 1a000057 bne 4288 4128: e3140004 tst r4, #4 ; 0x4 412c: 0a000055 beq 4288 _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 _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 4140: e3570001 cmp r7, #1 ; 0x1 4144: 83a0000a movhi r0, #10 ; 0xa 4148: 8a00004f bhi 428c rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 414c: e59f2140 ldr r2, [pc, #320] ; 4294 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 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 _Thread_Enable_dispatch(); 416c: eb000825 bl 6208 <_Thread_Enable_dispatch> 4170: e3a00005 mov r0, #5 ; 0x5 4174: ea000044 b 428c * 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 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 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 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 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 <== 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 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_INLINE_ROUTINE void _Semaphore_Free ( Semaphore_Control *the_semaphore ) { _Objects_Free( &_Semaphore_Information, &the_semaphore->Object ); 4214: e59f007c ldr r0, [pc, #124] ; 4298 <== 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 <== 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 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 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 : #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 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 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 _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 &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 : #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 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 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 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 } 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 : */ 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 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 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_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 <== 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 <== 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 <== 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_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 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 61d4: ea000019 b 6240 <== 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 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 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 } /* * 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 _Thread_Enable_dispatch(); 6210: eb0006e6 bl 7db0 <_Thread_Enable_dispatch> 6214: e3a0001a mov r0, #26 ; 0x1a 6218: ea000008 b 6240 } 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_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 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 6278: ea000010 b 62c0 <== 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 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 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 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_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 return RTEMS_INVALID_ADDRESS; if ( !result ) 62dc: e3520000 cmp r2, #0 ; 0x0 62e0: 0a000013 beq 6334 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 6300: ea00000c b 6338 <== 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 /* * 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 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 _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 : 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 return RTEMS_INVALID_NUMBER; if ( !routine ) 10a20: e3520000 cmp r2, #0 ; 0x0 10a24: 03a00009 moveq r0, #9 ; 0x9 10a28: 0a00001f beq 10aac RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get ( Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) 10a2c: e59f0080 ldr r0, [pc, #128] ; 10ab4 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 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 _ISR_Enable( level ); 10a74: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED 10a78: ea000009 b 10aa4 <== 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 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_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 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 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 <== 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 10ca0: eb001158 bl 15208 <_Watchdog_Insert> 10ca4: ea00000f b 10ce8 break; case TIMER_INTERVAL_ON_TASK: if ( !_Timer_Server_schedule_operation ) { 10ca8: e59f5050 ldr r5, [pc, #80] ; 10d00 10cac: e5953000 ldr r3, [r5] 10cb0: e3530000 cmp r3, #0 ; 0x0 10cb4: 1a000002 bne 10cc4 _Thread_Enable_dispatch(); 10cb8: eb000be4 bl 13c50 <_Thread_Enable_dispatch> <== NOT EXECUTED 10cbc: e3a0000e mov r0, #14 ; 0xe <== NOT EXECUTED 10cc0: ea00000a b 10cf0 <== 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 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 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 : 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 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 return RTEMS_INCORRECT_STATE; if ( !routine ) 10d30: e3520000 cmp r2, #0 ; 0x0 10d34: 03a00009 moveq r0, #9 ; 0x9 10d38: 0a000023 beq 10dcc return RTEMS_INVALID_ADDRESS; if ( ticks == 0 ) 10d3c: e3510000 cmp r1, #0 ; 0x0 10d40: 03a0000a moveq r0, #10 ; 0xa 10d44: 0a000020 beq 10dcc 10d48: e59f0088 ldr r0, [pc, #136] ; 10dd8 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 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 _ISR_Enable( level ); 10d8c: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED 10d90: ea00000b b 10dc4 <== 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 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}