=============================================================================== 00016c10 <_CORE_message_queue_Broadcast>: { Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 16c10: e590304c ldr r3, [r0, #76] ; 0x4c Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 16c14: 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 ) { 16c18: e1530002 cmp r3, r2 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 16c1c: e1a07000 mov r7, r0 16c20: e1a05002 mov r5, r2 16c24: e1a08001 mov r8, r1 16c28: 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 ) { 16c2c: 3a000016 bcc 16c8c <_CORE_message_queue_Broadcast+0x7c> * 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 ) { 16c30: e5906048 ldr r6, [r0, #72] ; 0x48 16c34: e3560000 cmp r6, #0 *count = 0; 16c38: 13a00000 movne r0, #0 16c3c: 158a0000 strne r0, [sl] * 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 ) { 16c40: 18bd85f0 popne {r4, r5, r6, r7, r8, sl, pc} /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 16c44: e1a00007 mov r0, r7 16c48: eb000a5d bl 195c4 <_Thread_queue_Dequeue> 16c4c: e2504000 subs r4, r0, #0 16c50: 0a00000a beq 16c80 <_CORE_message_queue_Broadcast+0x70> const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 16c54: e594002c ldr r0, [r4, #44] ; 0x2c 16c58: e1a01008 mov r1, r8 16c5c: e1a02005 mov r2, r5 16c60: eb002469 bl 1fe0c buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 16c64: e5943028 ldr r3, [r4, #40] ; 0x28 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 16c68: e1a00007 mov r0, r7 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 16c6c: e5835000 str r5, [r3] /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 16c70: eb000a53 bl 195c4 <_Thread_queue_Dequeue> 16c74: e2504000 subs r4, r0, #0 _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 16c78: e2866001 add r6, r6, #1 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 16c7c: 1afffff4 bne 16c54 <_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; 16c80: e58a6000 str r6, [sl] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 16c84: e1a00004 mov r0, r4 16c88: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE; 16c8c: e3a00001 mov r0, #1 <== NOT EXECUTED #endif } *count = number_broadcasted; return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } 16c90: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED =============================================================================== 0000b4d8 <_Chain_Initialize>: count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { b4d8: e3520000 cmp r2, #0 Chain_Node *current; Chain_Node *next; count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; b4dc: e3a0c000 mov ip, #0 Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { b4e0: e92d0070 push {r4, r5, r6} Chain_Node *current; Chain_Node *next; count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; b4e4: e580c004 str ip, [r0, #4] */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head( Chain_Control *the_chain ) { return (Chain_Node *) the_chain; b4e8: e1a04000 mov r4, r0 next = starting_address; b4ec: 11a05002 movne r5, r2 b4f0: 11a0c001 movne ip, r1 while ( count-- ) { b4f4: 1a000002 bne b504 <_Chain_Initialize+0x2c> b4f8: ea000008 b b520 <_Chain_Initialize+0x48> <== NOT EXECUTED b4fc: e1a0400c mov r4, ip current->next = next; next->previous = current; current = next; next = (Chain_Node *) b500: e1a0c006 mov ip, r6 count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { b504: e2555001 subs r5, r5, #1 current->next = next; b508: e584c000 str ip, [r4] next->previous = current; b50c: e58c4004 str r4, [ip, #4] * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( b510: e08c6003 add r6, ip, r3 count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { b514: 1afffff8 bne b4fc <_Chain_Initialize+0x24> * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( b518: e2422001 sub r2, r2, #1 count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { b51c: e0241293 mla r4, r3, r2, r1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; b520: e2803004 add r3, r0, #4 next->previous = current; current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = _Chain_Tail( the_chain ); b524: e5843000 str r3, [r4] the_chain->last = current; b528: e5804008 str r4, [r0, #8] } b52c: e8bd0070 pop {r4, r5, r6} b530: e12fff1e bx lr =============================================================================== 0000b714 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { b714: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} b718: e1a08002 mov r8, r2 Heap_Statistics *const stats = &heap->stats; Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); Heap_Block *block = _Heap_Free_list_first( heap ); uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; b71c: e5902010 ldr r2, [r0, #16] Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { b720: e24dd01c sub sp, sp, #28 b724: e1a05001 mov r5, r1 - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; uintptr_t alloc_begin = 0; uint32_t search_count = 0; if ( block_size_floor < alloc_size ) { b728: e2911004 adds r1, r1, #4 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { b72c: e1a07000 mov r7, r0 - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; uintptr_t alloc_begin = 0; uint32_t search_count = 0; if ( block_size_floor < alloc_size ) { b730: e58d1000 str r1, [sp] Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { b734: e1a0b003 mov fp, r3 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } b738: e5909008 ldr r9, [r0, #8] Heap_Statistics *const stats = &heap->stats; Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); Heap_Block *block = _Heap_Free_list_first( heap ); uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; b73c: e58d200c str r2, [sp, #12] uintptr_t alloc_begin = 0; uint32_t search_count = 0; if ( block_size_floor < alloc_size ) { b740: 2a000075 bcs b91c <_Heap_Allocate_aligned_with_boundary+0x208> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { b744: e3530000 cmp r3, #0 b748: 1a000071 bne b914 <_Heap_Allocate_aligned_with_boundary+0x200> if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { b74c: e1570009 cmp r7, r9 b750: 0a000071 beq b91c <_Heap_Allocate_aligned_with_boundary+0x208> uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size b754: e59d300c ldr r3, [sp, #12] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; b758: e2651004 rsb r1, r5, #4 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size b75c: e2833007 add r3, r3, #7 b760: e58d3010 str r3, [sp, #16] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; b764: e58d1014 str r1, [sp, #20] if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { b768: e3a06000 mov r6, #0 /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { b76c: e599a004 ldr sl, [r9, #4] b770: e59d2000 ldr r2, [sp] b774: e152000a cmp r2, sl while ( block != free_list_tail ) { _HAssert( _Heap_Is_prev_used( block ) ); /* Statistics */ ++search_count; b778: e2866001 add r6, r6, #1 /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { b77c: 2a000051 bcs b8c8 <_Heap_Allocate_aligned_with_boundary+0x1b4> if ( alignment == 0 ) { b780: e3580000 cmp r8, #0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; b784: 02894008 addeq r4, r9, #8 b788: 0a00004c beq b8c0 <_Heap_Allocate_aligned_with_boundary+0x1ac> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } b78c: e5973014 ldr r3, [r7, #20] uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; b790: e59d1014 ldr r1, [sp, #20] uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; b794: e59d2010 ldr r2, [sp, #16] - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; b798: e3caa001 bic sl, sl, #1 uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; b79c: e089a00a add sl, r9, sl uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; b7a0: e081400a add r4, r1, sl if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } b7a4: e58d3004 str r3, [sp, #4] uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; b7a8: e0633002 rsb r3, r3, r2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); b7ac: e1a00004 mov r0, r4 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size b7b0: e083a00a add sl, r3, sl b7b4: e1a01008 mov r1, r8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; b7b8: e2893008 add r3, r9, #8 b7bc: e58d3008 str r3, [sp, #8] RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); b7c0: eb0016a8 bl 11268 <__umodsi3> b7c4: e0604004 rsb r4, r0, r4 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { b7c8: e15a0004 cmp sl, r4 b7cc: 2a000003 bcs b7e0 <_Heap_Allocate_aligned_with_boundary+0xcc> b7d0: e1a0000a mov r0, sl b7d4: e1a01008 mov r1, r8 b7d8: eb0016a2 bl 11268 <__umodsi3> b7dc: e060400a rsb r4, r0, sl } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { b7e0: e35b0000 cmp fp, #0 b7e4: 0a000025 beq b880 <_Heap_Allocate_aligned_with_boundary+0x16c> /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { alloc_begin = _Heap_Align_down( alloc_begin_ceiling, alignment ); } alloc_end = alloc_begin + alloc_size; b7e8: e084a005 add sl, r4, r5 b7ec: e1a0000a mov r0, sl b7f0: e1a0100b mov r1, fp b7f4: eb00169b bl 11268 <__umodsi3> b7f8: e060000a rsb r0, r0, sl /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { b7fc: e1540000 cmp r4, r0 b800: 23a03000 movcs r3, #0 b804: 33a03001 movcc r3, #1 b808: e15a0000 cmp sl, r0 b80c: 93a03000 movls r3, #0 b810: e3530000 cmp r3, #0 b814: 0a000019 beq b880 <_Heap_Allocate_aligned_with_boundary+0x16c> alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; b818: e59d1008 ldr r1, [sp, #8] b81c: e081a005 add sl, r1, r5 uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { b820: e15a0000 cmp sl, r0 b824: 958d6018 strls r6, [sp, #24] b828: 9a000002 bls b838 <_Heap_Allocate_aligned_with_boundary+0x124> b82c: ea000025 b b8c8 <_Heap_Allocate_aligned_with_boundary+0x1b4> b830: e15a0000 cmp sl, r0 b834: 8a00003a bhi b924 <_Heap_Allocate_aligned_with_boundary+0x210> return 0; } alloc_begin = boundary_line - alloc_size; b838: e0654000 rsb r4, r5, r0 b83c: e1a01008 mov r1, r8 b840: e1a00004 mov r0, r4 b844: eb001687 bl 11268 <__umodsi3> b848: e0604004 rsb r4, r0, r4 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; b84c: e0846005 add r6, r4, r5 b850: e1a00006 mov r0, r6 b854: e1a0100b mov r1, fp b858: eb001682 bl 11268 <__umodsi3> b85c: e0600006 rsb r0, r0, r6 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { b860: e1560000 cmp r6, r0 b864: 93a06000 movls r6, #0 b868: 83a06001 movhi r6, #1 b86c: e1540000 cmp r4, r0 b870: 23a06000 movcs r6, #0 b874: e3560000 cmp r6, #0 b878: 1affffec bne b830 <_Heap_Allocate_aligned_with_boundary+0x11c> b87c: e59d6018 ldr r6, [sp, #24] boundary_line = _Heap_Align_down( alloc_end, boundary ); } } /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { b880: e59d2008 ldr r2, [sp, #8] b884: e1520004 cmp r2, r4 b888: 8a00000e bhi b8c8 <_Heap_Allocate_aligned_with_boundary+0x1b4> b88c: e59d100c ldr r1, [sp, #12] b890: e1a00004 mov r0, r4 b894: eb001673 bl 11268 <__umodsi3> b898: e269a4ff rsb sl, r9, #-16777216 ; 0xff000000 b89c: e28aa8ff add sl, sl, #16711680 ; 0xff0000 b8a0: e28aacff add sl, sl, #65280 ; 0xff00 b8a4: e28aa0f8 add sl, sl, #248 ; 0xf8 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); b8a8: e08aa004 add sl, sl, r4 uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; if ( free_size >= min_block_size || free_size == 0 ) { b8ac: e59d1004 ldr r1, [sp, #4] b8b0: e060300a rsb r3, r0, sl b8b4: e15a0000 cmp sl, r0 b8b8: 11510003 cmpne r1, r3 b8bc: 8a000001 bhi b8c8 <_Heap_Allocate_aligned_with_boundary+0x1b4> boundary ); } } if ( alloc_begin != 0 ) { b8c0: e3540000 cmp r4, #0 b8c4: 1a000004 bne b8dc <_Heap_Allocate_aligned_with_boundary+0x1c8> break; } block = block->next; b8c8: e5999008 ldr r9, [r9, #8] if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { b8cc: e1570009 cmp r7, r9 b8d0: 1affffa5 bne b76c <_Heap_Allocate_aligned_with_boundary+0x58> b8d4: e3a00000 mov r0, #0 b8d8: ea000008 b b900 <_Heap_Allocate_aligned_with_boundary+0x1ec> block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; b8dc: e597304c ldr r3, [r7, #76] ; 0x4c b8e0: e0833006 add r3, r3, r6 b8e4: e587304c str r3, [r7, #76] ; 0x4c block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); b8e8: e1a00007 mov r0, r7 b8ec: e1a01009 mov r1, r9 b8f0: e1a02004 mov r2, r4 b8f4: e1a03005 mov r3, r5 b8f8: ebffebce bl 6838 <_Heap_Block_allocate> b8fc: e1a00004 mov r0, r4 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { b900: e5973044 ldr r3, [r7, #68] ; 0x44 b904: e1530006 cmp r3, r6 stats->max_search = search_count; b908: 35876044 strcc r6, [r7, #68] ; 0x44 } return (void *) alloc_begin; } b90c: e28dd01c add sp, sp, #28 b910: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { b914: e1550003 cmp r5, r3 b918: 9a000006 bls b938 <_Heap_Allocate_aligned_with_boundary+0x224> if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { b91c: e3a00000 mov r0, #0 b920: eafffff9 b b90c <_Heap_Allocate_aligned_with_boundary+0x1f8> if ( alloc_begin != 0 ) { break; } block = block->next; b924: e5999008 ldr r9, [r9, #8] <== NOT EXECUTED if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { b928: e1570009 cmp r7, r9 <== NOT EXECUTED b92c: e59d6018 ldr r6, [sp, #24] <== NOT EXECUTED b930: 1affff8d bne b76c <_Heap_Allocate_aligned_with_boundary+0x58><== NOT EXECUTED b934: eaffffe6 b b8d4 <_Heap_Allocate_aligned_with_boundary+0x1c0><== NOT EXECUTED if ( boundary < alloc_size ) { return NULL; } if ( alignment == 0 ) { alignment = page_size; b938: e3580000 cmp r8, #0 b93c: 01a08002 moveq r8, r2 b940: eaffff81 b b74c <_Heap_Allocate_aligned_with_boundary+0x38> =============================================================================== 0000b944 <_Heap_Free>: #include #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { b944: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} b948: e1a04000 mov r4, r0 b94c: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); b950: e1a00001 mov r0, r1 b954: e5941010 ldr r1, [r4, #16] b958: eb001642 bl 11268 <__umodsi3> b95c: e2455008 sub r5, r5, #8 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block b960: e5943020 ldr r3, [r4, #32] uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); b964: e0605005 rsb r5, r0, r5 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; b968: e1550003 cmp r5, r3 b96c: 3a00002f bcc ba30 <_Heap_Free+0xec> b970: e5941024 ldr r1, [r4, #36] ; 0x24 b974: e1550001 cmp r5, r1 b978: 8a00002c bhi ba30 <_Heap_Free+0xec> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } b97c: e595c004 ldr ip, [r5, #4] - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; b980: e3cc6001 bic r6, ip, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); b984: e0852006 add r2, r5, r6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; b988: e1530002 cmp r3, r2 b98c: 8a000027 bhi ba30 <_Heap_Free+0xec> b990: e1510002 cmp r1, r2 b994: 3a000027 bcc ba38 <_Heap_Free+0xf4> b998: e5927004 ldr r7, [r2, #4] if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { b99c: e2170001 ands r0, r7, #1 b9a0: 08bd85f0 popeq {r4, r5, r6, r7, r8, sl, pc} return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); b9a4: e1510002 cmp r1, r2 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; b9a8: e3c77001 bic r7, r7, #1 b9ac: 03a08000 moveq r8, #0 b9b0: 0a000004 beq b9c8 <_Heap_Free+0x84> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } b9b4: e0820007 add r0, r2, r7 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; b9b8: e5900004 ldr r0, [r0, #4] #include #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) b9bc: e3100001 tst r0, #1 b9c0: 13a08000 movne r8, #0 b9c4: 03a08001 moveq r8, #1 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { b9c8: e21c0001 ands r0, ip, #1 b9cc: 1a00001b bne ba40 <_Heap_Free+0xfc> uintptr_t const prev_size = block->prev_size; b9d0: e595c000 ldr ip, [r5] RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); b9d4: e06ca005 rsb sl, ip, r5 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; b9d8: e153000a cmp r3, sl b9dc: 88bd85f0 pophi {r4, r5, r6, r7, r8, sl, pc} b9e0: e151000a cmp r1, sl b9e4: 38bd85f0 popcc {r4, r5, r6, r7, r8, sl, pc} block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; b9e8: e59a0004 ldr r0, [sl, #4] return( false ); } /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { b9ec: e2100001 ands r0, r0, #1 b9f0: 08bd85f0 popeq {r4, r5, r6, r7, r8, sl, pc} _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ b9f4: e3580000 cmp r8, #0 b9f8: 0a000039 beq bae4 <_Heap_Free+0x1a0> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; b9fc: e5940038 ldr r0, [r4, #56] ; 0x38 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ba00: e0867007 add r7, r6, r7 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ba04: e5923008 ldr r3, [r2, #8] _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ba08: e087c00c add ip, r7, ip --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ba0c: e592200c ldr r2, [r2, #12] } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ba10: e2400001 sub r0, r0, #1 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ba14: e38c1001 orr r1, ip, #1 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; ba18: e5823008 str r3, [r2, #8] next->prev = prev; ba1c: e583200c str r2, [r3, #12] } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ba20: e5840038 str r0, [r4, #56] ; 0x38 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ba24: e58a1004 str r1, [sl, #4] next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; ba28: e78ac00c str ip, [sl, ip] ba2c: ea00000f b ba70 <_Heap_Free+0x12c> block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; ba30: e3a00000 mov r0, #0 ba34: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} ba38: e3a00000 mov r0, #0 <== NOT EXECUTED --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ba3c: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ ba40: e3580000 cmp r8, #0 ba44: 0a000014 beq ba9c <_Heap_Free+0x158> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ba48: e5923008 ldr r3, [r2, #8] prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; ba4c: e0877006 add r7, r7, r6 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ba50: e592200c ldr r2, [r2, #12] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ba54: e3871001 orr r1, r7, #1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; ba58: e5853008 str r3, [r5, #8] new_block->prev = prev; ba5c: e585200c str r2, [r5, #12] next->prev = new_block; prev->next = new_block; ba60: e5825008 str r5, [r2, #8] Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; ba64: e583500c str r5, [r3, #12] ba68: e5851004 str r1, [r5, #4] next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; ba6c: e7857007 str r7, [r5, r7] stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ba70: e5942040 ldr r2, [r4, #64] ; 0x40 ++stats->frees; ba74: e5943050 ldr r3, [r4, #80] ; 0x50 stats->free_size += block_size; ba78: e5941030 ldr r1, [r4, #48] ; 0x30 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ba7c: e2422001 sub r2, r2, #1 ++stats->frees; ba80: e2833001 add r3, r3, #1 stats->free_size += block_size; ba84: e0816006 add r6, r1, r6 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ba88: e5842040 str r2, [r4, #64] ; 0x40 ++stats->frees; ba8c: e5843050 str r3, [r4, #80] ; 0x50 stats->free_size += block_size; ba90: e5846030 str r6, [r4, #48] ; 0x30 return( true ); ba94: e3a00001 mov r0, #1 ba98: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; ba9c: e3863001 orr r3, r6, #1 baa0: e5853004 str r3, [r5, #4] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; baa4: e2843038 add r3, r4, #56 ; 0x38 baa8: e8931008 ldm r3, {r3, ip} } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; baac: e5920004 ldr r0, [r2, #4] RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; bab0: e5941008 ldr r1, [r4, #8] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; bab4: e2833001 add r3, r3, #1 } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; bab8: e3c00001 bic r0, r0, #1 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { babc: e153000c cmp r3, ip new_block->next = next; bac0: e5851008 str r1, [r5, #8] new_block->prev = block_before; bac4: e585400c str r4, [r5, #12] } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; bac8: e5820004 str r0, [r2, #4] block_before->next = new_block; next->prev = new_block; bacc: e581500c str r5, [r1, #12] next_block->prev_size = block_size; bad0: e7856006 str r6, [r5, r6] { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; bad4: e5845008 str r5, [r4, #8] /* Statistics */ ++stats->free_blocks; bad8: e5843038 str r3, [r4, #56] ; 0x38 if ( stats->max_free_blocks < stats->free_blocks ) { stats->max_free_blocks = stats->free_blocks; badc: 8584303c strhi r3, [r4, #60] ; 0x3c bae0: eaffffe2 b ba70 <_Heap_Free+0x12c> prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; bae4: e086c00c add ip, r6, ip prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; bae8: e38c3001 orr r3, ip, #1 baec: e58a3004 str r3, [sl, #4] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; baf0: e5923004 ldr r3, [r2, #4] baf4: e3c33001 bic r3, r3, #1 baf8: e5823004 str r3, [r2, #4] next_block->prev_size = size; bafc: e785c006 str ip, [r5, r6] bb00: eaffffda b ba70 <_Heap_Free+0x12c> =============================================================================== 000130f0 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 130f0: e92d40f0 push {r4, r5, r6, r7, lr} 130f4: e1a04000 mov r4, r0 130f8: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 130fc: e1a00001 mov r0, r1 13100: e5941010 ldr r1, [r4, #16] 13104: e1a07002 mov r7, r2 13108: ebfff856 bl 11268 <__umodsi3> 1310c: e2456008 sub r6, r5, #8 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block 13110: e5943020 ldr r3, [r4, #32] uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 13114: e0600006 rsb r0, r0, r6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 13118: e1500003 cmp r0, r3 1311c: 3a000010 bcc 13164 <_Heap_Size_of_alloc_area+0x74> 13120: e5942024 ldr r2, [r4, #36] ; 0x24 13124: e1500002 cmp r0, r2 13128: 8a00000d bhi 13164 <_Heap_Size_of_alloc_area+0x74> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 1312c: e5906004 ldr r6, [r0, #4] 13130: e3c66001 bic r6, r6, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 13134: e0806006 add r6, r0, r6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 13138: e1530006 cmp r3, r6 1313c: 8a000008 bhi 13164 <_Heap_Size_of_alloc_area+0x74> 13140: e1520006 cmp r2, r6 13144: 3a000008 bcc 1316c <_Heap_Size_of_alloc_area+0x7c> block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 13148: e5960004 ldr r0, [r6, #4] block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 1314c: e2100001 ands r0, r0, #1 ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_BLOCK_SIZE_OFFSET - alloc_begin; 13150: 12655004 rsbne r5, r5, #4 13154: 10856006 addne r6, r5, r6 13158: 15876000 strne r6, [r7] return true; 1315c: 13a00001 movne r0, #1 13160: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; 13164: e3a00000 mov r0, #0 13168: e8bd80f0 pop {r4, r5, r6, r7, pc} 1316c: e3a00000 mov r0, #0 <== NOT EXECUTED } *alloc_size = (uintptr_t) next_block + HEAP_BLOCK_SIZE_OFFSET - alloc_begin; return true; } 13170: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== 00007590 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 7590: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; if ( !_System_state_Is_up( _System_state_Get() ) ) { 7594: e59f35cc ldr r3, [pc, #1484] ; 7b68 <_Heap_Walk+0x5d8> uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 7598: e31200ff tst r2, #255 ; 0xff if ( !_System_state_Is_up( _System_state_Get() ) ) { 759c: e5933000 ldr r3, [r3] uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 75a0: e59f25c4 ldr r2, [pc, #1476] ; 7b6c <_Heap_Walk+0x5dc> 75a4: e59f95c4 ldr r9, [pc, #1476] ; 7b70 <_Heap_Walk+0x5e0> bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 75a8: e1a0a001 mov sl, r1 uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 75ac: 11a09002 movne r9, r2 Heap_Control *heap, int source, bool dump ) { uintptr_t const page_size = heap->page_size; 75b0: e5901010 ldr r1, [r0, #16] Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; if ( !_System_state_Is_up( _System_state_Get() ) ) { 75b4: e3530003 cmp r3, #3 int source, bool dump ) { uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; 75b8: e5902014 ldr r2, [r0, #20] Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; 75bc: e5903024 ldr r3, [r0, #36] ; 0x24 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 75c0: e24dd038 sub sp, sp, #56 ; 0x38 75c4: e1a04000 mov r4, r0 uintptr_t const page_size = heap->page_size; 75c8: e58d1024 str r1, [sp, #36] ; 0x24 uintptr_t const min_block_size = heap->min_block_size; 75cc: e58d2028 str r2, [sp, #40] ; 0x28 Heap_Block *const first_block = heap->first_block; 75d0: e5908020 ldr r8, [r0, #32] Heap_Block *const last_block = heap->last_block; 75d4: e58d302c str r3, [sp, #44] ; 0x2c Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; if ( !_System_state_Is_up( _System_state_Get() ) ) { 75d8: 0a000002 beq 75e8 <_Heap_Walk+0x58> } block = next_block; } while ( block != first_block ); return true; 75dc: e3a00001 mov r0, #1 } 75e0: e28dd038 add sp, sp, #56 ; 0x38 75e4: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; (*printer)( 75e8: e594101c ldr r1, [r4, #28] 75ec: e5900018 ldr r0, [r0, #24] 75f0: e2842008 add r2, r4, #8 75f4: e892000c ldm r2, {r2, r3} 75f8: e59dc028 ldr ip, [sp, #40] ; 0x28 75fc: e58d1008 str r1, [sp, #8] 7600: e59d102c ldr r1, [sp, #44] ; 0x2c 7604: e58d0004 str r0, [sp, #4] 7608: e58d1010 str r1, [sp, #16] 760c: e58d2014 str r2, [sp, #20] 7610: e58d3018 str r3, [sp, #24] 7614: e59f2558 ldr r2, [pc, #1368] ; 7b74 <_Heap_Walk+0x5e4> 7618: e58dc000 str ip, [sp] 761c: e58d800c str r8, [sp, #12] 7620: e1a0000a mov r0, sl 7624: e3a01000 mov r1, #0 7628: e59d3024 ldr r3, [sp, #36] ; 0x24 762c: e1a0e00f mov lr, pc 7630: e12fff19 bx r9 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 7634: e59d2024 ldr r2, [sp, #36] ; 0x24 7638: e3520000 cmp r2, #0 763c: 0a000026 beq 76dc <_Heap_Walk+0x14c> (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 7640: e59d3024 ldr r3, [sp, #36] ; 0x24 7644: e2135003 ands r5, r3, #3 7648: 1a00002a bne 76f8 <_Heap_Walk+0x168> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 764c: e59d0028 ldr r0, [sp, #40] ; 0x28 7650: e59d1024 ldr r1, [sp, #36] ; 0x24 7654: ebffe551 bl ba0 <__umodsi3> ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 7658: e250b000 subs fp, r0, #0 765c: 1a00002c bne 7714 <_Heap_Walk+0x184> 7660: e2880008 add r0, r8, #8 7664: e59d1024 ldr r1, [sp, #36] ; 0x24 7668: ebffe54c bl ba0 <__umodsi3> ); return false; } if ( 766c: e2506000 subs r6, r0, #0 7670: 1a00002f bne 7734 <_Heap_Walk+0x1a4> block = next_block; } while ( block != first_block ); return true; } 7674: e598b004 ldr fp, [r8, #4] ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 7678: e21b5001 ands r5, fp, #1 767c: 0a0000cd beq 79b8 <_Heap_Walk+0x428> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 7680: e59dc02c ldr ip, [sp, #44] ; 0x2c 7684: e59c3004 ldr r3, [ip, #4] 7688: e3c33001 bic r3, r3, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 768c: e08c3003 add r3, ip, r3 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 7690: e5935004 ldr r5, [r3, #4] ); return false; } if ( _Heap_Is_free( last_block ) ) { 7694: e2155001 ands r5, r5, #1 7698: 0a000008 beq 76c0 <_Heap_Walk+0x130> ); return false; } if ( 769c: e1580003 cmp r8, r3 76a0: 0a00002b beq 7754 <_Heap_Walk+0x1c4> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 76a4: e1a0000a mov r0, sl <== NOT EXECUTED 76a8: e3a01001 mov r1, #1 <== NOT EXECUTED 76ac: e59f24c4 ldr r2, [pc, #1220] ; 7b78 <_Heap_Walk+0x5e8> <== NOT EXECUTED 76b0: e1a0e00f mov lr, pc <== NOT EXECUTED 76b4: e12fff19 bx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 76b8: e1a00006 mov r0, r6 <== NOT EXECUTED 76bc: eaffffc7 b 75e0 <_Heap_Walk+0x50> <== NOT EXECUTED return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 76c0: e1a0000a mov r0, sl 76c4: e3a01001 mov r1, #1 76c8: e59f24ac ldr r2, [pc, #1196] ; 7b7c <_Heap_Walk+0x5ec> 76cc: e1a0e00f mov lr, pc 76d0: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 76d4: e1a00005 mov r0, r5 76d8: eaffffc0 b 75e0 <_Heap_Walk+0x50> first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 76dc: e1a0000a mov r0, sl 76e0: e3a01001 mov r1, #1 76e4: e59f2494 ldr r2, [pc, #1172] ; 7b80 <_Heap_Walk+0x5f0> 76e8: e1a0e00f mov lr, pc 76ec: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 76f0: e59d0024 ldr r0, [sp, #36] ; 0x24 76f4: eaffffb9 b 75e0 <_Heap_Walk+0x50> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 76f8: e1a0000a mov r0, sl 76fc: e3a01001 mov r1, #1 7700: e59f247c ldr r2, [pc, #1148] ; 7b84 <_Heap_Walk+0x5f4> 7704: e1a0e00f mov lr, pc 7708: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 770c: e3a00000 mov r0, #0 7710: eaffffb2 b 75e0 <_Heap_Walk+0x50> return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 7714: e1a0000a mov r0, sl 7718: e3a01001 mov r1, #1 771c: e59f2464 ldr r2, [pc, #1124] ; 7b88 <_Heap_Walk+0x5f8> 7720: e59d3028 ldr r3, [sp, #40] ; 0x28 7724: e1a0e00f mov lr, pc 7728: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 772c: e1a00005 mov r0, r5 7730: eaffffaa b 75e0 <_Heap_Walk+0x50> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 7734: e1a0000a mov r0, sl 7738: e3a01001 mov r1, #1 773c: e59f2448 ldr r2, [pc, #1096] ; 7b8c <_Heap_Walk+0x5fc> 7740: e1a03008 mov r3, r8 7744: e1a0e00f mov lr, pc 7748: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 774c: e1a0000b mov r0, fp 7750: eaffffa2 b 75e0 <_Heap_Walk+0x50> block = next_block; } while ( block != first_block ); return true; } 7754: e5945008 ldr r5, [r4, #8] const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 7758: e1540005 cmp r4, r5 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 775c: e5947010 ldr r7, [r4, #16] const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 7760: 05943020 ldreq r3, [r4, #32] 7764: 0a00000d beq 77a0 <_Heap_Walk+0x210> block = next_block; } while ( block != first_block ); return true; } 7768: e5943020 ldr r3, [r4, #32] const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 776c: e1530005 cmp r3, r5 7770: 9a000097 bls 79d4 <_Heap_Walk+0x444> const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 7774: e1a0000a mov r0, sl 7778: e3a01001 mov r1, #1 777c: e59f240c ldr r2, [pc, #1036] ; 7b90 <_Heap_Walk+0x600> 7780: e1a03005 mov r3, r5 7784: e1a0e00f mov lr, pc 7788: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 778c: e3a00000 mov r0, #0 7790: eaffff92 b 75e0 <_Heap_Walk+0x50> 7794: e1a03008 mov r3, r8 7798: e28d8030 add r8, sp, #48 ; 0x30 779c: e8980900 ldm r8, {r8, fp} ); return false; } if ( _Heap_Is_used( free_block ) ) { 77a0: e1a06008 mov r6, r8 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 77a4: e3cb7001 bic r7, fp, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 77a8: e0875006 add r5, r7, r6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 77ac: e1530005 cmp r3, r5 77b0: 9a000008 bls 77d8 <_Heap_Walk+0x248> Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { (*printer)( 77b4: e1a0000a mov r0, sl 77b8: e58d5000 str r5, [sp] 77bc: e3a01001 mov r1, #1 77c0: e59f23cc ldr r2, [pc, #972] ; 7b94 <_Heap_Walk+0x604> 77c4: e1a03006 mov r3, r6 77c8: e1a0e00f mov lr, pc 77cc: e12fff19 bx r9 "block 0x%08x: next block 0x%08x not in heap\n", block, next_block ); return false; 77d0: e3a00000 mov r0, #0 77d4: eaffff81 b 75e0 <_Heap_Walk+0x50> 77d8: e5943024 ldr r3, [r4, #36] ; 0x24 77dc: e1530005 cmp r3, r5 77e0: 3afffff3 bcc 77b4 <_Heap_Walk+0x224> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 77e4: e59d1024 ldr r1, [sp, #36] ; 0x24 77e8: e1a00007 mov r0, r7 77ec: ebffe4eb bl ba0 <__umodsi3> uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 77f0: e59d102c ldr r1, [sp, #44] ; 0x2c 77f4: e0563001 subs r3, r6, r1 77f8: 13a03001 movne r3, #1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 77fc: e3500000 cmp r0, #0 7800: 0a000001 beq 780c <_Heap_Walk+0x27c> 7804: e3530000 cmp r3, #0 7808: 1a0000aa bne 7ab8 <_Heap_Walk+0x528> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 780c: e59d2028 ldr r2, [sp, #40] ; 0x28 7810: e1520007 cmp r2, r7 7814: 9a000001 bls 7820 <_Heap_Walk+0x290> 7818: e3530000 cmp r3, #0 781c: 1a0000ae bne 7adc <_Heap_Walk+0x54c> ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 7820: e1560005 cmp r6, r5 7824: 3a000001 bcc 7830 <_Heap_Walk+0x2a0> 7828: e3530000 cmp r3, #0 782c: 1a0000b4 bne 7b04 <_Heap_Walk+0x574> block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 7830: e5953004 ldr r3, [r5, #4] ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 7834: e3130001 tst r3, #1 7838: e20bb001 and fp, fp, #1 783c: 0a000018 beq 78a4 <_Heap_Walk+0x314> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 7840: e35b0000 cmp fp, #0 7844: 0a00000c beq 787c <_Heap_Walk+0x2ec> (*printer)( 7848: e58d7000 str r7, [sp] 784c: e1a0000a mov r0, sl 7850: e3a01000 mov r1, #0 7854: e59f233c ldr r2, [pc, #828] ; 7b98 <_Heap_Walk+0x608> 7858: e1a03006 mov r3, r6 785c: e1a0e00f mov lr, pc 7860: e12fff19 bx r9 block->prev_size ); } block = next_block; } while ( block != first_block ); 7864: e1580005 cmp r8, r5 7868: 0affff5b beq 75dc <_Heap_Walk+0x4c> 786c: e595b004 ldr fp, [r5, #4] 7870: e5943020 ldr r3, [r4, #32] 7874: e1a06005 mov r6, r5 7878: eaffffc9 b 77a4 <_Heap_Walk+0x214> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 787c: e58d7000 str r7, [sp] 7880: e5963000 ldr r3, [r6] 7884: e1a0000a mov r0, sl 7888: e58d3004 str r3, [sp, #4] 788c: e1a0100b mov r1, fp 7890: e59f2304 ldr r2, [pc, #772] ; 7b9c <_Heap_Walk+0x60c> 7894: e1a03006 mov r3, r6 7898: e1a0e00f mov lr, pc 789c: e12fff19 bx r9 78a0: eaffffef b 7864 <_Heap_Walk+0x2d4> false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 78a4: e596200c ldr r2, [r6, #12] Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 78a8: e5943008 ldr r3, [r4, #8] 78ac: e1530002 cmp r3, r2 block = next_block; } while ( block != first_block ); return true; } 78b0: e594100c ldr r1, [r4, #12] Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 78b4: 059f02e4 ldreq r0, [pc, #740] ; 7ba0 <_Heap_Walk+0x610> 78b8: 0a000003 beq 78cc <_Heap_Walk+0x33c> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 78bc: e59f32e0 ldr r3, [pc, #736] ; 7ba4 <_Heap_Walk+0x614> 78c0: e1540002 cmp r4, r2 78c4: e59f02dc ldr r0, [pc, #732] ; 7ba8 <_Heap_Walk+0x618> 78c8: 01a00003 moveq r0, r3 block->next, block->next == last_free_block ? 78cc: e5963008 ldr r3, [r6, #8] Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 78d0: e1510003 cmp r1, r3 78d4: 059f12d0 ldreq r1, [pc, #720] ; 7bac <_Heap_Walk+0x61c> 78d8: 0a000003 beq 78ec <_Heap_Walk+0x35c> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 78dc: e59fc2cc ldr ip, [pc, #716] ; 7bb0 <_Heap_Walk+0x620> 78e0: e1540003 cmp r4, r3 78e4: e59f12bc ldr r1, [pc, #700] ; 7ba8 <_Heap_Walk+0x618> 78e8: 01a0100c moveq r1, ip Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 78ec: e58d2004 str r2, [sp, #4] 78f0: e58d0008 str r0, [sp, #8] 78f4: e58d300c str r3, [sp, #12] 78f8: e58d1010 str r1, [sp, #16] 78fc: e1a03006 mov r3, r6 7900: e58d7000 str r7, [sp] 7904: e1a0000a mov r0, sl 7908: e3a01000 mov r1, #0 790c: e59f22a0 ldr r2, [pc, #672] ; 7bb4 <_Heap_Walk+0x624> 7910: e1a0e00f mov lr, pc 7914: e12fff19 bx r9 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 7918: e5953000 ldr r3, [r5] 791c: e1570003 cmp r7, r3 7920: 1a000011 bne 796c <_Heap_Walk+0x3dc> ); return false; } if ( !prev_used ) { 7924: e35b0000 cmp fp, #0 7928: 0a00001a beq 7998 <_Heap_Walk+0x408> block = next_block; } while ( block != first_block ); return true; } 792c: e5943008 ldr r3, [r4, #8] ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 7930: e1540003 cmp r4, r3 7934: 0a000004 beq 794c <_Heap_Walk+0x3bc> if ( free_block == block ) { 7938: e1560003 cmp r6, r3 793c: 0affffc8 beq 7864 <_Heap_Walk+0x2d4> return true; } free_block = free_block->next; 7940: e5933008 ldr r3, [r3, #8] ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 7944: e1540003 cmp r4, r3 7948: 1afffffa bne 7938 <_Heap_Walk+0x3a8> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 794c: e1a0000a mov r0, sl 7950: e3a01001 mov r1, #1 7954: e59f225c ldr r2, [pc, #604] ; 7bb8 <_Heap_Walk+0x628> 7958: e1a03006 mov r3, r6 795c: e1a0e00f mov lr, pc 7960: e12fff19 bx r9 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 7964: e3a00000 mov r0, #0 7968: eaffff1c b 75e0 <_Heap_Walk+0x50> " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( 796c: e58d3004 str r3, [sp, #4] 7970: e1a0000a mov r0, sl 7974: e58d7000 str r7, [sp] 7978: e58d5008 str r5, [sp, #8] 797c: e3a01001 mov r1, #1 7980: e59f2234 ldr r2, [pc, #564] ; 7bbc <_Heap_Walk+0x62c> 7984: e1a03006 mov r3, r6 7988: e1a0e00f mov lr, pc 798c: e12fff19 bx r9 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 7990: e3a00000 mov r0, #0 7994: eaffff11 b 75e0 <_Heap_Walk+0x50> return false; } if ( !prev_used ) { (*printer)( 7998: e1a0000a mov r0, sl 799c: e3a01001 mov r1, #1 79a0: e59f2218 ldr r2, [pc, #536] ; 7bc0 <_Heap_Walk+0x630> 79a4: e1a03006 mov r3, r6 79a8: e1a0e00f mov lr, pc 79ac: e12fff19 bx r9 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 79b0: e1a0000b mov r0, fp 79b4: eaffff09 b 75e0 <_Heap_Walk+0x50> return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 79b8: e1a0000a mov r0, sl 79bc: e3a01001 mov r1, #1 79c0: e59f21fc ldr r2, [pc, #508] ; 7bc4 <_Heap_Walk+0x634> 79c4: e1a0e00f mov lr, pc 79c8: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 79cc: e1a00005 mov r0, r5 79d0: eaffff02 b 75e0 <_Heap_Walk+0x50> const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 79d4: e594c024 ldr ip, [r4, #36] ; 0x24 79d8: e15c0005 cmp ip, r5 79dc: 3affff64 bcc 7774 <_Heap_Walk+0x1e4> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 79e0: e2850008 add r0, r5, #8 79e4: e1a01007 mov r1, r7 79e8: e58d301c str r3, [sp, #28] 79ec: e58dc020 str ip, [sp, #32] 79f0: ebffe46a bl ba0 <__umodsi3> ); return false; } if ( 79f4: e3500000 cmp r0, #0 79f8: e28d301c add r3, sp, #28 79fc: e8931008 ldm r3, {r3, ip} 7a00: 1a000048 bne 7b28 <_Heap_Walk+0x598> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 7a04: e5952004 ldr r2, [r5, #4] 7a08: e3c22001 bic r2, r2, #1 block = next_block; } while ( block != first_block ); return true; } 7a0c: e0852002 add r2, r5, r2 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 7a10: e5922004 ldr r2, [r2, #4] ); return false; } if ( _Heap_Is_used( free_block ) ) { 7a14: e3120001 tst r2, #1 7a18: 1a00004a bne 7b48 <_Heap_Walk+0x5b8> 7a1c: e58d8030 str r8, [sp, #48] ; 0x30 7a20: e58db034 str fp, [sp, #52] ; 0x34 7a24: e1a01004 mov r1, r4 7a28: e1a06005 mov r6, r5 7a2c: e1a0b00c mov fp, ip 7a30: e1a08003 mov r8, r3 7a34: ea000013 b 7a88 <_Heap_Walk+0x4f8> return false; } prev_block = free_block; free_block = free_block->next; 7a38: e5955008 ldr r5, [r5, #8] const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 7a3c: e1540005 cmp r4, r5 7a40: 0affff53 beq 7794 <_Heap_Walk+0x204> const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 7a44: e1580005 cmp r8, r5 7a48: 8affff49 bhi 7774 <_Heap_Walk+0x1e4> 7a4c: e155000b cmp r5, fp RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 7a50: e2850008 add r0, r5, #8 7a54: e1a01007 mov r1, r7 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 7a58: 8affff45 bhi 7774 <_Heap_Walk+0x1e4> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 7a5c: ebffe44f bl ba0 <__umodsi3> ); return false; } if ( 7a60: e3500000 cmp r0, #0 7a64: 1a00002f bne 7b28 <_Heap_Walk+0x598> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 7a68: e5953004 ldr r3, [r5, #4] 7a6c: e3c33001 bic r3, r3, #1 block = next_block; } while ( block != first_block ); return true; } 7a70: e0833005 add r3, r3, r5 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 7a74: e5933004 ldr r3, [r3, #4] ); return false; } if ( _Heap_Is_used( free_block ) ) { 7a78: e3130001 tst r3, #1 7a7c: 1a000031 bne 7b48 <_Heap_Walk+0x5b8> 7a80: e1a01006 mov r1, r6 7a84: e1a06005 mov r6, r5 ); return false; } if ( free_block->prev != prev_block ) { 7a88: e595200c ldr r2, [r5, #12] 7a8c: e1520001 cmp r2, r1 7a90: 0affffe8 beq 7a38 <_Heap_Walk+0x4a8> (*printer)( 7a94: e58d2000 str r2, [sp] 7a98: e1a0000a mov r0, sl 7a9c: e3a01001 mov r1, #1 7aa0: e59f2120 ldr r2, [pc, #288] ; 7bc8 <_Heap_Walk+0x638> 7aa4: e1a03005 mov r3, r5 7aa8: e1a0e00f mov lr, pc 7aac: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 7ab0: e3a00000 mov r0, #0 7ab4: eafffec9 b 75e0 <_Heap_Walk+0x50> return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( 7ab8: e1a0000a mov r0, sl 7abc: e58d7000 str r7, [sp] 7ac0: e3a01001 mov r1, #1 7ac4: e59f2100 ldr r2, [pc, #256] ; 7bcc <_Heap_Walk+0x63c> 7ac8: e1a03006 mov r3, r6 7acc: e1a0e00f mov lr, pc 7ad0: e12fff19 bx r9 "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; 7ad4: e3a00000 mov r0, #0 7ad8: eafffec0 b 75e0 <_Heap_Walk+0x50> } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( 7adc: e58d2004 str r2, [sp, #4] 7ae0: e1a0000a mov r0, sl 7ae4: e58d7000 str r7, [sp] 7ae8: e3a01001 mov r1, #1 7aec: e59f20dc ldr r2, [pc, #220] ; 7bd0 <_Heap_Walk+0x640> 7af0: e1a03006 mov r3, r6 7af4: e1a0e00f mov lr, pc 7af8: e12fff19 bx r9 block, block_size, min_block_size ); return false; 7afc: e3a00000 mov r0, #0 7b00: eafffeb6 b 75e0 <_Heap_Walk+0x50> } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 7b04: e1a0000a mov r0, sl 7b08: e58d5000 str r5, [sp] 7b0c: e3a01001 mov r1, #1 7b10: e59f20bc ldr r2, [pc, #188] ; 7bd4 <_Heap_Walk+0x644> 7b14: e1a03006 mov r3, r6 7b18: e1a0e00f mov lr, pc 7b1c: e12fff19 bx r9 "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 7b20: e3a00000 mov r0, #0 7b24: eafffead b 75e0 <_Heap_Walk+0x50> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 7b28: e1a0000a mov r0, sl 7b2c: e3a01001 mov r1, #1 7b30: e59f20a0 ldr r2, [pc, #160] ; 7bd8 <_Heap_Walk+0x648> 7b34: e1a03005 mov r3, r5 7b38: e1a0e00f mov lr, pc 7b3c: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 7b40: e3a00000 mov r0, #0 7b44: eafffea5 b 75e0 <_Heap_Walk+0x50> return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 7b48: e1a0000a mov r0, sl 7b4c: e3a01001 mov r1, #1 7b50: e59f2084 ldr r2, [pc, #132] ; 7bdc <_Heap_Walk+0x64c> 7b54: e1a03005 mov r3, r5 7b58: e1a0e00f mov lr, pc 7b5c: e12fff19 bx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 7b60: e3a00000 mov r0, #0 7b64: eafffe9d b 75e0 <_Heap_Walk+0x50> =============================================================================== 00006a84 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 6a84: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 6a88: e5904034 ldr r4, [r0, #52] ; 0x34 6a8c: e3540000 cmp r4, #0 */ void _Objects_Extend_information( Objects_Information *information ) { 6a90: e24dd014 sub sp, sp, #20 6a94: e1a05000 mov r5, r0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 6a98: e1d070b8 ldrh r7, [r0, #8] index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 6a9c: 0a00009b beq 6d10 <_Objects_Extend_information+0x28c> block_count = 0; else { block_count = information->maximum / information->allocation_size; 6aa0: e1d081b4 ldrh r8, [r0, #20] 6aa4: e1d0a1b0 ldrh sl, [r0, #16] 6aa8: e1a01008 mov r1, r8 6aac: e1a0000a mov r0, sl 6ab0: eb0029a6 bl 11150 <__aeabi_uidiv> 6ab4: e1a03800 lsl r3, r0, #16 for ( ; block < block_count; block++ ) { 6ab8: e1b03823 lsrs r3, r3, #16 6abc: 0a000099 beq 6d28 <_Objects_Extend_information+0x2a4> if ( information->object_blocks[ block ] == NULL ) { 6ac0: e5949000 ldr r9, [r4] 6ac4: e3590000 cmp r9, #0 6ac8: 01a01008 moveq r1, r8 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 6acc: 01a06007 moveq r6, r7 index_base = minimum_index; block = 0; 6ad0: 01a04009 moveq r4, r9 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 6ad4: 0a00000c beq 6b0c <_Objects_Extend_information+0x88> 6ad8: e1a02004 mov r2, r4 6adc: e1a01008 mov r1, r8 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 6ae0: e1a06007 mov r6, r7 index_base = minimum_index; block = 0; 6ae4: e3a04000 mov r4, #0 6ae8: ea000002 b 6af8 <_Objects_Extend_information+0x74> block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 6aec: e5b29004 ldr r9, [r2, #4]! 6af0: e3590000 cmp r9, #0 6af4: 0a000004 beq 6b0c <_Objects_Extend_information+0x88> if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 6af8: e2844001 add r4, r4, #1 6afc: e1530004 cmp r3, r4 if ( information->object_blocks[ block ] == NULL ) { do_extend = false; break; } else index_base += information->allocation_size; 6b00: e0866008 add r6, r6, r8 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 6b04: 8afffff8 bhi 6aec <_Objects_Extend_information+0x68> /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 6b08: e3a09001 mov r9, #1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 6b0c: e08aa001 add sl, sl, r1 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 6b10: e35a0801 cmp sl, #65536 ; 0x10000 6b14: 2a000063 bcs 6ca8 <_Objects_Extend_information+0x224> /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; if ( information->auto_extend ) { 6b18: e5d52012 ldrb r2, [r5, #18] /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; 6b1c: e5950018 ldr r0, [r5, #24] if ( information->auto_extend ) { 6b20: e3520000 cmp r2, #0 /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; 6b24: e0000091 mul r0, r1, r0 if ( information->auto_extend ) { 6b28: 1a000060 bne 6cb0 <_Objects_Extend_information+0x22c> new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 6b2c: e58d3000 str r3, [sp] 6b30: eb000838 bl 8c18 <_Workspace_Allocate_or_fatal_error> 6b34: e59d3000 ldr r3, [sp] 6b38: e1a08000 mov r8, r0 } /* * Do we need to grow the tables? */ if ( do_extend ) { 6b3c: e3590000 cmp r9, #0 6b40: 0a000039 beq 6c2c <_Objects_Extend_information+0x1a8> */ /* * Up the block count and maximum */ block_count++; 6b44: e283b001 add fp, r3, #1 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 6b48: e08b008b add r0, fp, fp, lsl #1 ((maximum + minimum_index) * sizeof(Objects_Control *)); 6b4c: e08a0000 add r0, sl, r0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 6b50: e0800007 add r0, r0, r7 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 6b54: e1a00100 lsl r0, r0, #2 6b58: e58d3000 str r3, [sp] 6b5c: eb000823 bl 8bf0 <_Workspace_Allocate> if ( !object_blocks ) { 6b60: e2509000 subs r9, r0, #0 6b64: e59d3000 ldr r3, [sp] 6b68: 0a000073 beq 6d3c <_Objects_Extend_information+0x2b8> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 6b6c: e1d521b0 ldrh r2, [r5, #16] 6b70: e1570002 cmp r7, r2 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); 6b74: e089c10b add ip, r9, fp, lsl #2 6b78: e089b18b add fp, r9, fp, lsl #3 6b7c: 3a000051 bcc 6cc8 <_Objects_Extend_information+0x244> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 6b80: e3570000 cmp r7, #0 6b84: 13a02000 movne r2, #0 6b88: 11a0100b movne r1, fp local_table[ index ] = NULL; 6b8c: 11a00002 movne r0, r2 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 6b90: 0a000003 beq 6ba4 <_Objects_Extend_information+0x120> 6b94: e2822001 add r2, r2, #1 6b98: e1570002 cmp r7, r2 local_table[ index ] = NULL; 6b9c: e4810004 str r0, [r1], #4 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 6ba0: 8afffffb bhi 6b94 <_Objects_Extend_information+0x110> 6ba4: e1a03103 lsl r3, r3, #2 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 6ba8: e1d511b4 ldrh r1, [r5, #20] 6bac: e0861001 add r1, r6, r1 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 6bb0: e3a00000 mov r0, #0 inactive_per_block[block_count] = 0; for ( index=index_base ; 6bb4: e1560001 cmp r6, r1 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 6bb8: e7890003 str r0, [r9, r3] inactive_per_block[block_count] = 0; 6bbc: e78c0003 str r0, [ip, r3] for ( index=index_base ; 6bc0: 2a000005 bcs 6bdc <_Objects_Extend_information+0x158> 6bc4: e08b2106 add r2, fp, r6, lsl #2 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 6bc8: e1a03006 mov r3, r6 object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { 6bcc: e2833001 add r3, r3, #1 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 6bd0: e1530001 cmp r3, r1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 6bd4: e4820004 str r0, [r2], #4 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 6bd8: 3afffffb bcc 6bcc <_Objects_Extend_information+0x148> 6bdc: e10f3000 mrs r3, CPSR 6be0: e3832080 orr r2, r3, #128 ; 0x80 6be4: e129f002 msr CPSR_fc, r2 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 6be8: e5952000 ldr r2, [r5] information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 6bec: e1d510b4 ldrh r1, [r5, #4] 6bf0: e1a02c02 lsl r2, r2, #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 = (Objects_Maximum) maximum; 6bf4: e1a0a80a lsl sl, sl, #16 6bf8: e3822801 orr r2, r2, #65536 ; 0x10000 6bfc: e1a0a82a lsr sl, sl, #16 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 6c00: e1822d81 orr r2, r2, r1, lsl #27 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 6c04: e182200a orr r2, r2, sl local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 6c08: e5950034 ldr r0, [r5, #52] ; 0x34 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; 6c0c: e585c030 str ip, [r5, #48] ; 0x30 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 6c10: e5859034 str r9, [r5, #52] ; 0x34 information->inactive_per_block = inactive_per_block; information->local_table = local_table; 6c14: e585b01c str fp, [r5, #28] information->maximum = (Objects_Maximum) maximum; 6c18: e1c5a1b0 strh sl, [r5, #16] information->maximum_id = _Objects_Build_id( 6c1c: e585200c str r2, [r5, #12] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( 6c20: e129f003 msr CPSR_fc, r3 information->maximum ); _ISR_Enable( level ); if ( old_tables ) 6c24: e3500000 cmp r0, #0 _Workspace_Free( old_tables ); 6c28: 1b0007f6 blne 8c08 <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 6c2c: e5953034 ldr r3, [r5, #52] ; 0x34 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 6c30: e28d7008 add r7, sp, #8 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 6c34: e7838104 str r8, [r3, r4, lsl #2] /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 6c38: e1a01008 mov r1, r8 6c3c: e1a00007 mov r0, r7 6c40: e1d521b4 ldrh r2, [r5, #20] 6c44: e5953018 ldr r3, [r5, #24] 6c48: eb001222 bl b4d8 <_Chain_Initialize> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 6c4c: e1a04104 lsl r4, r4, #2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 6c50: e2858020 add r8, r5, #32 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 6c54: ea000009 b 6c80 <_Objects_Extend_information+0x1fc> 6c58: e5953000 ldr r3, [r5] the_object->id = _Objects_Build_id( 6c5c: e1d520b4 ldrh r2, [r5, #4] 6c60: e1a03c03 lsl r3, r3, #24 6c64: e3833801 orr r3, r3, #65536 ; 0x10000 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 6c68: e1833d82 orr r3, r3, r2, lsl #27 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 6c6c: e1833006 orr r3, r3, r6 6c70: e5813008 str r3, [r1, #8] information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 6c74: e1a00008 mov r0, r8 6c78: ebfffce3 bl 600c <_Chain_Append> index++; 6c7c: e2866001 add r6, r6, #1 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 6c80: e1a00007 mov r0, r7 6c84: ebfffcf3 bl 6058 <_Chain_Get> 6c88: e2501000 subs r1, r0, #0 6c8c: 1afffff1 bne 6c58 <_Objects_Extend_information+0x1d4> index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 6c90: e1d522bc ldrh r2, [r5, #44] ; 0x2c _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 6c94: e1d531b4 ldrh r3, [r5, #20] 6c98: e5951030 ldr r1, [r5, #48] ; 0x30 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 6c9c: e0832002 add r2, r3, r2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 6ca0: e7813004 str r3, [r1, r4] information->inactive = 6ca4: e1c522bc strh r2, [r5, #44] ; 0x2c (Objects_Maximum)(information->inactive + information->allocation_size); } 6ca8: e28dd014 add sp, sp, #20 6cac: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); 6cb0: e58d3000 str r3, [sp] 6cb4: eb0007cd bl 8bf0 <_Workspace_Allocate> if ( !new_object_block ) 6cb8: e2508000 subs r8, r0, #0 6cbc: e59d3000 ldr r3, [sp] 6cc0: 1affff9d bne 6b3c <_Objects_Extend_information+0xb8> 6cc4: eafffff7 b 6ca8 <_Objects_Extend_information+0x224> /* * 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, 6cc8: e1a03103 lsl r3, r3, #2 6ccc: e5951034 ldr r1, [r5, #52] ; 0x34 6cd0: e1a02003 mov r2, r3 6cd4: e88d1008 stm sp, {r3, ip} 6cd8: eb001d9b bl e34c information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 6cdc: e89d1008 ldm sp, {r3, ip} 6ce0: e1a0000c mov r0, ip 6ce4: e1a02003 mov r2, r3 6ce8: e5951030 ldr r1, [r5, #48] ; 0x30 6cec: eb001d96 bl e34c information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 6cf0: e1d521b0 ldrh r2, [r5, #16] 6cf4: e0872002 add r2, r7, r2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 6cf8: e1a0000b mov r0, fp 6cfc: e595101c ldr r1, [r5, #28] 6d00: e1a02102 lsl r2, r2, #2 6d04: eb001d90 bl e34c 6d08: e89d1008 ldm sp, {r3, ip} 6d0c: eaffffa5 b 6ba8 <_Objects_Extend_information+0x124> minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 6d10: e1d0a1b0 ldrh sl, [r0, #16] 6d14: e1d011b4 ldrh r1, [r0, #20] /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 6d18: e1a06007 mov r6, r7 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 6d1c: e3a09001 mov r9, #1 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; 6d20: e1a03004 mov r3, r4 6d24: eaffff78 b 6b0c <_Objects_Extend_information+0x88> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 6d28: e1a01008 mov r1, r8 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 6d2c: e1a06007 mov r6, r7 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 6d30: e3a09001 mov r9, #1 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 6d34: e1a04003 mov r4, r3 <== NOT EXECUTED 6d38: eaffff73 b 6b0c <_Objects_Extend_information+0x88> <== NOT EXECUTED (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); if ( !object_blocks ) { _Workspace_Free( new_object_block ); 6d3c: e1a00008 mov r0, r8 6d40: eb0007b0 bl 8c08 <_Workspace_Free> return; 6d44: eaffffd7 b 6ca8 <_Objects_Extend_information+0x224> =============================================================================== 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: e1a05000 mov r5, r0 773c: e1a06001 mov r6, r1 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 7740: e1a00002 mov r0, r2 7744: e1d513ba ldrh r1, [r5, #58] ; 0x3a bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 7748: e1a07002 mov r7, r2 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 774c: eb002211 bl ff98 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 7750: e5d53038 ldrb r3, [r5, #56] ; 0x38 7754: e3530000 cmp r3, #0 { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 7758: e1a04000 mov r4, r0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 775c: 1a000017 bne 77c0 <_Objects_Set_name+0x8c> d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 7760: e5d72000 ldrb r2, [r7] 7764: e3500001 cmp r0, #1 7768: e1a02c02 lsl r2, r2, #24 776c: 9a00000c bls 77a4 <_Objects_Set_name+0x70> 7770: e5d73001 ldrb r3, [r7, #1] 7774: e3500002 cmp r0, #2 7778: e1822803 orr r2, r2, r3, lsl #16 777c: 0a000009 beq 77a8 <_Objects_Set_name+0x74> 7780: e5d73002 ldrb r3, [r7, #2] 7784: e3500003 cmp r0, #3 7788: e1822403 orr r2, r2, r3, lsl #8 778c: 15d73003 ldrbne r3, [r7, #3] 7790: 03a03020 moveq r3, #32 7794: e1823003 orr r3, r2, r3 7798: e586300c str r3, [r6, #12] ((3 < length) ? s[ 3 ] : ' ') ); } return true; 779c: e3a00001 mov r0, #1 77a0: e8bd80f0 pop {r4, r5, r6, r7, pc} d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 77a4: e3822602 orr r2, r2, #2097152 ; 0x200000 77a8: e3822a02 orr r2, r2, #8192 ; 0x2000 77ac: e3a03020 mov r3, #32 77b0: e1823003 orr r3, r2, r3 77b4: e586300c str r3, [r6, #12] ((3 < length) ? s[ 3 ] : ' ') ); } return true; 77b8: e3a00001 mov r0, #1 77bc: e8bd80f0 pop {r4, r5, r6, r7, pc} #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { char *d; d = _Workspace_Allocate( length + 1 ); 77c0: e2800001 add r0, r0, #1 77c4: eb0006e4 bl 935c <_Workspace_Allocate> if ( !d ) 77c8: e2505000 subs r5, r0, #0 77cc: 0a00000e beq 780c <_Objects_Set_name+0xd8> return false; if ( the_object->name.name_p ) { 77d0: e596000c ldr r0, [r6, #12] 77d4: e3500000 cmp r0, #0 77d8: 0a000002 beq 77e8 <_Objects_Set_name+0xb4> _Workspace_Free( (void *)the_object->name.name_p ); 77dc: eb0006e4 bl 9374 <_Workspace_Free> the_object->name.name_p = NULL; 77e0: e3a03000 mov r3, #0 77e4: e586300c str r3, [r6, #12] } strncpy( d, name, length ); 77e8: e1a00005 mov r0, r5 77ec: e1a01007 mov r1, r7 77f0: e1a02004 mov r2, r4 77f4: eb0021ac bl feac d[length] = '\0'; 77f8: e3a03000 mov r3, #0 77fc: e7c53004 strb r3, [r5, r4] ((3 < length) ? s[ 3 ] : ' ') ); } return true; 7800: e3a00001 mov r0, #1 the_object->name.name_p = NULL; } strncpy( d, name, length ); d[length] = '\0'; the_object->name.name_p = d; 7804: e586500c str r5, [r6, #12] 7808: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( information->is_string ) { char *d; d = _Workspace_Allocate( length + 1 ); if ( !d ) return false; 780c: e1a00005 mov r0, r5 <== NOT EXECUTED ); } return true; } 7810: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== 000070a8 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { 70a8: e92d40f0 push {r4, r5, r6, r7, lr} /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 70ac: e1d040b8 ldrh r4, [r0, #8] block_count = (information->maximum - index_base) / 70b0: e1d051b4 ldrh r5, [r0, #20] */ void _Objects_Shrink_information( Objects_Information *information ) { 70b4: e1a06000 mov r6, r0 /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / 70b8: e1d001b0 ldrh r0, [r0, #16] 70bc: e1a01005 mov r1, r5 70c0: e0640000 rsb r0, r4, r0 70c4: eb002821 bl 11150 <__aeabi_uidiv> information->allocation_size; for ( block = 0; block < block_count; block++ ) { 70c8: e3500000 cmp r0, #0 70cc: 08bd80f0 popeq {r4, r5, r6, r7, pc} if ( information->inactive_per_block[ block ] == 70d0: e5962030 ldr r2, [r6, #48] ; 0x30 70d4: e5923000 ldr r3, [r2] 70d8: e1550003 cmp r5, r3 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 70dc: 13a03000 movne r3, #0 if ( information->inactive_per_block[ block ] == 70e0: 1a000005 bne 70fc <_Objects_Shrink_information+0x54> 70e4: ea000008 b 710c <_Objects_Shrink_information+0x64> <== NOT EXECUTED 70e8: e5b21004 ldr r1, [r2, #4]! 70ec: e1550001 cmp r5, r1 information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; 70f0: e0844005 add r4, r4, r5 70f4: e1a07103 lsl r7, r3, #2 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == 70f8: 0a000004 beq 7110 <_Objects_Shrink_information+0x68> index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 70fc: e2833001 add r3, r3, #1 7100: e1500003 cmp r0, r3 7104: 8afffff7 bhi 70e8 <_Objects_Shrink_information+0x40> 7108: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( information->inactive_per_block[ block ] == 710c: e3a07000 mov r7, #0 <== NOT EXECUTED information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) information->Inactive.first; 7110: e5960020 ldr r0, [r6, #32] 7114: ea000002 b 7124 <_Objects_Shrink_information+0x7c> if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); 7118: e3550000 cmp r5, #0 711c: 0a00000b beq 7150 <_Objects_Shrink_information+0xa8> index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 7120: e1a00005 mov r0, r5 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) information->Inactive.first; do { index = _Objects_Get_index( the_object->id ); 7124: e1d030b8 ldrh r3, [r0, #8] /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 7128: e1530004 cmp r3, r4 index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 712c: e5905000 ldr r5, [r0] if ((index >= index_base) && 7130: 3afffff8 bcc 7118 <_Objects_Shrink_information+0x70> (index < (index_base + information->allocation_size))) { 7134: e1d621b4 ldrh r2, [r6, #20] 7138: e0842002 add r2, r4, r2 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 713c: e1530002 cmp r3, r2 7140: 2afffff4 bcs 7118 <_Objects_Shrink_information+0x70> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 7144: ebfffbbb bl 6038 <_Chain_Extract> } } while ( the_object ); 7148: e3550000 cmp r5, #0 714c: 1afffff3 bne 7120 <_Objects_Shrink_information+0x78> /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 7150: e5963034 ldr r3, [r6, #52] ; 0x34 7154: e7930007 ldr r0, [r3, r7] 7158: eb0006aa bl 8c08 <_Workspace_Free> information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; 715c: e1d602bc ldrh r0, [r6, #44] ; 0x2c 7160: e1d631b4 ldrh r3, [r6, #20] /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 7164: e5961034 ldr r1, [r6, #52] ; 0x34 information->inactive_per_block[ block ] = 0; 7168: e5962030 ldr r2, [r6, #48] ; 0x30 information->inactive -= information->allocation_size; 716c: e0633000 rsb r3, r3, r0 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 7170: e7815007 str r5, [r1, r7] information->inactive_per_block[ block ] = 0; 7174: e7825007 str r5, [r2, r7] information->inactive -= information->allocation_size; 7178: e1c632bc strh r3, [r6, #44] ; 0x2c return; 717c: e8bd80f0 pop {r4, r5, r6, r7, pc} =============================================================================== 00006784 <_POSIX_Condition_variables_Wait_support>: pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 6784: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} 6788: e24dd004 sub sp, sp, #4 678c: e1a04001 mov r4, r1 6790: e1a06000 mov r6, r0 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 6794: e1a00001 mov r0, r1 6798: e1a0100d mov r1, sp pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 679c: e1a08002 mov r8, r2 67a0: e20370ff and r7, r3, #255 ; 0xff register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 67a4: eb00005a bl 6914 <_POSIX_Mutex_Get> 67a8: e3500000 cmp r0, #0 67ac: 0a00000a beq 67dc <_POSIX_Condition_variables_Wait_support+0x58> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 67b0: e59f30d8 ldr r3, [pc, #216] ; 6890 <_POSIX_Condition_variables_Wait_support+0x10c> 67b4: e5932000 ldr r2, [r3] 67b8: e2422001 sub r2, r2, #1 67bc: e5832000 str r2, [r3] return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 67c0: e1a00006 mov r0, r6 67c4: e1a0100d mov r1, sp 67c8: ebffff75 bl 65a4 <_POSIX_Condition_variables_Get> switch ( location ) { 67cc: e59d3000 ldr r3, [sp] 67d0: e3530000 cmp r3, #0 return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 67d4: e1a0a000 mov sl, r0 switch ( location ) { 67d8: 0a000003 beq 67ec <_POSIX_Condition_variables_Wait_support+0x68> #endif case OBJECTS_ERROR: break; } return EINVAL; 67dc: e3a05016 mov r5, #22 } 67e0: e1a00005 mov r0, r5 67e4: e28dd004 add sp, sp, #4 67e8: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} the_cond = _POSIX_Condition_variables_Get( cond, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_cond->Mutex && ( the_cond->Mutex != *mutex ) ) { 67ec: e5903014 ldr r3, [r0, #20] 67f0: e3530000 cmp r3, #0 67f4: 0a000005 beq 6810 <_POSIX_Condition_variables_Wait_support+0x8c> 67f8: e5942000 ldr r2, [r4] 67fc: e1530002 cmp r3, r2 6800: 0a000002 beq 6810 <_POSIX_Condition_variables_Wait_support+0x8c> _Thread_Enable_dispatch(); 6804: eb000c88 bl 9a2c <_Thread_Enable_dispatch> return EINVAL; 6808: e3a05016 mov r5, #22 680c: eafffff3 b 67e0 <_POSIX_Condition_variables_Wait_support+0x5c> } (void) pthread_mutex_unlock( mutex ); 6810: e1a00004 mov r0, r4 6814: eb0000e4 bl 6bac _Thread_Enable_dispatch(); return EINVAL; } */ if ( !already_timedout ) { 6818: e3570000 cmp r7, #0 681c: 0a000006 beq 683c <_POSIX_Condition_variables_Wait_support+0xb8> status = _Thread_Executing->Wait.return_code; if ( status && status != ETIMEDOUT ) return status; } else { _Thread_Enable_dispatch(); 6820: eb000c81 bl 9a2c <_Thread_Enable_dispatch> status = ETIMEDOUT; 6824: e3a05074 mov r5, #116 ; 0x74 /* * When we get here the dispatch disable level is 0. */ mutex_status = pthread_mutex_lock( mutex ); 6828: e1a00004 mov r0, r4 682c: eb0000bd bl 6b28 if ( mutex_status ) return EINVAL; 6830: e3500000 cmp r0, #0 6834: 13a05016 movne r5, #22 6838: eaffffe8 b 67e0 <_POSIX_Condition_variables_Wait_support+0x5c> if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 683c: e59f5050 ldr r5, [pc, #80] ; 6894 <_POSIX_Condition_variables_Wait_support+0x110> return EINVAL; } */ if ( !already_timedout ) { the_cond->Mutex = *mutex; 6840: e5942000 ldr r2, [r4] _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 6844: e5953004 ldr r3, [r5, #4] return EINVAL; } */ if ( !already_timedout ) { the_cond->Mutex = *mutex; 6848: e58a2014 str r2, [sl, #20] 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; 684c: e3a02001 mov r2, #1 6850: e58a2048 str r2, [sl, #72] ; 0x48 _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 6854: e5837034 str r7, [r3, #52] ; 0x34 _Thread_Executing->Wait.queue = &the_cond->Wait_queue; _Thread_Executing->Wait.id = *cond; 6858: e5962000 ldr r2, [r6] if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; _Thread_Executing->Wait.queue = &the_cond->Wait_queue; 685c: e28a0018 add r0, sl, #24 _Thread_Executing->Wait.id = *cond; 6860: e5832020 str r2, [r3, #32] if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; _Thread_Executing->Wait.queue = &the_cond->Wait_queue; 6864: e5830044 str r0, [r3, #68] ; 0x44 _Thread_Executing->Wait.id = *cond; _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 6868: e1a01008 mov r1, r8 686c: e59f2024 ldr r2, [pc, #36] ; 6898 <_POSIX_Condition_variables_Wait_support+0x114> 6870: eb000da5 bl 9f0c <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 6874: eb000c6c bl 9a2c <_Thread_Enable_dispatch> /* * Switch ourself out because we blocked as a result of the * _Thread_queue_Enqueue. */ status = _Thread_Executing->Wait.return_code; 6878: e5953004 ldr r3, [r5, #4] 687c: e5935034 ldr r5, [r3, #52] ; 0x34 if ( status && status != ETIMEDOUT ) 6880: e3550074 cmp r5, #116 ; 0x74 6884: 13550000 cmpne r5, #0 6888: 0affffe6 beq 6828 <_POSIX_Condition_variables_Wait_support+0xa4> 688c: eaffffd3 b 67e0 <_POSIX_Condition_variables_Wait_support+0x5c><== NOT EXECUTED =============================================================================== 0000da10 <_POSIX_signals_Clear_process_signals>: static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( da10: e10f2000 mrs r2, CPSR da14: e3823080 orr r3, r2, #128 ; 0x80 da18: e129f003 msr CPSR_fc, r3 mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { da1c: e59f1050 ldr r1, [pc, #80] ; da74 <_POSIX_signals_Clear_process_signals+0x64> da20: e0803080 add r3, r0, r0, lsl #1 da24: e7911103 ldr r1, [r1, r3, lsl #2] da28: e3510002 cmp r1, #2 da2c: e1a01103 lsl r1, r3, #2 da30: 0a000007 beq da54 <_POSIX_signals_Clear_process_signals+0x44> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; da34: e59f303c ldr r3, [pc, #60] ; da78 <_POSIX_signals_Clear_process_signals+0x68> da38: e5931000 ldr r1, [r3] da3c: e3a0c001 mov ip, #1 da40: e2400001 sub r0, r0, #1 da44: e1c1001c bic r0, r1, ip, lsl r0 da48: e5830000 str r0, [r3] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( da4c: e129f002 msr CPSR_fc, r2 } _ISR_Enable( level ); } da50: e12fff1e bx lr */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); da54: e59fc020 ldr ip, [pc, #32] ; da7c <_POSIX_signals_Clear_process_signals+0x6c> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; da58: e2811004 add r1, r1, #4 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) da5c: e79c3103 ldr r3, [ip, r3, lsl #2] da60: e081c00c add ip, r1, ip da64: e153000c cmp r3, ip da68: 0afffff1 beq da34 <_POSIX_signals_Clear_process_signals+0x24> da6c: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } da70: e12fff1e bx lr <== NOT EXECUTED =============================================================================== 000066a8 <_TOD_Validate>: { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 66a8: e59f30b8 ldr r3, [pc, #184] ; 6768 <_TOD_Validate+0xc0> */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 66ac: e92d4010 push {r4, lr} uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 66b0: e2504000 subs r4, r0, #0 { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 66b4: e593100c ldr r1, [r3, #12] (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; 66b8: 01a00004 moveq r0, r4 uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 66bc: 08bd8010 popeq {r4, pc} ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 66c0: e3a0093d mov r0, #999424 ; 0xf4000 66c4: e2800d09 add r0, r0, #576 ; 0x240 66c8: eb0048eb bl 18a7c <__aeabi_uidiv> rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 66cc: e5943018 ldr r3, [r4, #24] 66d0: e1500003 cmp r0, r3 66d4: 9a00001f bls 6758 <_TOD_Validate+0xb0> (the_tod->ticks >= ticks_per_second) || 66d8: e5943014 ldr r3, [r4, #20] 66dc: e353003b cmp r3, #59 ; 0x3b 66e0: 8a00001c bhi 6758 <_TOD_Validate+0xb0> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 66e4: e5943010 ldr r3, [r4, #16] 66e8: e353003b cmp r3, #59 ; 0x3b 66ec: 8a000019 bhi 6758 <_TOD_Validate+0xb0> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 66f0: e594300c ldr r3, [r4, #12] 66f4: e3530017 cmp r3, #23 66f8: 8a000016 bhi 6758 <_TOD_Validate+0xb0> (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 66fc: e5940004 ldr r0, [r4, #4] rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || 6700: e3500000 cmp r0, #0 6704: 08bd8010 popeq {r4, pc} (the_tod->month == 0) || 6708: e350000c cmp r0, #12 670c: 8a000011 bhi 6758 <_TOD_Validate+0xb0> (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 6710: e5942000 ldr r2, [r4] (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 6714: e3a03d1f mov r3, #1984 ; 0x7c0 6718: e2833003 add r3, r3, #3 671c: e1520003 cmp r2, r3 6720: 9a00000c bls 6758 <_TOD_Validate+0xb0> (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 6724: e5944008 ldr r4, [r4, #8] (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 6728: e3540000 cmp r4, #0 672c: 0a00000b beq 6760 <_TOD_Validate+0xb8> (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 6730: e3120003 tst r2, #3 days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 6734: 059f3030 ldreq r3, [pc, #48] ; 676c <_TOD_Validate+0xc4> else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 6738: 159f302c ldrne r3, [pc, #44] ; 676c <_TOD_Validate+0xc4> (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 673c: 0280000d addeq r0, r0, #13 6740: 07930100 ldreq r0, [r3, r0, lsl #2] else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 6744: 17930100 ldrne r0, [r3, r0, lsl #2] * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 6748: e1500004 cmp r0, r4 674c: 33a00000 movcc r0, #0 6750: 23a00001 movcs r0, #1 6754: e8bd8010 pop {r4, pc} (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; 6758: e3a00000 mov r0, #0 675c: e8bd8010 pop {r4, pc} 6760: e1a00004 mov r0, r4 <== NOT EXECUTED if ( the_tod->day > days_in_month ) return false; return true; } 6764: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== 00007d5c <_Thread_queue_Enqueue_priority>: Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 7d5c: e5913014 ldr r3, [r1, #20] Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 7d60: e92d0ff0 push {r4, r5, r6, r7, r8, r9, sl, fp} 7d64: e281403c add r4, r1, #60 ; 0x3c Chain_Node *previous_node; Chain_Node *search_node; Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); 7d68: e281c038 add ip, r1, #56 ; 0x38 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 7d6c: e5814038 str r4, [r1, #56] ; 0x38 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 ) ) 7d70: e3130020 tst r3, #32 the_chain->permanent_null = NULL; 7d74: e3a04000 mov r4, #0 7d78: e581403c str r4, [r1, #60] ; 0x3c the_chain->last = _Chain_Head(the_chain); 7d7c: e581c040 str ip, [r1, #64] ; 0x40 RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); 7d80: e1a08323 lsr r8, r3, #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 ]; block_state = the_thread_queue->state; 7d84: e5905038 ldr r5, [r0, #56] ; 0x38 if ( _Thread_queue_Is_reverse_search( priority ) ) 7d88: 1a00001f bne 7e0c <_Thread_queue_Enqueue_priority+0xb0> goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->first; 7d8c: e0888088 add r8, r8, r8, lsl #1 7d90: e1a09108 lsl r9, r8, #2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 7d94: e2898004 add r8, r9, #4 7d98: e0808008 add r8, r0, r8 7d9c: e0809009 add r9, r0, r9 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( 7da0: e10f7000 mrs r7, CPSR 7da4: e387c080 orr ip, r7, #128 ; 0x80 7da8: e129f00c msr CPSR_fc, ip 7dac: e1a0a007 mov sl, r7 7db0: e599c000 ldr ip, [r9] while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 7db4: e15c0008 cmp ip, r8 7db8: 1a000009 bne 7de4 <_Thread_queue_Enqueue_priority+0x88> 7dbc: ea000054 b 7f14 <_Thread_queue_Enqueue_priority+0x1b8> static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( 7dc0: e10f6000 mrs r6, CPSR 7dc4: e129f007 msr CPSR_fc, r7 7dc8: e129f006 msr CPSR_fc, r6 RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); 7dcc: e59c6010 ldr r6, [ip, #16] search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { 7dd0: e1150006 tst r5, r6 7dd4: 0a000036 beq 7eb4 <_Thread_queue_Enqueue_priority+0x158> _ISR_Enable( level ); goto restart_forward_search; } search_thread = (Thread_Control *)search_thread->Object.Node.next; 7dd8: e59cc000 ldr ip, [ip] 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 ) ) { 7ddc: e15c0008 cmp ip, r8 7de0: 0a000002 beq 7df0 <_Thread_queue_Enqueue_priority+0x94> search_priority = search_thread->current_priority; 7de4: e59c4014 ldr r4, [ip, #20] if ( priority <= search_priority ) 7de8: e1530004 cmp r3, r4 7dec: 8afffff3 bhi 7dc0 <_Thread_queue_Enqueue_priority+0x64> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 7df0: e5905030 ldr r5, [r0, #48] ; 0x30 7df4: e3550001 cmp r5, #1 7df8: 0a00002f beq 7ebc <_Thread_queue_Enqueue_priority+0x160> * 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; 7dfc: e582a000 str sl, [r2] return the_thread_queue->sync_state; } 7e00: e1a00005 mov r0, r5 7e04: e8bd0ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp} 7e08: e12fff1e bx lr _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 ]; 7e0c: e0888088 add r8, r8, r8, lsl #1 7e10: e0808108 add r8, r0, r8, lsl #2 7e14: e59f9100 ldr r9, [pc, #256] ; 7f1c <_Thread_queue_Enqueue_priority+0x1c0> restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->last; 7e18: e1a0b008 mov fp, r8 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 7e1c: e5d94000 ldrb r4, [r9] 7e20: e2844001 add r4, r4, #1 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( 7e24: e10f7000 mrs r7, CPSR 7e28: e387c080 orr ip, r7, #128 ; 0x80 7e2c: e129f00c msr CPSR_fc, ip 7e30: e1a0a007 mov sl, r7 _ISR_Disable( level ); search_thread = (Thread_Control *) header->last; 7e34: e59bc008 ldr ip, [fp, #8] while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 7e38: e15c0008 cmp ip, r8 7e3c: 1a000009 bne 7e68 <_Thread_queue_Enqueue_priority+0x10c> 7e40: ea00000b b 7e74 <_Thread_queue_Enqueue_priority+0x118> static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( 7e44: e10f6000 mrs r6, CPSR 7e48: e129f007 msr CPSR_fc, r7 7e4c: e129f006 msr CPSR_fc, r6 7e50: e59c6010 ldr r6, [ip, #16] search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { 7e54: e1150006 tst r5, r6 7e58: 0a000013 beq 7eac <_Thread_queue_Enqueue_priority+0x150> _ISR_Enable( level ); goto restart_reverse_search; } search_thread = (Thread_Control *) search_thread->Object.Node.previous; 7e5c: e59cc004 ldr ip, [ip, #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 ) ) { 7e60: e15c0008 cmp ip, r8 7e64: 0a000002 beq 7e74 <_Thread_queue_Enqueue_priority+0x118> search_priority = search_thread->current_priority; 7e68: e59c4014 ldr r4, [ip, #20] if ( priority >= search_priority ) 7e6c: e1530004 cmp r3, r4 7e70: 3afffff3 bcc 7e44 <_Thread_queue_Enqueue_priority+0xe8> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 7e74: e5905030 ldr r5, [r0, #48] ; 0x30 7e78: e3550001 cmp r5, #1 7e7c: 1affffde bne 7dfc <_Thread_queue_Enqueue_priority+0xa0> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) 7e80: e1530004 cmp r3, r4 if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 7e84: e3a03000 mov r3, #0 7e88: e5803030 str r3, [r0, #48] ; 0x30 if ( priority == search_priority ) 7e8c: 0a000016 beq 7eec <_Thread_queue_Enqueue_priority+0x190> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 7e90: e59c3000 ldr r3, [ip] the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 7e94: e8811008 stm r1, {r3, ip} search_node->next = the_node; next_node->previous = the_node; 7e98: e5831004 str r1, [r3, #4] 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; 7e9c: e58c1000 str r1, [ip] next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 7ea0: e5810044 str r0, [r1, #68] ; 0x44 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( 7ea4: e129f007 msr CPSR_fc, r7 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 7ea8: eaffffd4 b 7e00 <_Thread_queue_Enqueue_priority+0xa4> 7eac: e129f007 msr CPSR_fc, r7 <== NOT EXECUTED 7eb0: eaffffd9 b 7e1c <_Thread_queue_Enqueue_priority+0xc0> <== NOT EXECUTED 7eb4: e129f007 msr CPSR_fc, r7 7eb8: eaffffb8 b 7da0 <_Thread_queue_Enqueue_priority+0x44> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) 7ebc: e1530004 cmp r3, r4 if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 7ec0: e3a03000 mov r3, #0 7ec4: e5803030 str r3, [r0, #48] ; 0x30 if ( priority == search_priority ) 7ec8: 0a000007 beq 7eec <_Thread_queue_Enqueue_priority+0x190> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 7ecc: e59c3004 ldr r3, [ip, #4] the_node = (Chain_Node *) the_thread; the_node->next = search_node; 7ed0: e581c000 str ip, [r1] the_node->previous = previous_node; 7ed4: e5813004 str r3, [r1, #4] previous_node->next = the_node; 7ed8: e5831000 str r1, [r3] search_node->previous = the_node; 7edc: e58c1004 str r1, [ip, #4] the_thread->Wait.queue = the_thread_queue; 7ee0: e5810044 str r0, [r1, #68] ; 0x44 7ee4: e129f007 msr CPSR_fc, r7 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 7ee8: eaffffc4 b 7e00 <_Thread_queue_Enqueue_priority+0xa4> 7eec: e28cc03c add ip, ip, #60 ; 0x3c _ISR_Enable( level ); 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; 7ef0: e59c3004 ldr r3, [ip, #4] the_node = (Chain_Node *) the_thread; the_node->next = search_node; 7ef4: e581c000 str ip, [r1] the_node->previous = previous_node; 7ef8: e5813004 str r3, [r1, #4] previous_node->next = the_node; 7efc: e5831000 str r1, [r3] search_node->previous = the_node; 7f00: e58c1004 str r1, [ip, #4] the_thread->Wait.queue = the_thread_queue; 7f04: e5810044 str r0, [r1, #68] ; 0x44 7f08: e129f00a msr CPSR_fc, sl _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 7f0c: e3a05001 mov r5, #1 7f10: eaffffba b 7e00 <_Thread_queue_Enqueue_priority+0xa4> if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; 7f14: e3e04000 mvn r4, #0 7f18: eaffffb4 b 7df0 <_Thread_queue_Enqueue_priority+0x94> =============================================================================== 0000bc80 <_Thread_queue_Extract_priority_helper>: void _Thread_queue_Extract_priority_helper( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread, bool requeuing ) { bc80: e92d4070 push {r4, r5, r6, lr} bc84: e20220ff and r2, r2, #255 ; 0xff bc88: e1a04001 mov r4, r1 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( bc8c: e10f1000 mrs r1, CPSR bc90: e3813080 orr r3, r1, #128 ; 0x80 bc94: e129f003 msr CPSR_fc, r3 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); bc98: e5943010 ldr r3, [r4, #16] bc9c: e3c334ff bic r3, r3, #-16777216 ; 0xff000000 bca0: e3c3373f bic r3, r3, #16515072 ; 0xfc0000 bca4: e3c33c41 bic r3, r3, #16640 ; 0x4100 bca8: e3c3301f bic r3, r3, #31 Chain_Node *new_second_node; Chain_Node *last_node; the_node = (Chain_Node *) the_thread; _ISR_Disable( level ); if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { bcac: e3530000 cmp r3, #0 bcb0: 0a000023 beq bd44 <_Thread_queue_Extract_priority_helper+0xc4> */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); bcb4: e5943038 ldr r3, [r4, #56] ; 0x38 /* * The thread was actually waiting on a thread queue so let's remove it. */ next_node = the_node->next; bcb8: e594c000 ldr ip, [r4] previous_node = the_node->previous; bcbc: e5945004 ldr r5, [r4, #4] */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; bcc0: e284003c add r0, r4, #60 ; 0x3c if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { bcc4: e1530000 cmp r3, r0 new_first_thread->Wait.Block2n.last = last_node; last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n ); } } else { previous_node->next = next_node; bcc8: 0585c000 streq ip, [r5] next_node->previous = previous_node; bccc: 058c5004 streq r5, [ip, #4] */ next_node = the_node->next; previous_node = the_node->previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { bcd0: 0a00000d beq bd0c <_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; bcd4: e5940040 ldr r0, [r4, #64] ; 0x40 previous_node->next = new_first_node; next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { bcd8: e1500003 cmp r0, r3 if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { 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; bcdc: e5936000 ldr r6, [r3] previous_node->next = new_first_node; next_node->previous = new_first_node; bce0: e58c3004 str r3, [ip, #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; bce4: e5853000 str r3, [r5] next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; bce8: e5835004 str r5, [r3, #4] last_node = the_thread->Wait.Block2n.last; new_second_node = new_first_node->next; previous_node->next = new_first_node; next_node->previous = new_first_node; new_first_node->next = next_node; bcec: e583c000 str ip, [r3] new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { bcf0: 0a000005 beq bd0c <_Thread_queue_Extract_priority_helper+0x8c> /* > two threads on 2-n */ new_second_node->previous = _Chain_Head( &new_first_thread->Wait.Block2n ); bcf4: e2835038 add r5, r3, #56 ; 0x38 bcf8: e283c03c add ip, r3, #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 = bcfc: e5865004 str r5, [r6, #4] _Chain_Head( &new_first_thread->Wait.Block2n ); new_first_thread->Wait.Block2n.first = new_second_node; bd00: e5836038 str r6, [r3, #56] ; 0x38 new_first_thread->Wait.Block2n.last = last_node; bd04: e5830040 str r0, [r3, #64] ; 0x40 last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n ); bd08: e580c000 str ip, [r0] /* * If we are not supposed to touch timers or the thread's state, return. */ if ( requeuing ) { bd0c: e3520000 cmp r2, #0 bd10: 1a000009 bne bd3c <_Thread_queue_Extract_priority_helper+0xbc> _ISR_Enable( level ); return; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { bd14: e5943050 ldr r3, [r4, #80] ; 0x50 bd18: e3530002 cmp r3, #2 bd1c: 0a00000a beq bd4c <_Thread_queue_Extract_priority_helper+0xcc> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( bd20: e129f001 msr CPSR_fc, r1 bd24: e3a01201 mov r1, #268435456 ; 0x10000000 bd28: e2811bff add r1, r1, #261120 ; 0x3fc00 bd2c: e1a00004 mov r0, r4 bd30: e2811ffe add r1, r1, #1016 ; 0x3f8 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } bd34: e8bd4070 pop {r4, r5, r6, lr} bd38: eaffedad b 73f4 <_Thread_Clear_state> bd3c: e129f001 msr CPSR_fc, r1 bd40: e8bd8070 pop {r4, r5, r6, pc} bd44: e129f001 msr CPSR_fc, r1 bd48: e8bd8070 pop {r4, r5, r6, pc} bd4c: e3a03003 mov r3, #3 <== NOT EXECUTED bd50: e5843050 str r3, [r4, #80] ; 0x50 <== NOT EXECUTED bd54: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); bd58: e2840048 add r0, r4, #72 ; 0x48 <== NOT EXECUTED bd5c: ebfff33a bl 8a4c <_Watchdog_Remove> <== NOT EXECUTED bd60: eaffffef b bd24 <_Thread_queue_Extract_priority_helper+0xa4><== NOT EXECUTED =============================================================================== 00015f94 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 15f94: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} 15f98: e24dd024 sub sp, sp, #36 ; 0x24 15f9c: e28d700c add r7, sp, #12 15fa0: e28d2018 add r2, sp, #24 15fa4: e282a004 add sl, r2, #4 15fa8: e2872004 add r2, r7, #4 15fac: e58d2000 str r2, [sp] Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 15fb0: e28d2018 add r2, sp, #24 15fb4: e58d2020 str r2, [sp, #32] */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 15fb8: e59d2000 ldr r2, [sp] 15fbc: e58d200c str r2, [sp, #12] 15fc0: e2802008 add r2, r0, #8 the_chain->permanent_null = NULL; 15fc4: e3a03000 mov r3, #0 15fc8: e58d2004 str r2, [sp, #4] 15fcc: e2802040 add r2, r0, #64 ; 0x40 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 15fd0: e58da018 str sl, [sp, #24] the_chain->permanent_null = NULL; 15fd4: e58d301c str r3, [sp, #28] 15fd8: e58d3010 str r3, [sp, #16] the_chain->last = _Chain_Head(the_chain); 15fdc: e58d7014 str r7, [sp, #20] 15fe0: e59f91a8 ldr r9, [pc, #424] ; 16190 <_Timer_server_Body+0x1fc> 15fe4: e59fb1a8 ldr fp, [pc, #424] ; 16194 <_Timer_server_Body+0x200> 15fe8: e58d2008 str r2, [sp, #8] 15fec: e1a04000 mov r4, r0 15ff0: e2806030 add r6, r0, #48 ; 0x30 15ff4: e2808068 add r8, r0, #104 ; 0x68 { /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 15ff8: e28d3018 add r3, sp, #24 15ffc: e5843078 str r3, [r4, #120] ; 0x78 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 16000: e5993000 ldr r3, [r9] /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 16004: e594103c ldr r1, [r4, #60] ; 0x3c watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 16008: e1a02007 mov r2, r7 1600c: e1a00006 mov r0, r6 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 16010: e584303c str r3, [r4, #60] ; 0x3c _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 16014: e0611003 rsb r1, r1, r3 16018: eb0011ca bl 1a748 <_Watchdog_Adjust_to_chain> static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 1601c: e59b5000 ldr r5, [fp] Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 16020: e5942074 ldr r2, [r4, #116] ; 0x74 /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { 16024: e1550002 cmp r5, r2 16028: 8a000022 bhi 160b8 <_Timer_server_Body+0x124> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { 1602c: 3a000018 bcc 16094 <_Timer_server_Body+0x100> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 16030: e5845074 str r5, [r4, #116] ; 0x74 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 16034: e5940078 ldr r0, [r4, #120] ; 0x78 16038: eb0002d0 bl 16b80 <_Chain_Get> if ( timer == NULL ) { 1603c: e2501000 subs r1, r0, #0 16040: 0a00000b beq 16074 <_Timer_server_Body+0xe0> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 16044: e5913038 ldr r3, [r1, #56] ; 0x38 16048: e3530001 cmp r3, #1 1604c: 0a000015 beq 160a8 <_Timer_server_Body+0x114> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 16050: e3530003 cmp r3, #3 16054: 1afffff6 bne 16034 <_Timer_server_Body+0xa0> _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 16058: e2811010 add r1, r1, #16 1605c: e1a00008 mov r0, r8 16060: eb0011e2 bl 1a7f0 <_Watchdog_Insert> } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 16064: e5940078 ldr r0, [r4, #120] ; 0x78 16068: eb0002c4 bl 16b80 <_Chain_Get> if ( timer == NULL ) { 1606c: e2501000 subs r1, r0, #0 16070: 1afffff3 bne 16044 <_Timer_server_Body+0xb0> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( 16074: e10f2000 mrs r2, CPSR 16078: e3823080 orr r3, r2, #128 ; 0x80 1607c: e129f003 msr CPSR_fc, r3 * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { 16080: e59d3018 ldr r3, [sp, #24] 16084: e15a0003 cmp sl, r3 16088: 0a00000f beq 160cc <_Timer_server_Body+0x138> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( 1608c: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED 16090: eaffffda b 16000 <_Timer_server_Body+0x6c> <== NOT EXECUTED /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); 16094: e1a00008 mov r0, r8 16098: e3a01001 mov r1, #1 1609c: e0652002 rsb r2, r5, r2 160a0: eb001179 bl 1a68c <_Watchdog_Adjust> 160a4: eaffffe1 b 16030 <_Timer_server_Body+0x9c> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 160a8: e1a00006 mov r0, r6 160ac: e2811010 add r1, r1, #16 160b0: eb0011ce bl 1a7f0 <_Watchdog_Insert> 160b4: eaffffde b 16034 <_Timer_server_Body+0xa0> /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 160b8: e0621005 rsb r1, r2, r5 160bc: e1a00008 mov r0, r8 160c0: e1a02007 mov r2, r7 160c4: eb00119f bl 1a748 <_Watchdog_Adjust_to_chain> 160c8: eaffffd8 b 16030 <_Timer_server_Body+0x9c> */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 160cc: e5841078 str r1, [r4, #120] ; 0x78 160d0: e129f002 msr CPSR_fc, r2 _Chain_Initialize_empty( &fire_chain ); while ( true ) { _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain ); if ( !_Chain_Is_empty( &fire_chain ) ) { 160d4: e59d300c ldr r3, [sp, #12] 160d8: e59d2000 ldr r2, [sp] 160dc: e1520003 cmp r2, r3 160e0: 0a000015 beq 1613c <_Timer_server_Body+0x1a8> 160e4: e1a05004 mov r5, r4 160e8: e59d4000 ldr r4, [sp] 160ec: ea000009 b 16118 <_Timer_server_Body+0x184> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 160f0: e5932000 ldr r2, [r3] the_chain->first = new_first; new_first->previous = _Chain_Head(the_chain); 160f4: e5827004 str r7, [r2, #4] Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; the_chain->first = new_first; 160f8: e58d200c str r2, [sp, #12] * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; 160fc: e3a02000 mov r2, #0 16100: e5832008 str r2, [r3, #8] 16104: e129f001 msr CPSR_fc, r1 /* * The timer server may block here and wait for resources or time. * The system watchdogs are inactive and will remain inactive since * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); 16108: e2830020 add r0, r3, #32 1610c: e8900003 ldm r0, {r0, r1} 16110: e1a0e00f mov lr, pc 16114: e593f01c ldr pc, [r3, #28] static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( 16118: e10f1000 mrs r1, CPSR 1611c: e3813080 orr r3, r1, #128 ; 0x80 16120: e129f003 msr CPSR_fc, r3 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 16124: e59d300c ldr r3, [sp, #12] */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 16128: e1540003 cmp r4, r3 1612c: 1affffef bne 160f0 <_Timer_server_Body+0x15c> 16130: e1a04005 mov r4, r5 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( 16134: e129f001 msr CPSR_fc, r1 16138: eaffffae b 15ff8 <_Timer_server_Body+0x64> } } else { ts->active = false; 1613c: e3a03000 mov r3, #0 16140: e5c4307c strb r3, [r4, #124] ; 0x7c 16144: e59f204c ldr r2, [pc, #76] ; 16198 <_Timer_server_Body+0x204> 16148: e5923000 ldr r3, [r2] 1614c: e2833001 add r3, r3, #1 16150: e5823000 str r3, [r2] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 16154: e3a01008 mov r1, #8 16158: e5940000 ldr r0, [r4] 1615c: eb000ee0 bl 19ce4 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 16160: e1a00004 mov r0, r4 16164: ebffff5e bl 15ee4 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); 16168: e1a00004 mov r0, r4 1616c: ebffff72 bl 15f3c <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); 16170: eb000c3a bl 19260 <_Thread_Enable_dispatch> ts->active = true; 16174: e3a03001 mov r3, #1 16178: e5c4307c strb r3, [r4, #124] ; 0x7c static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 1617c: e59d0004 ldr r0, [sp, #4] 16180: eb0011fd bl 1a97c <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 16184: e59d0008 ldr r0, [sp, #8] 16188: eb0011fb bl 1a97c <_Watchdog_Remove> 1618c: eaffff99 b 15ff8 <_Timer_server_Body+0x64> =============================================================================== 00008784 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 8784: e92d40f0 push {r4, r5, r6, r7, lr} Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _User_extensions_List.first ; 8788: e59f5050 ldr r5, [pc, #80] ; 87e0 <_User_extensions_Thread_create+0x5c> 878c: e4954004 ldr r4, [r5], #4 8790: e1540005 cmp r4, r5 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 8794: e1a06000 mov r6, r0 Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _User_extensions_List.first ; 8798: 0a00000e beq 87d8 <_User_extensions_Thread_create+0x54> the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { status = (*the_extension->Callouts.thread_create)( 879c: e59f7040 ldr r7, [pc, #64] ; 87e4 <_User_extensions_Thread_create+0x60> !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { 87a0: e5943014 ldr r3, [r4, #20] 87a4: e3530000 cmp r3, #0 status = (*the_extension->Callouts.thread_create)( 87a8: e1a01006 mov r1, r6 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { 87ac: 0a000004 beq 87c4 <_User_extensions_Thread_create+0x40> status = (*the_extension->Callouts.thread_create)( 87b0: e5970004 ldr r0, [r7, #4] 87b4: e1a0e00f mov lr, pc 87b8: e12fff13 bx r3 _Thread_Executing, the_thread ); if ( !status ) 87bc: e3500000 cmp r0, #0 87c0: 08bd80f0 popeq {r4, r5, r6, r7, pc} User_extensions_Control *the_extension; bool status; for ( the_node = _User_extensions_List.first ; !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 87c4: e5944000 ldr r4, [r4] { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _User_extensions_List.first ; 87c8: e1540005 cmp r4, r5 87cc: 1afffff3 bne 87a0 <_User_extensions_Thread_create+0x1c> if ( !status ) return false; } } return true; 87d0: e3a00001 mov r0, #1 87d4: e8bd80f0 pop {r4, r5, r6, r7, pc} 87d8: e3a00001 mov r0, #1 <== NOT EXECUTED } 87dc: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== 0000a77c <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { a77c: e92d41f0 push {r4, r5, r6, r7, r8, lr} a780: e1a04000 mov r4, r0 a784: e1a05002 mov r5, r2 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a788: e10f3000 mrs r3, CPSR a78c: e3832080 orr r2, r3, #128 ; 0x80 a790: e129f002 msr CPSR_fc, r2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); a794: e1a07000 mov r7, r0 a798: e4972004 ldr r2, [r7], #4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { a79c: e1520007 cmp r2, r7 a7a0: 0a000018 beq a808 <_Watchdog_Adjust+0x8c> switch ( direction ) { a7a4: e3510000 cmp r1, #0 a7a8: 1a000018 bne a810 <_Watchdog_Adjust+0x94> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { a7ac: e3550000 cmp r5, #0 a7b0: 0a000014 beq a808 <_Watchdog_Adjust+0x8c> if ( units < _Watchdog_First( header )->delta_interval ) { a7b4: e5926010 ldr r6, [r2, #16] a7b8: e1550006 cmp r5, r6 _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; a7bc: 23a08001 movcs r8, #1 case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { a7c0: 2a000005 bcs a7dc <_Watchdog_Adjust+0x60> a7c4: ea000018 b a82c <_Watchdog_Adjust+0xb0> <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { a7c8: e0555006 subs r5, r5, r6 a7cc: 0a00000d beq a808 <_Watchdog_Adjust+0x8c> if ( units < _Watchdog_First( header )->delta_interval ) { a7d0: e5926010 ldr r6, [r2, #16] a7d4: e1560005 cmp r6, r5 a7d8: 8a000013 bhi a82c <_Watchdog_Adjust+0xb0> _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; a7dc: e5828010 str r8, [r2, #16] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a7e0: e129f003 msr CPSR_fc, r3 _ISR_Enable( level ); _Watchdog_Tickle( header ); a7e4: e1a00004 mov r0, r4 a7e8: eb0000a0 bl aa70 <_Watchdog_Tickle> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a7ec: e10f3000 mrs r3, CPSR a7f0: e3832080 orr r2, r3, #128 ; 0x80 a7f4: e129f002 msr CPSR_fc, r2 a7f8: e5941000 ldr r1, [r4] _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) a7fc: e1570001 cmp r7, r1 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) header->first ); a800: e1a02001 mov r2, r1 a804: 1affffef bne a7c8 <_Watchdog_Adjust+0x4c> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a808: e129f003 msr CPSR_fc, r3 } } _ISR_Enable( level ); } a80c: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { a810: e3510001 cmp r1, #1 a814: 1afffffb bne a808 <_Watchdog_Adjust+0x8c> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; a818: e5921010 ldr r1, [r2, #16] a81c: e0815005 add r5, r1, r5 a820: e5825010 str r5, [r2, #16] a824: e129f003 msr CPSR_fc, r3 } } _ISR_Enable( level ); } a828: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; a82c: e0655006 rsb r5, r5, r6 a830: e5825010 str r5, [r2, #16] break; a834: eafffff3 b a808 <_Watchdog_Adjust+0x8c> =============================================================================== 00021c7c : int killinfo( pid_t pid, int sig, const union sigval *value ) { 21c7c: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} 21c80: e24dd00c sub sp, sp, #12 21c84: e1a04000 mov r4, r0 21c88: e1a05001 mov r5, r1 21c8c: e1a08002 mov r8, r2 POSIX_signals_Siginfo_node *psiginfo; /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) 21c90: ebffff40 bl 21998 21c94: e1500004 cmp r0, r4 21c98: 1a000093 bne 21eec rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) 21c9c: e3550000 cmp r5, #0 21ca0: 0a000096 beq 21f00 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 21ca4: e2454001 sub r4, r5, #1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 21ca8: e354001f cmp r4, #31 21cac: 8a000093 bhi 21f00 rtems_set_errno_and_return_minus_one( EINVAL ); /* * If the signal is being ignored, then we are out of here. */ if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) 21cb0: e59f6274 ldr r6, [pc, #628] ; 21f2c 21cb4: e1a07085 lsl r7, r5, #1 21cb8: e0873005 add r3, r7, r5 21cbc: e0863103 add r3, r6, r3, lsl #2 21cc0: e5933008 ldr r3, [r3, #8] 21cc4: e3530001 cmp r3, #1 return 0; 21cc8: 03a00000 moveq r0, #0 rtems_set_errno_and_return_minus_one( EINVAL ); /* * If the signal is being ignored, then we are out of here. */ if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) 21ccc: 0a000038 beq 21db4 /* * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) 21cd0: e3550008 cmp r5, #8 21cd4: 13550004 cmpne r5, #4 21cd8: 0a000037 beq 21dbc 21cdc: e355000b cmp r5, #11 21ce0: 0a000035 beq 21dbc static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); 21ce4: e3a03001 mov r3, #1 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; 21ce8: e58d3004 str r3, [sp, #4] /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 21cec: e58d5000 str r5, [sp] siginfo->si_code = SI_USER; if ( !value ) { 21cf0: e3580000 cmp r8, #0 21cf4: e1a04413 lsl r4, r3, r4 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; 21cf8: 15983000 ldrne r3, [r8] 21cfc: 158d3008 strne r3, [sp, #8] 21d00: e59f3228 ldr r3, [pc, #552] ; 21f30 21d04: e5932000 ldr r2, [r3] 21d08: e2822001 add r2, r2, #1 */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; 21d0c: 058d8008 streq r8, [sp, #8] 21d10: e5832000 str r2, [r3] /* * Is the currently executing thread interested? If so then it will * get it an execute it as soon as the dispatcher executes. */ the_thread = _Thread_Executing; 21d14: e59f3218 ldr r3, [pc, #536] ; 21f34 21d18: e5930004 ldr r0, [r3, #4] api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 21d1c: e5903108 ldr r3, [r0, #264] ; 0x108 21d20: e59330cc ldr r3, [r3, #204] ; 0xcc 21d24: e1d43003 bics r3, r4, r3 21d28: 1a000014 bne 21d80 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; 21d2c: e59f1204 ldr r1, [pc, #516] ; 21f38 21d30: e4913004 ldr r3, [r1], #4 21d34: e1530001 cmp r3, r1 21d38: 0a000030 beq 21e00 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 21d3c: e5932030 ldr r2, [r3, #48] ; 0x30 21d40: e1140002 tst r4, r2 for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 21d44: e1a00003 mov r0, r3 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 21d48: e5932108 ldr r2, [r3, #264] ; 0x108 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 21d4c: 0a000008 beq 21d74 21d50: ea00000a b 21d80 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 21d54: e5933000 ldr r3, [r3] /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; 21d58: e1530001 cmp r3, r1 21d5c: 0a000027 beq 21e00 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 21d60: e5932030 ldr r2, [r3, #48] ; 0x30 <== NOT EXECUTED 21d64: e1140002 tst r4, r2 <== NOT EXECUTED for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 21d68: e1a00003 mov r0, r3 <== NOT EXECUTED api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 21d6c: e5932108 ldr r2, [r3, #264] ; 0x108 <== NOT EXECUTED #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 21d70: 1a000002 bne 21d80 <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 21d74: e59220cc ldr r2, [r2, #204] ; 0xcc 21d78: e1d42002 bics r2, r4, r2 21d7c: 0afffff4 beq 21d54 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 21d80: e1a01005 mov r1, r5 21d84: e1a0200d mov r2, sp 21d88: eb00007a bl 21f78 <_POSIX_signals_Unblock_thread> 21d8c: e3500000 cmp r0, #0 21d90: 1a000005 bne 21dac /* * We may have woken up a thread but we definitely need to post the * signal to the process wide information set. */ _POSIX_signals_Set_process_signals( mask ); 21d94: e1a00004 mov r0, r4 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 21d98: e0875005 add r5, r7, r5 /* * We may have woken up a thread but we definitely need to post the * signal to the process wide information set. */ _POSIX_signals_Set_process_signals( mask ); 21d9c: eb00006b bl 21f50 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 21da0: e7963105 ldr r3, [r6, r5, lsl #2] 21da4: e3530002 cmp r3, #2 21da8: 0a000007 beq 21dcc _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 21dac: ebffac14 bl ce04 <_Thread_Enable_dispatch> return 0; 21db0: e3a00000 mov r0, #0 } 21db4: e28dd00c add sp, sp, #12 21db8: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) return pthread_kill( pthread_self(), sig ); 21dbc: eb0000ed bl 22178 21dc0: e1a01005 mov r1, r5 21dc4: eb0000b2 bl 22094 21dc8: eafffff9 b 21db4 _POSIX_signals_Set_process_signals( mask ); if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 21dcc: e59f0168 ldr r0, [pc, #360] ; 21f3c 21dd0: ebffa617 bl b634 <_Chain_Get> if ( !psiginfo ) { 21dd4: e250c000 subs ip, r0, #0 21dd8: 0a00004d beq 21f14 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 21ddc: e1a0300d mov r3, sp 21de0: e8930007 ldm r3, {r0, r1, r2} 21de4: e28c3008 add r3, ip, #8 21de8: e8830007 stm r3, {r0, r1, r2} _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 21dec: e59f014c ldr r0, [pc, #332] ; 21f40 21df0: e1a0100c mov r1, ip 21df4: e0800105 add r0, r0, r5, lsl #2 21df8: ebffa5fa bl b5e8 <_Chain_Append> 21dfc: eaffffea b 21dac * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 21e00: e59f313c ldr r3, [pc, #316] ; 21f44 21e04: e5d3e000 ldrb lr, [r3] 21e08: e59f8138 ldr r8, [pc, #312] ; 21f48 21e0c: e28ee001 add lr, lr, #1 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 21e10: e3a0a000 mov sl, #0 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and an API is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 21e14: e5b83004 ldr r3, [r8, #4]! 21e18: e3530000 cmp r3, #0 21e1c: 0a000020 beq 21ea4 continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 21e20: e5933004 ldr r3, [r3, #4] */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 21e24: e1d3c1b0 ldrh ip, [r3, #16] object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 21e28: e35c0000 cmp ip, #0 if ( !the_info ) continue; #endif maximum = the_info->maximum; object_table = the_info->local_table; 21e2c: e593101c ldr r1, [r3, #28] for ( index = 1 ; index <= maximum ; index++ ) { 21e30: 0a00001b beq 21ea4 21e34: e3a02001 mov r2, #1 the_thread = (Thread_Control *) object_table[ index ]; 21e38: e5b13004 ldr r3, [r1, #4]! if ( !the_thread ) 21e3c: e3530000 cmp r3, #0 21e40: 0a000014 beq 21e98 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 21e44: e5930014 ldr r0, [r3, #20] 21e48: e150000e cmp r0, lr 21e4c: 8a000011 bhi 21e98 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 21e50: e5939108 ldr r9, [r3, #264] ; 0x108 21e54: e59990cc ldr r9, [r9, #204] ; 0xcc 21e58: e1d49009 bics r9, r4, r9 21e5c: 0a00000d beq 21e98 * * NOTE: We initialized interested_priority to PRIORITY_MAXIMUM + 1 * so we never have to worry about deferencing a NULL * interested thread. */ if ( the_thread->current_priority < interested_priority ) { 21e60: e150000e cmp r0, lr 21e64: 3a00001a bcc 21ed4 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( !_States_Is_ready( interested->current_state ) ) { 21e68: e59a9010 ldr r9, [sl, #16] 21e6c: e3590000 cmp r9, #0 21e70: 0a000008 beq 21e98 /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 21e74: e593b010 ldr fp, [r3, #16] 21e78: e35b0000 cmp fp, #0 21e7c: 0a000014 beq 21ed4 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 21e80: e3190201 tst r9, #268435456 ; 0x10000000 21e84: 1a000003 bne 21e98 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 21e88: e20bb201 and fp, fp, #268435456 ; 0x10000000 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 21e8c: e35b0000 cmp fp, #0 21e90: 11a0e000 movne lr, r0 21e94: 11a0a003 movne sl, r3 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 21e98: e2822001 add r2, r2, #1 21e9c: e15c0002 cmp ip, r2 21ea0: 2affffe4 bcs 21e38 * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { 21ea4: e59f30a0 ldr r3, [pc, #160] ; 21f4c 21ea8: e1580003 cmp r8, r3 21eac: 1affffd8 bne 21e14 } } } } if ( interested ) { 21eb0: e35a0000 cmp sl, #0 21eb4: 0affffb6 beq 21d94 21eb8: e1a0000a mov r0, sl /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 21ebc: e1a01005 mov r1, r5 21ec0: e1a0200d mov r2, sp 21ec4: eb00002b bl 21f78 <_POSIX_signals_Unblock_thread> 21ec8: e3500000 cmp r0, #0 21ecc: 0affffb0 beq 21d94 21ed0: eaffffb5 b 21dac <== NOT EXECUTED #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 21ed4: e2822001 add r2, r2, #1 21ed8: e15c0002 cmp ip, r2 */ if ( !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 21edc: e1a0e000 mov lr, r0 21ee0: e1a0a003 mov sl, r3 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 21ee4: 2affffd3 bcs 21e38 21ee8: eaffffed b 21ea4 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); 21eec: ebffc4b5 bl 131c8 <__errno> 21ef0: e3a03003 mov r3, #3 21ef4: e5803000 str r3, [r0] 21ef8: e3e00000 mvn r0, #0 21efc: eaffffac b 21db4 */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); 21f00: ebffc4b0 bl 131c8 <__errno> 21f04: e3a03016 mov r3, #22 21f08: e5803000 str r3, [r0] 21f0c: e3e00000 mvn r0, #0 21f10: eaffffa7 b 21db4 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { _Thread_Enable_dispatch(); 21f14: ebffabba bl ce04 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 21f18: ebffc4aa bl 131c8 <__errno> 21f1c: e3a0300b mov r3, #11 21f20: e5803000 str r3, [r0] 21f24: e3e00000 mvn r0, #0 21f28: eaffffa1 b 21db4 =============================================================================== 00009d78 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) 9d78: e3500000 cmp r0, #0 9d7c: 0a00000e beq 9dbc 9d80: e5903000 ldr r3, [r0] 9d84: e3530000 cmp r3, #0 9d88: 0a00000b beq 9dbc return EINVAL; switch ( policy ) { 9d8c: e3510004 cmp r1, #4 9d90: 9a000001 bls 9d9c case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; 9d94: e3a00086 mov r0, #134 ; 0x86 } } 9d98: e12fff1e bx lr ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { 9d9c: e3a03001 mov r3, #1 9da0: e1a03113 lsl r3, r3, r1 9da4: e3130017 tst r3, #23 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 9da8: 15801014 strne r1, [r0, #20] return 0; 9dac: 13a00000 movne r0, #0 ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { 9db0: 112fff1e bxne lr case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; 9db4: e3a00086 mov r0, #134 ; 0x86 <== NOT EXECUTED } } 9db8: e12fff1e bx lr <== NOT EXECUTED pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) return EINVAL; 9dbc: e3a00016 mov r0, #22 9dc0: e12fff1e bx lr =============================================================================== 000056c8 : 56c8: e59f30f8 ldr r3, [pc, #248] ; 57c8 56cc: e5932000 ldr r2, [r3] 56d0: e2822001 add r2, r2, #1 int pthread_key_create( pthread_key_t *key, void (*destructor)( void * ) ) { 56d4: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} 56d8: e5832000 str r2, [r3] 56dc: e1a08000 mov r8, r0 56e0: e1a04001 mov r4, r1 * the inactive chain of free keys control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Keys_Control *_POSIX_Keys_Allocate( void ) { return (POSIX_Keys_Control *) _Objects_Allocate( &_POSIX_Keys_Information ); 56e4: e59f00e0 ldr r0, [pc, #224] ; 57cc 56e8: eb0008a9 bl 7994 <_Objects_Allocate> _Thread_Disable_dispatch(); the_key = _POSIX_Keys_Allocate(); if ( !the_key ) { 56ec: e2507000 subs r7, r0, #0 56f0: 0a000023 beq 5784 _Thread_Enable_dispatch(); return EAGAIN; } the_key->destructor = destructor; 56f4: e59f60d4 ldr r6, [pc, #212] ; 57d0 56f8: e5874010 str r4, [r7, #16] 56fc: e1a05007 mov r5, r7 * APIs are optional. * * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; 5700: e3a04001 mov r4, #1 the_api <= OBJECTS_APIS_LAST; the_api++ ) { if ( _Objects_Information_table[ the_api ] ) { 5704: e5b63004 ldr r3, [r6, #4]! 5708: e3530000 cmp r3, #0 570c: 0a00001a beq 577c true, INTERNAL_ERROR_IMPLEMENTATION_KEY_CREATE_INCONSISTENCY ); #endif bytes_to_allocate = sizeof( void * ) * (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); 5710: e5933004 ldr r3, [r3, #4] 5714: e1d3a1b0 ldrh sl, [r3, #16] 5718: e28aa001 add sl, sl, #1 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_IMPLEMENTATION_KEY_CREATE_INCONSISTENCY ); #endif bytes_to_allocate = sizeof( void * ) * 571c: e1a0a10a lsl sl, sl, #2 (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); 5720: e1a0000a mov r0, sl 5724: eb001150 bl 9c6c <_Workspace_Allocate> if ( !table ) { 5728: e2503000 subs r3, r0, #0 572c: 0a000017 beq 5790 _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); return ENOMEM; } the_key->Values[ the_api ] = table; 5730: e5853018 str r3, [r5, #24] memset( table, '\0', bytes_to_allocate ); 5734: e3a01000 mov r1, #0 5738: e1a0200a mov r2, sl 573c: eb0026dc bl f2b4 * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) { 5740: e2844001 add r4, r4, #1 * APIs are optional. * * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; 5744: e3540004 cmp r4, #4 the_api <= OBJECTS_APIS_LAST; the_api++ ) { 5748: e2855004 add r5, r5, #4 * APIs are optional. * * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; 574c: 1affffec bne 5704 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 5750: e59f2074 ldr r2, [pc, #116] ; 57cc uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 5754: e5973008 ldr r3, [r7, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 5758: e592201c ldr r2, [r2, #28] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 575c: e3a04000 mov r4, #0 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 5760: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 5764: e7827721 str r7, [r2, r1, lsr #14] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 5768: e587400c str r4, [r7, #12] } _Objects_Open_u32( &_POSIX_Keys_Information, &the_key->Object, 0 ); *key = the_key->Object.id; 576c: e5883000 str r3, [r8] _Thread_Enable_dispatch(); 5770: eb000be2 bl 8700 <_Thread_Enable_dispatch> return 0; 5774: e1a00004 mov r0, r4 } 5778: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} } the_key->Values[ the_api ] = table; memset( table, '\0', bytes_to_allocate ); } else { the_key->Values[ the_api ] = NULL; 577c: e5853018 str r3, [r5, #24] <== NOT EXECUTED 5780: eaffffee b 5740 <== NOT EXECUTED _Thread_Disable_dispatch(); the_key = _POSIX_Keys_Allocate(); if ( !the_key ) { _Thread_Enable_dispatch(); 5784: eb000bdd bl 8700 <_Thread_Enable_dispatch> return EAGAIN; 5788: e3a0000b mov r0, #11 578c: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} #endif bytes_to_allocate = sizeof( void * ) * (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); if ( !table ) { for ( --the_api; 5790: e2545001 subs r5, r4, #1 5794: 0a000005 beq 57b0 int _EXFUN(pthread_once, (pthread_once_t *__once_control, void (*__init_routine)(void))); /* Thread-Specific Data Key Create, P1003.1c/Draft 10, p. 163 */ int _EXFUN(pthread_key_create, 5798: e2844005 add r4, r4, #5 579c: e0874104 add r4, r7, r4, lsl #2 the_api >= 1; the_api-- ) _Workspace_Free( the_key->Values[ the_api ] ); 57a0: e5340004 ldr r0, [r4, #-4]! 57a4: eb001136 bl 9c84 <_Workspace_Free> #endif bytes_to_allocate = sizeof( void * ) * (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); if ( !table ) { for ( --the_api; 57a8: e2555001 subs r5, r5, #1 57ac: 1afffffb bne 57a0 */ RTEMS_INLINE_ROUTINE void _POSIX_Keys_Free ( POSIX_Keys_Control *the_key ) { _Objects_Free( &_POSIX_Keys_Information, &the_key->Object ); 57b0: e59f0014 ldr r0, [pc, #20] ; 57cc 57b4: e1a01007 mov r1, r7 57b8: eb000950 bl 7d00 <_Objects_Free> the_api >= 1; the_api-- ) _Workspace_Free( the_key->Values[ the_api ] ); _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); 57bc: eb000bcf bl 8700 <_Thread_Enable_dispatch> return ENOMEM; 57c0: e3a0000c mov r0, #12 57c4: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} =============================================================================== 0000777c : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) 777c: e3500000 cmp r0, #0 7780: 0a000008 beq 77a8 7784: e5903000 ldr r3, [r0] 7788: e3530000 cmp r3, #0 778c: 0a000005 beq 77a8 return EINVAL; switch ( pshared ) { 7790: e3510001 cmp r1, #1 case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 7794: 95801004 strls r1, [r0, #4] return 0; 7798: 93a00000 movls r0, #0 ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( pshared ) { 779c: 912fff1e bxls lr case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; return 0; default: return EINVAL; 77a0: e3a00016 mov r0, #22 <== NOT EXECUTED } } 77a4: e12fff1e bx lr <== NOT EXECUTED pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) return EINVAL; 77a8: e3a00016 mov r0, #22 77ac: e12fff1e bx lr =============================================================================== 00007314 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) 7314: e3500000 cmp r0, #0 7318: 0a000008 beq 7340 return EINVAL; if ( !attr->is_initialized ) 731c: e5903000 ldr r3, [r0] 7320: e3530000 cmp r3, #0 7324: 0a000005 beq 7340 return EINVAL; switch ( pshared ) { 7328: e3510001 cmp r1, #1 case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 732c: 95801004 strls r1, [r0, #4] return 0; 7330: 93a00000 movls r0, #0 return EINVAL; if ( !attr->is_initialized ) return EINVAL; switch ( pshared ) { 7334: 912fff1e bxls lr case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; return 0; default: return EINVAL; 7338: e3a00016 mov r0, #22 <== NOT EXECUTED } } 733c: e12fff1e bx lr <== NOT EXECUTED { if ( !attr ) return EINVAL; if ( !attr->is_initialized ) return EINVAL; 7340: e3a00016 mov r0, #22 7344: e12fff1e bx lr =============================================================================== 00007004 : rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) 7004: e59f3150 ldr r3, [pc, #336] ; 715c 7008: e593c000 ldr ip, [r3] rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; 700c: e59f314c ldr r3, [pc, #332] ; 7160 if ( rtems_interrupt_is_in_progress() ) 7010: e35c0000 cmp ip, #0 rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { 7014: e92d4030 push {r4, r5, lr} 7018: e1a04000 mov r4, r0 rtems_device_major_number major_limit = _IO_Number_of_drivers; 701c: e5930000 ldr r0, [r3] if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; 7020: 13a00012 movne r0, #18 rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) 7024: 18bd8030 popne {r4, r5, pc} return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 7028: e3520000 cmp r2, #0 702c: 0a00003f beq 7130 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) 7030: e3510000 cmp r1, #0 if ( registered_major == NULL ) return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; 7034: e5820000 str r0, [r2] if ( driver_table == NULL ) 7038: 0a00003c beq 7130 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 703c: e591c000 ldr ip, [r1] 7040: e35c0000 cmp ip, #0 7044: 0a000036 beq 7124 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 7048: e1500004 cmp r0, r4 704c: 9a000027 bls 70f0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 7050: e59f010c ldr r0, [pc, #268] ; 7164 7054: e590c000 ldr ip, [r0] 7058: e28cc001 add ip, ip, #1 705c: e580c000 str ip, [r0] return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 7060: e3540000 cmp r4, #0 7064: 1a000023 bne 70f8 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 7068: e593c000 ldr ip, [r3] rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 706c: e35c0000 cmp ip, #0 7070: 0a000030 beq 7138 7074: e59fe0ec ldr lr, [pc, #236] ; 7168 7078: e59e3000 ldr r3, [lr] 707c: ea000003 b 7090 7080: e2844001 add r4, r4, #1 7084: e15c0004 cmp ip, r4 7088: e2833018 add r3, r3, #24 708c: 9a000005 bls 70a8 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 7090: e5930000 ldr r0, [r3] 7094: e3500000 cmp r0, #0 7098: 1afffff8 bne 7080 709c: e5930004 ldr r0, [r3, #4] 70a0: e3500000 cmp r0, #0 70a4: 1afffff5 bne 7080 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) 70a8: e15c0004 cmp ip, r4 70ac: 1084c084 addne ip, r4, r4, lsl #1 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 70b0: e5824000 str r4, [r2] if ( m != n ) 70b4: 11a0c18c lslne ip, ip, #3 70b8: 0a00001f beq 713c } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 70bc: e59e5000 ldr r5, [lr] 70c0: e1a0e001 mov lr, r1 70c4: e8be000f ldm lr!, {r0, r1, r2, r3} 70c8: e085c00c add ip, r5, ip 70cc: e8ac000f stmia ip!, {r0, r1, r2, r3} 70d0: e89e0003 ldm lr, {r0, r1} 70d4: e88c0003 stm ip, {r0, r1} _Thread_Enable_dispatch(); 70d8: eb0006a3 bl 8b6c <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); 70dc: e3a01000 mov r1, #0 70e0: e1a00004 mov r0, r4 70e4: e1a02001 mov r2, r1 } 70e8: e8bd4030 pop {r4, r5, lr} _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 70ec: ea002114 b f544 if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) return RTEMS_INVALID_NUMBER; 70f0: e3a0000a mov r0, #10 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 70f4: e8bd8030 pop {r4, r5, pc} _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 70f8: e59fe068 ldr lr, [pc, #104] ; 7168 70fc: e59e3000 ldr r3, [lr] 7100: e084c084 add ip, r4, r4, lsl #1 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 7104: e793018c ldr r0, [r3, ip, lsl #3] _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 7108: e1a0c18c lsl ip, ip, #3 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 710c: e3500000 cmp r0, #0 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 7110: e083300c add r3, r3, ip static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 7114: 0a00000b beq 7148 major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); 7118: eb000693 bl 8b6c <_Thread_Enable_dispatch> return RTEMS_RESOURCE_IN_USE; 711c: e3a0000c mov r0, #12 7120: e8bd8030 pop {r4, r5, pc} static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 7124: e591c004 ldr ip, [r1, #4] 7128: e35c0000 cmp ip, #0 712c: 1affffc5 bne 7048 if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; 7130: e3a00009 mov r0, #9 7134: e8bd8030 pop {r4, r5, pc} if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 7138: e5824000 str r4, [r2] <== NOT EXECUTED if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 713c: eb00068a bl 8b6c <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; 7140: e3a00005 mov r0, #5 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); return sc; 7144: e8bd8030 pop {r4, r5, pc} static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 7148: e5933004 ldr r3, [r3, #4] 714c: e3530000 cmp r3, #0 7150: 1afffff0 bne 7118 if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; 7154: e5824000 str r4, [r2] 7158: eaffffd7 b 70bc =============================================================================== 0000595c : ) { const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) 595c: e3500001 cmp r0, #1 const char *rtems_object_get_api_class_name( int the_api, int the_class ) { 5960: e52de004 push {lr} ; (str lr, [sp, #-4]!) const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) 5964: 0a00000d beq 59a0 api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) 5968: e3500002 cmp r0, #2 596c: 0a000004 beq 5984 api_assoc = rtems_object_api_classic_assoc; #ifdef RTEMS_POSIX_API else if ( the_api == OBJECTS_POSIX_API ) 5970: e3500003 cmp r0, #3 api_assoc = rtems_object_api_posix_assoc; 5974: 059f003c ldreq r0, [pc, #60] ; 59b8 if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) api_assoc = rtems_object_api_classic_assoc; #ifdef RTEMS_POSIX_API else if ( the_api == OBJECTS_POSIX_API ) 5978: 0a000002 beq 5988 api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; 597c: e59f0038 ldr r0, [pc, #56] ; 59bc 5980: e49df004 pop {pc} ; (ldr pc, [sp], #4) const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) api_assoc = rtems_object_api_classic_assoc; 5984: e59f0034 ldr r0, [pc, #52] ; 59c0 else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); 5988: eb001342 bl a698 if ( class_assoc ) 598c: e3500000 cmp r0, #0 return class_assoc->name; 5990: 15900000 ldrne r0, [r0] api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); if ( class_assoc ) 5994: 149df004 popne {pc} ; (ldrne pc, [sp], #4) return class_assoc->name; return "BAD CLASS"; 5998: e59f0024 ldr r0, [pc, #36] ; 59c4 } 599c: e49df004 pop {pc} ; (ldr pc, [sp], #4) { const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; 59a0: e59f0020 ldr r0, [pc, #32] ; 59c8 else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); 59a4: eb00133b bl a698 if ( class_assoc ) 59a8: e3500000 cmp r0, #0 return class_assoc->name; 59ac: 15900000 ldrne r0, [r0] api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); if ( class_assoc ) 59b0: 149df004 popne {pc} ; (ldrne pc, [sp], #4) 59b4: eafffff7 b 5998 <== NOT EXECUTED =============================================================================== 0000874c : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { 874c: e92d4010 push {r4, lr} 8750: e24dd004 sub sp, sp, #4 8754: e1a04000 mov r4, r0 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 8758: e1a00001 mov r0, r1 875c: e1a0100d mov r1, sp 8760: eb001636 bl e040 <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 8764: e3500003 cmp r0, #3 8768: 0a000005 beq 8784 do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 876c: e1a00004 mov r0, r4 <== NOT EXECUTED 8770: e3a01000 mov r1, #0 <== NOT EXECUTED 8774: e59d2000 ldr r2, [sp] <== NOT EXECUTED 8778: eb00194a bl eca8 <_POSIX_Semaphore_Wait_support> <== NOT EXECUTED break; } } return lock_status; } 877c: e28dd004 add sp, sp, #4 8780: e8bd8010 pop {r4, pc} */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 8784: e1a00004 mov r0, r4 8788: e3a01001 mov r1, #1 878c: e59d2000 ldr r2, [sp] 8790: eb001944 bl eca8 <_POSIX_Semaphore_Wait_support> 8794: eafffff8 b 877c =============================================================================== 00005f94 : struct sigaction *oact ) { ISR_Level level; if ( oact ) 5f94: e2523000 subs r3, r2, #0 *oact = _POSIX_signals_Vectors[ sig ]; 5f98: 159f20c4 ldrne r2, [pc, #196] ; 6064 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 5f9c: e92d4070 push {r4, r5, r6, lr} 5fa0: e1a05001 mov r5, r1 ISR_Level level; if ( oact ) *oact = _POSIX_signals_Vectors[ sig ]; 5fa4: 10801080 addne r1, r0, r0, lsl #1 5fa8: 10822101 addne r2, r2, r1, lsl #2 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 5fac: e1a04000 mov r4, r0 ISR_Level level; if ( oact ) *oact = _POSIX_signals_Vectors[ sig ]; 5fb0: 18920007 ldmne r2, {r0, r1, r2} 5fb4: 18830007 stmne r3, {r0, r1, r2} if ( !sig ) 5fb8: e3540000 cmp r4, #0 5fbc: 0a000023 beq 6050 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 5fc0: e2443001 sub r3, r4, #1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 5fc4: e353001f cmp r3, #31 5fc8: 8a000020 bhi 6050 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 5fcc: e3540009 cmp r4, #9 5fd0: 0a00001e beq 6050 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 5fd4: e3550000 cmp r5, #0 5fd8: 0a00001a beq 6048 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( 5fdc: e10f6000 mrs r6, CPSR 5fe0: e3863080 orr r3, r6, #128 ; 0x80 5fe4: e129f003 msr CPSR_fc, r3 * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { 5fe8: e5953008 ldr r3, [r5, #8] 5fec: e3530000 cmp r3, #0 5ff0: 0a000009 beq 601c _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); 5ff4: e1a00004 mov r0, r4 5ff8: eb00170a bl bc28 <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; 5ffc: e59f3060 ldr r3, [pc, #96] ; 6064 6000: e8950007 ldm r5, {r0, r1, r2} 6004: e0844084 add r4, r4, r4, lsl #1 6008: e0834104 add r4, r3, r4, lsl #2 600c: e8840007 stm r4, {r0, r1, r2} static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( 6010: e129f006 msr CPSR_fc, r6 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 6014: e3a00000 mov r0, #0 6018: e8bd8070 pop {r4, r5, r6, pc} * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 601c: e0844084 add r4, r4, r4, lsl #1 6020: e59f3040 ldr r3, [pc, #64] ; 6068 6024: e1a04104 lsl r4, r4, #2 6028: e0833004 add r3, r3, r4 602c: e8930007 ldm r3, {r0, r1, r2} 6030: e59f302c ldr r3, [pc, #44] ; 6064 6034: e0834004 add r4, r3, r4 6038: e8840007 stm r4, {r0, r1, r2} 603c: e129f006 msr CPSR_fc, r6 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 6040: e3a00000 mov r0, #0 6044: e8bd8070 pop {r4, r5, r6, pc} 6048: e1a00005 mov r0, r5 <== NOT EXECUTED } 604c: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); 6050: eb00234b bl ed84 <__errno> 6054: e3a03016 mov r3, #22 6058: e5803000 str r3, [r0] 605c: e3e00000 mvn r0, #0 6060: e8bd8070 pop {r4, r5, r6, pc} =============================================================================== 0000851c : int sigwait( const sigset_t *set, int *sig ) { 851c: e92d4010 push {r4, lr} 8520: e1a04001 mov r4, r1 int status; status = sigtimedwait( set, NULL, NULL ); 8524: e3a01000 mov r1, #0 8528: e1a02001 mov r2, r1 852c: ebffff8a bl 835c if ( status != -1 ) { 8530: e3700001 cmn r0, #1 8534: 0a000005 beq 8550 if ( sig ) 8538: e3540000 cmp r4, #0 *sig = status; 853c: 15840000 strne r0, [r4] return 0; 8540: 13a00000 movne r0, #0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) 8544: 18bd8010 popne {r4, pc} *sig = status; return 0; 8548: e1a00004 mov r0, r4 <== NOT EXECUTED } return errno; } 854c: e8bd8010 pop {r4, pc} <== NOT EXECUTED if ( sig ) *sig = status; return 0; } return errno; 8550: eb0022aa bl 11000 <__errno> 8554: e5900000 ldr r0, [r0] 8558: e8bd8010 pop {r4, pc}