=============================================================================== a000ff88 : uint32_t TOD_MICROSECONDS_TO_TICKS( uint32_t microseconds ) { return (microseconds / rtems_configuration_get_microseconds_per_tick()); a000ff88: e59f300c ldr r3, [pc, #12] ; a000ff9c <== NOT EXECUTED #include uint32_t TOD_MICROSECONDS_TO_TICKS( uint32_t microseconds ) { a000ff8c: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED return (microseconds / rtems_configuration_get_microseconds_per_tick()); a000ff90: e593100c ldr r1, [r3, #12] <== NOT EXECUTED a000ff94: eb004e8f bl a00239d8 <__aeabi_uidiv> <== NOT EXECUTED } a000ff98: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a001043c : #include #include uint32_t TOD_TICKS_PER_SECOND_method(void) { return (TOD_MICROSECONDS_PER_SECOND / a001043c: e59f3014 ldr r3, [pc, #20] ; a0010458 <== NOT EXECUTED a0010440: e3a0093d mov r0, #999424 ; 0xf4000 <== NOT EXECUTED #include #include #include uint32_t TOD_TICKS_PER_SECOND_method(void) { a0010444: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED return (TOD_MICROSECONDS_PER_SECOND / a0010448: e593100c ldr r1, [r3, #12] <== NOT EXECUTED a001044c: e2800d09 add r0, r0, #576 ; 0x240 <== NOT EXECUTED a0010450: eb00328f bl a001ce94 <__aeabi_uidiv> <== NOT EXECUTED rtems_configuration_get_microseconds_per_tick()); } a0010454: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a001af8c <_CORE_message_queue_Broadcast>: { Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { a001af8c: 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 ) { a001af90: 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 ) { a001af94: 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 ) { a001af98: e1a07000 mov r7, r0 a001af9c: e1a05002 mov r5, r2 a001afa0: e1a08001 mov r8, r1 a001afa4: 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 ) { a001afa8: 3a000013 bcc a001affc <_CORE_message_queue_Broadcast+0x70> * 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 ) { a001afac: e5906048 ldr r6, [r0, #72] ; 0x48 a001afb0: e3560000 cmp r6, #0 a001afb4: 0a000009 beq a001afe0 <_CORE_message_queue_Broadcast+0x54> *count = 0; a001afb8: e3a00000 mov r0, #0 a001afbc: e58a0000 str r0, [sl] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; a001afc0: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} const void *source, void *destination, size_t size ) { memcpy(destination, source, size); a001afc4: e594002c ldr r0, [r4, #44] ; 0x2c a001afc8: e1a01008 mov r1, r8 a001afcc: e1a02005 mov r2, r5 a001afd0: eb00206e bl a0023190 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; a001afd4: e5943028 ldr r3, [r4, #40] ; 0x28 */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; a001afd8: e2866001 add r6, r6, #1 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; a001afdc: 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 = a001afe0: e1a00007 mov r0, r7 a001afe4: eb000ac9 bl a001db10 <_Thread_queue_Dequeue> a001afe8: e2504000 subs r4, r0, #0 a001afec: 1afffff4 bne a001afc4 <_CORE_message_queue_Broadcast+0x38> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; a001aff0: e58a6000 str r6, [sl] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; a001aff4: e1a00004 mov r0, r4 a001aff8: 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; a001affc: e3a00001 mov r0, #1 <== NOT EXECUTED #endif } *count = number_broadcasted; return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } a001b000: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED =============================================================================== a0013410 <_CORE_message_queue_Submit>: ) { CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { a0013410: e590304c ldr r3, [r0, #76] ; 0x4c #endif CORE_message_queue_Submit_types submit_type, bool wait, Watchdog_Interval timeout ) { a0013414: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { a0013418: e1530002 cmp r3, r2 #endif CORE_message_queue_Submit_types submit_type, bool wait, Watchdog_Interval timeout ) { a001341c: e1a04000 mov r4, r0 a0013420: e1a05002 mov r5, r2 a0013424: e1a0a001 mov sl, r1 a0013428: e59d7020 ldr r7, [sp, #32] CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { a001342c: 3a000015 bcc a0013488 <_CORE_message_queue_Submit+0x78> } /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { a0013430: e5906048 ldr r6, [r0, #72] ; 0x48 a0013434: e3560000 cmp r6, #0 a0013438: 0a000014 beq a0013490 <_CORE_message_queue_Submit+0x80> /* * No one waiting on the message queue at this time, so attempt to * queue the message up for a future receive. */ if ( the_message_queue->number_of_pending_messages < a001343c: e5943044 ldr r3, [r4, #68] ; 0x44 a0013440: e1530006 cmp r3, r6 a0013444: 8a000001 bhi a0013450 <_CORE_message_queue_Submit+0x40> ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } #if !defined(RTEMS_SCORE_COREMSG_ENABLE_BLOCKING_SEND) return CORE_MESSAGE_QUEUE_STATUS_TOO_MANY; a0013448: e3a00002 mov r0, #2 <== NOT EXECUTED _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } a001344c: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED _CORE_message_queue_Allocate_message_buffer ( CORE_message_queue_Control *the_message_queue ) { return (CORE_message_queue_Buffer_control *) _Chain_Get( &the_message_queue->Inactive_messages ); a0013450: e2840060 add r0, r4, #96 ; 0x60 a0013454: ebffff6d bl a0013210 <_Chain_Get> const void *source, void *destination, size_t size ) { memcpy(destination, source, size); a0013458: e1a0100a mov r1, sl _CORE_message_queue_Allocate_message_buffer ( CORE_message_queue_Control *the_message_queue ) { return (CORE_message_queue_Buffer_control *) _Chain_Get( &the_message_queue->Inactive_messages ); a001345c: e1a06000 mov r6, r0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); a0013460: e1a02005 mov r2, r5 a0013464: e280000c add r0, r0, #12 a0013468: eb001dba bl a001ab58 size ); the_message->Contents.size = size; _CORE_message_queue_Set_message_priority( the_message, submit_type ); _CORE_message_queue_Insert_message( a001346c: e1a00004 mov r0, r4 _CORE_message_queue_Copy_buffer( buffer, the_message->Contents.buffer, size ); the_message->Contents.size = size; a0013470: e5865008 str r5, [r6, #8] _CORE_message_queue_Set_message_priority( the_message, submit_type ); _CORE_message_queue_Insert_message( a0013474: e1a01006 mov r1, r6 a0013478: e1a02007 mov r2, r7 a001347c: eb00133a bl a001816c <_CORE_message_queue_Insert_message> the_message_queue, the_message, submit_type ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; a0013480: e3a00000 mov r0, #0 a0013484: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} { CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE; a0013488: e3a00001 mov r0, #1 <== NOT EXECUTED a001348c: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); a0013490: eb000782 bl a00152a0 <_Thread_queue_Dequeue> if ( the_thread ) { a0013494: e2508000 subs r8, r0, #0 a0013498: 05946048 ldreq r6, [r4, #72] ; 0x48 a001349c: 0affffe6 beq a001343c <_CORE_message_queue_Submit+0x2c> a00134a0: e598002c ldr r0, [r8, #44] ; 0x2c a00134a4: e1a0100a mov r1, sl a00134a8: e1a02005 mov r2, r5 a00134ac: eb001da9 bl a001ab58 _CORE_message_queue_Copy_buffer( buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; a00134b0: e5983028 ldr r3, [r8, #40] ; 0x28 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; a00134b4: e1a00006 mov r0, r6 _CORE_message_queue_Copy_buffer( buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; a00134b8: e5835000 str r5, [r3] the_thread->Wait.count = (uint32_t) submit_type; a00134bc: e5887024 str r7, [r8, #36] ; 0x24 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; a00134c0: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} =============================================================================== a000a4b8 <_CORE_mutex_Initialize>: CORE_mutex_Status _CORE_mutex_Initialize( CORE_mutex_Control *the_mutex, CORE_mutex_Attributes *the_mutex_attributes, uint32_t initial_lock ) { a000a4b8: e92d40f0 push {r4, r5, r6, r7, lr} initial_lock == CORE_MUTEX_UNLOCKED ); */ the_mutex->Attributes = *the_mutex_attributes; the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; a000a4bc: e3a05000 mov r5, #0 CORE_mutex_Status _CORE_mutex_Initialize( CORE_mutex_Control *the_mutex, CORE_mutex_Attributes *the_mutex_attributes, uint32_t initial_lock ) { a000a4c0: e1a0c000 mov ip, r0 the_mutex->Attributes = *the_mutex_attributes; the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { a000a4c4: e1520005 cmp r2, r5 CORE_mutex_Status _CORE_mutex_Initialize( CORE_mutex_Control *the_mutex, CORE_mutex_Attributes *the_mutex_attributes, uint32_t initial_lock ) { a000a4c8: e1a06002 mov r6, r2 /* Add this to the RTEMS environment later ????????? rtems_assert( initial_lock == CORE_MUTEX_LOCKED || initial_lock == CORE_MUTEX_UNLOCKED ); */ the_mutex->Attributes = *the_mutex_attributes; a000a4cc: e2807040 add r7, r0, #64 ; 0x40 CORE_mutex_Status _CORE_mutex_Initialize( CORE_mutex_Control *the_mutex, CORE_mutex_Attributes *the_mutex_attributes, uint32_t initial_lock ) { a000a4d0: e1a04001 mov r4, r1 /* Add this to the RTEMS environment later ????????? rtems_assert( initial_lock == CORE_MUTEX_LOCKED || initial_lock == CORE_MUTEX_UNLOCKED ); */ the_mutex->Attributes = *the_mutex_attributes; a000a4d4: e891000f ldm r1, {r0, r1, r2, r3} the_mutex->lock = initial_lock; a000a4d8: e58c6050 str r6, [ip, #80] ; 0x50 /* Add this to the RTEMS environment later ????????? rtems_assert( initial_lock == CORE_MUTEX_LOCKED || initial_lock == CORE_MUTEX_UNLOCKED ); */ the_mutex->Attributes = *the_mutex_attributes; a000a4dc: e887000f stm r7, {r0, r1, r2, r3} the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; a000a4e0: e58c5058 str r5, [ip, #88] ; 0x58 #endif _Thread_Executing->resource_count++; } } else { the_mutex->nest_count = 0; a000a4e4: 158c5054 strne r5, [ip, #84] ; 0x54 the_mutex->holder = NULL; a000a4e8: 158c505c strne r5, [ip, #92] ; 0x5c the_mutex->holder_id = 0; a000a4ec: 158c5060 strne r5, [ip, #96] ; 0x60 the_mutex->Attributes = *the_mutex_attributes; the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { a000a4f0: 1a00000b bne a000a524 <_CORE_mutex_Initialize+0x6c> the_mutex->nest_count = 1; the_mutex->holder = _Thread_Executing; a000a4f4: e59f3074 ldr r3, [pc, #116] ; a000a570 <_CORE_mutex_Initialize+0xb8> the_mutex->Attributes = *the_mutex_attributes; the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { the_mutex->nest_count = 1; a000a4f8: e3a01001 mov r1, #1 STATES_WAITING_FOR_MUTEX, CORE_MUTEX_TIMEOUT ); return CORE_MUTEX_STATUS_SUCCESSFUL; } a000a4fc: e59c2048 ldr r2, [ip, #72] ; 0x48 the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { the_mutex->nest_count = 1; the_mutex->holder = _Thread_Executing; a000a500: e5933004 ldr r3, [r3, #4] the_mutex->Attributes = *the_mutex_attributes; the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { the_mutex->nest_count = 1; a000a504: e58c1054 str r1, [ip, #84] ; 0x54 the_mutex->holder = _Thread_Executing; the_mutex->holder_id = _Thread_Executing->Object.id; if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || a000a508: e3520002 cmp r2, #2 the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { the_mutex->nest_count = 1; the_mutex->holder = _Thread_Executing; the_mutex->holder_id = _Thread_Executing->Object.id; a000a50c: e5931008 ldr r1, [r3, #8] the_mutex->lock = initial_lock; the_mutex->blocked_count = 0; if ( initial_lock == CORE_MUTEX_LOCKED ) { the_mutex->nest_count = 1; the_mutex->holder = _Thread_Executing; a000a510: e58c305c str r3, [ip, #92] ; 0x5c the_mutex->holder_id = _Thread_Executing->Object.id; a000a514: e58c1060 str r1, [ip, #96] ; 0x60 if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || a000a518: 0a00000a beq a000a548 <_CORE_mutex_Initialize+0x90> a000a51c: e3520003 cmp r2, #3 a000a520: 0a000008 beq a000a548 <_CORE_mutex_Initialize+0x90> the_mutex->nest_count = 0; the_mutex->holder = NULL; the_mutex->holder_id = 0; } _Thread_queue_Initialize( a000a524: e5941008 ldr r1, [r4, #8] a000a528: e1a0000c mov r0, ip a000a52c: e3a02b01 mov r2, #1024 ; 0x400 a000a530: e2511000 subs r1, r1, #0 a000a534: 13a01001 movne r1, #1 a000a538: e3a03005 mov r3, #5 a000a53c: eb000837 bl a000c620 <_Thread_queue_Initialize> THREAD_QUEUE_DISCIPLINE_FIFO : THREAD_QUEUE_DISCIPLINE_PRIORITY, STATES_WAITING_FOR_MUTEX, CORE_MUTEX_TIMEOUT ); return CORE_MUTEX_STATUS_SUCCESSFUL; a000a540: e3a00000 mov r0, #0 a000a544: e8bd80f0 pop {r4, r5, r6, r7, pc} the_mutex->holder = _Thread_Executing; the_mutex->holder_id = _Thread_Executing->Object.id; if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || _CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) { if ( _Thread_Executing->current_priority < a000a548: e5931014 ldr r1, [r3, #20] a000a54c: e59c204c ldr r2, [ip, #76] ; 0x4c a000a550: e1510002 cmp r1, r2 a000a554: 3a000003 bcc a000a568 <_CORE_mutex_Initialize+0xb0> _Chain_Prepend_unprotected( &_Thread_Executing->lock_mutex, &the_mutex->queue.lock_queue ); the_mutex->queue.priority_before = _Thread_Executing->current_priority; #endif _Thread_Executing->resource_count++; a000a558: e593201c ldr r2, [r3, #28] <== NOT EXECUTED a000a55c: e2822001 add r2, r2, #1 <== NOT EXECUTED a000a560: e583201c str r2, [r3, #28] <== NOT EXECUTED a000a564: eaffffee b a000a524 <_CORE_mutex_Initialize+0x6c> <== NOT EXECUTED if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || _CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) { if ( _Thread_Executing->current_priority < the_mutex->Attributes.priority_ceiling ) return CORE_MUTEX_STATUS_CEILING_VIOLATED; a000a568: e3a00006 mov r0, #6 STATES_WAITING_FOR_MUTEX, CORE_MUTEX_TIMEOUT ); return CORE_MUTEX_STATUS_SUCCESSFUL; } a000a56c: e8bd80f0 pop {r4, r5, r6, r7, pc} =============================================================================== a000f0b0 <_CORE_mutex_Seize_interrupt_trylock>: { Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; a000f0b0: e59f2160 ldr r2, [pc, #352] ; a000f218 <_CORE_mutex_Seize_interrupt_trylock+0x168> executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL; if ( !_CORE_mutex_Is_locked( the_mutex ) ) { a000f0b4: e590c050 ldr ip, [r0, #80] ; 0x50 #if defined(__RTEMS_DO_NOT_INLINE_CORE_MUTEX_SEIZE__) int _CORE_mutex_Seize_interrupt_trylock( CORE_mutex_Control *the_mutex, ISR_Level *level_p ) { a000f0b8: e1a03000 mov r3, r0 { Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; a000f0bc: e5922004 ldr r2, [r2, #4] executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL; a000f0c0: e3a00000 mov r0, #0 if ( !_CORE_mutex_Is_locked( the_mutex ) ) { a000f0c4: e15c0000 cmp ip, r0 a000f0c8: e92d40f0 push {r4, r5, r6, r7, lr} Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL; a000f0cc: e5820034 str r0, [r2, #52] ; 0x34 if ( !_CORE_mutex_Is_locked( the_mutex ) ) { a000f0d0: 0a00000e beq a000f110 <_CORE_mutex_Seize_interrupt_trylock+0x60> return _CORE_mutex_Seize_interrupt_trylock_body( the_mutex, level_p ); } a000f0d4: e593c048 ldr ip, [r3, #72] ; 0x48 the_mutex->lock = CORE_MUTEX_LOCKED; the_mutex->holder = executing; the_mutex->holder_id = executing->Object.id; a000f0d8: e5925008 ldr r5, [r2, #8] the_mutex->nest_count = 1; a000f0dc: e3a04001 mov r4, #1 if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || a000f0e0: e35c0002 cmp ip, #2 /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL; if ( !_CORE_mutex_Is_locked( the_mutex ) ) { the_mutex->lock = CORE_MUTEX_LOCKED; a000f0e4: e5830050 str r0, [r3, #80] ; 0x50 the_mutex->holder = executing; a000f0e8: e583205c str r2, [r3, #92] ; 0x5c the_mutex->holder_id = executing->Object.id; a000f0ec: e5835060 str r5, [r3, #96] ; 0x60 the_mutex->nest_count = 1; a000f0f0: e5834054 str r4, [r3, #84] ; 0x54 if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || a000f0f4: 0a00000a beq a000f124 <_CORE_mutex_Seize_interrupt_trylock+0x74> a000f0f8: e35c0003 cmp ip, #3 a000f0fc: 0a000019 beq a000f168 <_CORE_mutex_Seize_interrupt_trylock+0xb8> a000f100: e5913000 ldr r3, [r1] a000f104: e129f003 msr CPSR_fc, r3 executing->resource_count++; } if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) { _ISR_Enable( *level_p ); return 0; a000f108: e3a00000 mov r0, #0 a000f10c: e8bd80f0 pop {r4, r5, r6, r7, pc} /* * At this point, we know the mutex was not available. If this thread * is the thread that has locked the mutex, let's see if we are allowed * to nest access. */ if ( _Thread_Is_executing( the_mutex->holder ) ) { a000f110: e593005c ldr r0, [r3, #92] ; 0x5c a000f114: e1520000 cmp r2, r0 a000f118: 0a000008 beq a000f140 <_CORE_mutex_Seize_interrupt_trylock+0x90> /* * The mutex is not available and the caller must deal with the possibility * of blocking. */ return 1; a000f11c: e3a00001 mov r0, #1 a000f120: e8bd80f0 pop {r4, r5, r6, r7, pc} _Chain_Prepend_unprotected( &executing->lock_mutex, &the_mutex->queue.lock_queue ); the_mutex->queue.priority_before = executing->current_priority; #endif executing->resource_count++; a000f124: e592301c ldr r3, [r2, #28] a000f128: e2833001 add r3, r3, #1 a000f12c: e582301c str r3, [r2, #28] a000f130: e5913000 ldr r3, [r1] a000f134: e129f003 msr CPSR_fc, r3 } if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) { _ISR_Enable( *level_p ); return 0; a000f138: e3a00000 mov r0, #0 a000f13c: e8bd80f0 pop {r4, r5, r6, r7, pc} * At this point, we know the mutex was not available. If this thread * is the thread that has locked the mutex, let's see if we are allowed * to nest access. */ if ( _Thread_Is_executing( the_mutex->holder ) ) { switch ( the_mutex->Attributes.lock_nesting_behavior ) { a000f140: e5930040 ldr r0, [r3, #64] ; 0x40 a000f144: e3500000 cmp r0, #0 a000f148: 1a000017 bne a000f1ac <_CORE_mutex_Seize_interrupt_trylock+0xfc> case CORE_MUTEX_NESTING_ACQUIRES: the_mutex->nest_count++; a000f14c: e5932054 ldr r2, [r3, #84] ; 0x54 a000f150: e2822001 add r2, r2, #1 a000f154: e5832054 str r2, [r3, #84] ; 0x54 a000f158: e5913000 ldr r3, [r1] a000f15c: e129f003 msr CPSR_fc, r3 _ISR_Enable( *level_p ); return 0; a000f160: e3a00000 mov r0, #0 a000f164: e8bd80f0 pop {r4, r5, r6, r7, pc} _Chain_Prepend_unprotected( &executing->lock_mutex, &the_mutex->queue.lock_queue ); the_mutex->queue.priority_before = executing->current_priority; #endif executing->resource_count++; a000f168: e592c01c ldr ip, [r2, #28] */ { Priority_Control ceiling; Priority_Control current; ceiling = the_mutex->Attributes.priority_ceiling; a000f16c: e593604c ldr r6, [r3, #76] ; 0x4c current = executing->current_priority; a000f170: e5925014 ldr r5, [r2, #20] _Chain_Prepend_unprotected( &executing->lock_mutex, &the_mutex->queue.lock_queue ); the_mutex->queue.priority_before = executing->current_priority; #endif executing->resource_count++; a000f174: e08c7004 add r7, ip, r4 a000f178: e582701c str r7, [r2, #28] Priority_Control ceiling; Priority_Control current; ceiling = the_mutex->Attributes.priority_ceiling; current = executing->current_priority; if ( current == ceiling ) { a000f17c: e1560005 cmp r6, r5 a000f180: 0a000020 beq a000f208 <_CORE_mutex_Seize_interrupt_trylock+0x158> _ISR_Enable( *level_p ); return 0; } if ( current > ceiling ) { a000f184: 3a000012 bcc a000f1d4 <_CORE_mutex_Seize_interrupt_trylock+0x124> ); _Thread_Enable_dispatch(); return 0; } /* if ( current < ceiling ) */ { executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED; a000f188: e3a05006 mov r5, #6 a000f18c: e5825034 str r5, [r2, #52] ; 0x34 the_mutex->lock = CORE_MUTEX_UNLOCKED; a000f190: e5834050 str r4, [r3, #80] ; 0x50 the_mutex->nest_count = 0; /* undo locking above */ a000f194: e5830054 str r0, [r3, #84] ; 0x54 executing->resource_count--; /* undo locking above */ a000f198: e582c01c str ip, [r2, #28] a000f19c: e5913000 ldr r3, [r1] a000f1a0: e129f003 msr CPSR_fc, r3 _ISR_Enable( *level_p ); return 0; a000f1a4: e3a00000 mov r0, #0 a000f1a8: e8bd80f0 pop {r4, r5, r6, r7, pc} * At this point, we know the mutex was not available. If this thread * is the thread that has locked the mutex, let's see if we are allowed * to nest access. */ if ( _Thread_Is_executing( the_mutex->holder ) ) { switch ( the_mutex->Attributes.lock_nesting_behavior ) { a000f1ac: e3500001 cmp r0, #1 a000f1b0: 0a000001 beq a000f1bc <_CORE_mutex_Seize_interrupt_trylock+0x10c> /* * The mutex is not available and the caller must deal with the possibility * of blocking. */ return 1; a000f1b4: e3a00001 mov r0, #1 a000f1b8: e8bd80f0 pop {r4, r5, r6, r7, pc} case CORE_MUTEX_NESTING_ACQUIRES: the_mutex->nest_count++; _ISR_Enable( *level_p ); return 0; case CORE_MUTEX_NESTING_IS_ERROR: executing->Wait.return_code = CORE_MUTEX_STATUS_NESTING_NOT_ALLOWED; a000f1bc: e3a03002 mov r3, #2 <== NOT EXECUTED a000f1c0: e5823034 str r3, [r2, #52] ; 0x34 <== NOT EXECUTED a000f1c4: e5913000 ldr r3, [r1] <== NOT EXECUTED a000f1c8: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED _ISR_Enable( *level_p ); return 0; a000f1cc: e3a00000 mov r0, #0 <== NOT EXECUTED a000f1d0: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000f1d4: e59f2040 ldr r2, [pc, #64] ; a000f21c <_CORE_mutex_Seize_interrupt_trylock+0x16c> a000f1d8: e5920000 ldr r0, [r2] a000f1dc: e2800001 add r0, r0, #1 a000f1e0: e5820000 str r0, [r2] a000f1e4: e5912000 ldr r2, [r1] a000f1e8: e129f002 msr CPSR_fc, r2 } if ( current > ceiling ) { _Thread_Disable_dispatch(); _ISR_Enable( *level_p ); _Thread_Change_priority( a000f1ec: e3a02000 mov r2, #0 a000f1f0: e593005c ldr r0, [r3, #92] ; 0x5c a000f1f4: e593104c ldr r1, [r3, #76] ; 0x4c a000f1f8: ebfff1f3 bl a000b9cc <_Thread_Change_priority> the_mutex->holder, the_mutex->Attributes.priority_ceiling, false ); _Thread_Enable_dispatch(); a000f1fc: ebfff332 bl a000becc <_Thread_Enable_dispatch> return 0; a000f200: e3a00000 mov r0, #0 a000f204: e8bd80f0 pop {r4, r5, r6, r7, pc} a000f208: e5913000 ldr r3, [r1] a000f20c: e129f003 msr CPSR_fc, r3 ceiling = the_mutex->Attributes.priority_ceiling; current = executing->current_priority; if ( current == ceiling ) { _ISR_Enable( *level_p ); return 0; a000f210: e3a00000 mov r0, #0 a000f214: e8bd80f0 pop {r4, r5, r6, r7, pc} =============================================================================== a000a6ac <_CORE_mutex_Surrender>: * allowed when the mutex in quetion is FIFO or simple Priority * discipline. But Priority Ceiling or Priority Inheritance mutexes * must be released by the thread which acquired them. */ if ( the_mutex->Attributes.only_owner_release ) { a000a6ac: e5d03044 ldrb r3, [r0, #68] ; 0x44 #else Objects_Id id __attribute__((unused)), CORE_mutex_API_mp_support_callout api_mutex_mp_support __attribute__((unused)) #endif ) { a000a6b0: e92d4030 push {r4, r5, lr} * allowed when the mutex in quetion is FIFO or simple Priority * discipline. But Priority Ceiling or Priority Inheritance mutexes * must be released by the thread which acquired them. */ if ( the_mutex->Attributes.only_owner_release ) { a000a6b4: e3530000 cmp r3, #0 #else Objects_Id id __attribute__((unused)), CORE_mutex_API_mp_support_callout api_mutex_mp_support __attribute__((unused)) #endif ) { a000a6b8: e1a04000 mov r4, r0 Thread_Control *the_thread; Thread_Control *holder; holder = the_mutex->holder; a000a6bc: e590205c ldr r2, [r0, #92] ; 0x5c * allowed when the mutex in quetion is FIFO or simple Priority * discipline. But Priority Ceiling or Priority Inheritance mutexes * must be released by the thread which acquired them. */ if ( the_mutex->Attributes.only_owner_release ) { a000a6c0: 0a000005 beq a000a6dc <_CORE_mutex_Surrender+0x30> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); a000a6c4: e59f3120 ldr r3, [pc, #288] ; a000a7ec <_CORE_mutex_Surrender+0x140> if ( !_Thread_Is_executing( holder ) ) a000a6c8: e5933004 ldr r3, [r3, #4] a000a6cc: e1520003 cmp r2, r3 a000a6d0: 0a000001 beq a000a6dc <_CORE_mutex_Surrender+0x30> return CORE_MUTEX_STATUS_NOT_OWNER_OF_RESOURCE; a000a6d4: e3a00003 mov r0, #3 a000a6d8: e8bd8030 pop {r4, r5, pc} } /* XXX already unlocked -- not right status */ if ( !the_mutex->nest_count ) a000a6dc: e5940054 ldr r0, [r4, #84] ; 0x54 a000a6e0: e3500000 cmp r0, #0 a000a6e4: 0a000023 beq a000a778 <_CORE_mutex_Surrender+0xcc> return CORE_MUTEX_STATUS_SUCCESSFUL; the_mutex->nest_count--; a000a6e8: e2400001 sub r0, r0, #1 if ( the_mutex->nest_count != 0 ) { a000a6ec: e3500000 cmp r0, #0 /* XXX already unlocked -- not right status */ if ( !the_mutex->nest_count ) return CORE_MUTEX_STATUS_SUCCESSFUL; the_mutex->nest_count--; a000a6f0: e5840054 str r0, [r4, #84] ; 0x54 if ( the_mutex->nest_count != 0 ) { a000a6f4: 1a000020 bne a000a77c <_CORE_mutex_Surrender+0xd0> } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; } a000a6f8: e5943048 ldr r3, [r4, #72] ; 0x48 /* * Formally release the mutex before possibly transferring it to a * blocked thread. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || a000a6fc: e3530002 cmp r3, #2 a000a700: 0a00001f beq a000a784 <_CORE_mutex_Surrender+0xd8> a000a704: e3530003 cmp r3, #3 a000a708: 0a00001d beq a000a784 <_CORE_mutex_Surrender+0xd8> if ( holder->resource_count == 0 && holder->real_priority != holder->current_priority ) { _Thread_Change_priority( holder, holder->real_priority, true ); } } the_mutex->holder = NULL; a000a70c: e3a05000 mov r5, #0 a000a710: e584505c str r5, [r4, #92] ; 0x5c the_mutex->holder_id = 0; a000a714: e5845060 str r5, [r4, #96] ; 0x60 /* * Now we check if another thread was waiting for this mutex. If so, * transfer the mutex to that thread. */ if ( ( the_thread = _Thread_queue_Dequeue( &the_mutex->Wait_queue ) ) ) { a000a718: e1a00004 mov r0, r4 a000a71c: eb0006b3 bl a000c1f0 <_Thread_queue_Dequeue> a000a720: e2503000 subs r3, r0, #0 a000a724: 0a00002c beq a000a7dc <_CORE_mutex_Surrender+0x130> } else #endif { the_mutex->holder = the_thread; the_mutex->holder_id = the_thread->Object.id; a000a728: e5931008 ldr r1, [r3, #8] the_mutex->nest_count = 1; switch ( the_mutex->Attributes.discipline ) { a000a72c: e5942048 ldr r2, [r4, #72] ; 0x48 } else #endif { the_mutex->holder = the_thread; a000a730: e584305c str r3, [r4, #92] ; 0x5c the_mutex->holder_id = the_thread->Object.id; a000a734: e5841060 str r1, [r4, #96] ; 0x60 the_mutex->nest_count = 1; switch ( the_mutex->Attributes.discipline ) { a000a738: e3520002 cmp r2, #2 #endif { the_mutex->holder = the_thread; the_mutex->holder_id = the_thread->Object.id; the_mutex->nest_count = 1; a000a73c: e3a01001 mov r1, #1 a000a740: e5841054 str r1, [r4, #84] ; 0x54 switch ( the_mutex->Attributes.discipline ) { a000a744: 0a00001b beq a000a7b8 <_CORE_mutex_Surrender+0x10c> a000a748: e3520003 cmp r2, #3 <== NOT EXECUTED a000a74c: 0a000001 beq a000a758 <_CORE_mutex_Surrender+0xac> <== NOT EXECUTED } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; a000a750: e1a00005 mov r0, r5 <== NOT EXECUTED a000a754: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; break; case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; a000a758: e593c01c ldr ip, [r3, #28] <== NOT EXECUTED if (the_mutex->Attributes.priority_ceiling < a000a75c: e594104c ldr r1, [r4, #76] ; 0x4c <== NOT EXECUTED a000a760: e5932014 ldr r2, [r3, #20] <== NOT EXECUTED _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; break; case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; a000a764: e28cc001 add ip, ip, #1 <== NOT EXECUTED a000a768: e583c01c str ip, [r3, #28] <== NOT EXECUTED if (the_mutex->Attributes.priority_ceiling < a000a76c: e1510002 cmp r1, r2 <== NOT EXECUTED } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; a000a770: 21a00005 movcs r0, r5 <== NOT EXECUTED the_thread->resource_count++; break; case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; if (the_mutex->Attributes.priority_ceiling < a000a774: 3a000014 bcc a000a7cc <_CORE_mutex_Surrender+0x120> <== NOT EXECUTED } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; } a000a778: e8bd8030 pop {r4, r5, pc} /* Currently no API exercises this behavior. */ break; } #else /* must be CORE_MUTEX_NESTING_ACQUIRES or we wouldn't be here */ return CORE_MUTEX_STATUS_SUCCESSFUL; a000a77c: e3a00000 mov r0, #0 a000a780: e8bd8030 pop {r4, r5, pc} _CORE_mutex_Pop_priority( the_mutex, holder ); if ( pop_status != CORE_MUTEX_STATUS_SUCCESSFUL ) return pop_status; holder->resource_count--; a000a784: e592301c ldr r3, [r2, #28] a000a788: e2433001 sub r3, r3, #1 /* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( holder->resource_count == 0 && a000a78c: e3530000 cmp r3, #0 _CORE_mutex_Pop_priority( the_mutex, holder ); if ( pop_status != CORE_MUTEX_STATUS_SUCCESSFUL ) return pop_status; holder->resource_count--; a000a790: e582301c str r3, [r2, #28] /* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( holder->resource_count == 0 && a000a794: 1affffdc bne a000a70c <_CORE_mutex_Surrender+0x60> holder->real_priority != holder->current_priority ) { a000a798: e5921018 ldr r1, [r2, #24] /* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( holder->resource_count == 0 && a000a79c: e5923014 ldr r3, [r2, #20] a000a7a0: e1510003 cmp r1, r3 a000a7a4: 0affffd8 beq a000a70c <_CORE_mutex_Surrender+0x60> holder->real_priority != holder->current_priority ) { _Thread_Change_priority( holder, holder->real_priority, true ); a000a7a8: e1a00002 mov r0, r2 a000a7ac: e3a02001 mov r2, #1 a000a7b0: eb000485 bl a000b9cc <_Thread_Change_priority> a000a7b4: eaffffd4 b a000a70c <_CORE_mutex_Surrender+0x60> case CORE_MUTEX_DISCIPLINES_FIFO: case CORE_MUTEX_DISCIPLINES_PRIORITY: break; case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; a000a7b8: e593201c ldr r2, [r3, #28] } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; a000a7bc: e1a00005 mov r0, r5 case CORE_MUTEX_DISCIPLINES_FIFO: case CORE_MUTEX_DISCIPLINES_PRIORITY: break; case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; a000a7c0: e2822001 add r2, r2, #1 a000a7c4: e583201c str r2, [r3, #28] break; a000a7c8: e8bd8030 pop {r4, r5, pc} case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING: _CORE_mutex_Push_priority( the_mutex, the_thread ); the_thread->resource_count++; if (the_mutex->Attributes.priority_ceiling < the_thread->current_priority){ _Thread_Change_priority( a000a7cc: e1a02005 mov r2, r5 <== NOT EXECUTED a000a7d0: eb00047d bl a000b9cc <_Thread_Change_priority> <== NOT EXECUTED } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; return CORE_MUTEX_STATUS_SUCCESSFUL; a000a7d4: e1a00005 mov r0, r5 <== NOT EXECUTED a000a7d8: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED } break; } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; a000a7dc: e3a02001 mov r2, #1 a000a7e0: e5842050 str r2, [r4, #80] ; 0x50 return CORE_MUTEX_STATUS_SUCCESSFUL; a000a7e4: e1a00003 mov r0, r3 a000a7e8: e8bd8030 pop {r4, r5, pc} =============================================================================== a000adc0 <_Chain_Get_with_empty_check>: bool _Chain_Get_with_empty_check( Chain_Control *chain, Chain_Node **node ) { a000adc0: e52d4004 push {r4} ; (str r4, [sp, #-4]!) <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000adc4: e10f4000 mrs r4, CPSR <== NOT EXECUTED a000adc8: e3843080 orr r3, r4, #128 ; 0x80 <== NOT EXECUTED a000adcc: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED ) { bool is_empty_now = true; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_first = head->next; a000add0: e5903000 ldr r3, [r0] <== NOT EXECUTED Chain_Node **the_node ) { bool is_empty_now = true; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); a000add4: e280c004 add ip, r0, #4 <== NOT EXECUTED Chain_Node *old_first = head->next; if ( old_first != tail ) { a000add8: e15c0003 cmp ip, r3 <== NOT EXECUTED *the_node = old_first; is_empty_now = new_first == tail; } else *the_node = NULL; a000addc: 03a03000 moveq r3, #0 <== NOT EXECUTED a000ade0: 05813000 streq r3, [r1] <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool _Chain_Get_with_empty_check_unprotected( Chain_Control *the_chain, Chain_Node **the_node ) { bool is_empty_now = true; a000ade4: 03a00001 moveq r0, #1 <== NOT EXECUTED Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_first = head->next; if ( old_first != tail ) { a000ade8: 0a000006 beq a000ae08 <_Chain_Get_with_empty_check+0x48> <== NOT EXECUTED Chain_Node *new_first = old_first->next; a000adec: e5932000 ldr r2, [r3] <== NOT EXECUTED head->next = new_first; a000adf0: e5802000 str r2, [r0] <== NOT EXECUTED new_first->previous = head; a000adf4: e5820004 str r0, [r2, #4] <== NOT EXECUTED *the_node = old_first; is_empty_now = new_first == tail; a000adf8: e15c0002 cmp ip, r2 <== NOT EXECUTED a000adfc: 13a00000 movne r0, #0 <== NOT EXECUTED a000ae00: 03a00001 moveq r0, #1 <== NOT EXECUTED Chain_Node *new_first = old_first->next; head->next = new_first; new_first->previous = head; *the_node = old_first; a000ae04: e5813000 str r3, [r1] <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000ae08: e129f004 msr CPSR_fc, r4 <== NOT EXECUTED _ISR_Disable( level ); is_empty_now = _Chain_Get_with_empty_check_unprotected( chain, node ); _ISR_Enable( level ); return is_empty_now; } a000ae0c: e8bd0010 pop {r4} <== NOT EXECUTED a000ae10: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a0009518 <_Event_Seize>: rtems_event_set pending_events; ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; a0009518: e59fc0fc ldr ip, [pc, #252] ; a000961c <_Event_Seize+0x104> rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { a000951c: e92d40f0 push {r4, r5, r6, r7, lr} rtems_event_set pending_events; ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; a0009520: e59c4004 ldr r4, [ip, #4] executing->Wait.return_code = RTEMS_SUCCESSFUL; a0009524: e3a0c000 mov ip, #0 a0009528: e584c034 str ip, [r4, #52] ; 0x34 api = executing->API_Extensions[ THREAD_API_RTEMS ]; a000952c: e594c0f4 ldr ip, [r4, #244] ; 0xf4 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a0009530: e10f7000 mrs r7, CPSR a0009534: e3875080 orr r5, r7, #128 ; 0x80 a0009538: e129f005 msr CPSR_fc, r5 _ISR_Disable( level ); pending_events = api->pending_events; a000953c: e59c5000 ldr r5, [ip] seized_events = _Event_sets_Get( pending_events, event_in ); if ( !_Event_sets_Is_empty( seized_events ) && a0009540: e0106005 ands r6, r0, r5 a0009544: 0a000003 beq a0009558 <_Event_Seize+0x40> a0009548: e1500006 cmp r0, r6 a000954c: 0a00001f beq a00095d0 <_Event_Seize+0xb8> (seized_events == event_in || _Options_Is_any( option_set )) ) { a0009550: e3110002 tst r1, #2 <== NOT EXECUTED a0009554: 1a00001d bne a00095d0 <_Event_Seize+0xb8> <== NOT EXECUTED _ISR_Enable( level ); *event_out = seized_events; return; } if ( _Options_Is_no_wait( option_set ) ) { a0009558: e3110001 tst r1, #1 a000955c: 1a000016 bne a00095bc <_Event_Seize+0xa4> */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in; executing->Wait.return_argument = event_out; _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a0009560: e59f50b8 ldr r5, [pc, #184] ; a0009620 <_Event_Seize+0x108> * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in; executing->Wait.return_argument = event_out; a0009564: e5843028 str r3, [r4, #40] ; 0x28 _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a0009568: e3a03001 mov r3, #1 * set properly when we are marked as in the event critical section. * * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; a000956c: e5841030 str r1, [r4, #48] ; 0x30 executing->Wait.count = (uint32_t) event_in; a0009570: e5840024 str r0, [r4, #36] ; 0x24 executing->Wait.return_argument = event_out; _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a0009574: e5853000 str r3, [r5] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0009578: e129f007 msr CPSR_fc, r7 _ISR_Enable( level ); if ( ticks ) { a000957c: e3520000 cmp r2, #0 a0009580: 1a000019 bne a00095ec <_Event_Seize+0xd4> NULL ); _Watchdog_Insert_ticks( &executing->Timer, ticks ); } _Thread_Set_state( executing, STATES_WAITING_FOR_EVENT ); a0009584: e1a00004 mov r0, r4 a0009588: e3a01c01 mov r1, #256 ; 0x100 a000958c: eb000c74 bl a000c764 <_Thread_Set_state> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a0009590: e10f2000 mrs r2, CPSR a0009594: e3823080 orr r3, r2, #128 ; 0x80 a0009598: e129f003 msr CPSR_fc, r3 _ISR_Disable( level ); sync_state = _Event_Sync_state; a000959c: e5950000 ldr r0, [r5] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; a00095a0: e3a03000 mov r3, #0 a00095a4: e5853000 str r3, [r5] if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) { a00095a8: e3500001 cmp r0, #1 a00095ac: 0a00000c beq a00095e4 <_Event_Seize+0xcc> * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); a00095b0: e1a01004 mov r1, r4 <== NOT EXECUTED } a00095b4: e8bd40f0 pop {r4, r5, r6, r7, lr} <== NOT EXECUTED * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); a00095b8: ea0008ed b a000b974 <_Thread_blocking_operation_Cancel> <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a00095bc: e129f007 msr CPSR_fc, r7 return; } if ( _Options_Is_no_wait( option_set ) ) { _ISR_Enable( level ); executing->Wait.return_code = RTEMS_UNSATISFIED; a00095c0: e3a0200d mov r2, #13 a00095c4: e5842034 str r2, [r4, #52] ; 0x34 *event_out = seized_events; a00095c8: e5836000 str r6, [r3] return; a00095cc: e8bd80f0 pop {r4, r5, r6, r7, pc} RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); a00095d0: e1c55006 bic r5, r5, r6 pending_events = api->pending_events; seized_events = _Event_sets_Get( pending_events, event_in ); if ( !_Event_sets_Is_empty( seized_events ) && (seized_events == event_in || _Options_Is_any( option_set )) ) { api->pending_events = a00095d4: e58c5000 str r5, [ip] a00095d8: e129f007 msr CPSR_fc, r7 _Event_sets_Clear( pending_events, seized_events ); _ISR_Enable( level ); *event_out = seized_events; a00095dc: e5836000 str r6, [r3] return; a00095e0: e8bd80f0 pop {r4, r5, r6, r7, pc} a00095e4: e129f002 msr CPSR_fc, r2 a00095e8: e8bd80f0 pop {r4, r5, r6, r7, pc} _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; _ISR_Enable( level ); if ( ticks ) { _Watchdog_Initialize( a00095ec: e5941008 ldr r1, [r4, #8] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a00095f0: e59f002c ldr r0, [pc, #44] ; a0009624 <_Event_Seize+0x10c> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a00095f4: e3a03000 mov r3, #0 the_watchdog->routine = routine; the_watchdog->id = id; a00095f8: e5841068 str r1, [r4, #104] ; 0x68 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a00095fc: e5840064 str r0, [r4, #100] ; 0x64 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a0009600: e5843050 str r3, [r4, #80] ; 0x50 the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; a0009604: e584306c str r3, [r4, #108] ; 0x6c Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a0009608: e5842054 str r2, [r4, #84] ; 0x54 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000960c: e59f0014 ldr r0, [pc, #20] ; a0009628 <_Event_Seize+0x110> a0009610: e2841048 add r1, r4, #72 ; 0x48 a0009614: eb000dce bl a000cd54 <_Watchdog_Insert> a0009618: eaffffd9 b a0009584 <_Event_Seize+0x6c> =============================================================================== a0009684 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { a0009684: e92d40f0 push {r4, r5, r6, r7, lr} rtems_event_set event_condition; rtems_event_set seized_events; rtems_option option_set; RTEMS_API_Control *api; api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; a0009688: e59010f4 ldr r1, [r0, #244] ; 0xf4 option_set = (rtems_option) the_thread->Wait.option; a000968c: e5906030 ldr r6, [r0, #48] ; 0x30 */ void _Event_Surrender( Thread_Control *the_thread ) { a0009690: e1a04000 mov r4, r0 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a0009694: e10f0000 mrs r0, CPSR a0009698: e3803080 orr r3, r0, #128 ; 0x80 a000969c: e129f003 msr CPSR_fc, r3 api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); pending_events = api->pending_events; a00096a0: e5912000 ldr r2, [r1] event_condition = (rtems_event_set) the_thread->Wait.count; a00096a4: e5943024 ldr r3, [r4, #36] ; 0x24 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { a00096a8: e013c002 ands ip, r3, r2 a00096ac: 0a000020 beq a0009734 <_Event_Surrender+0xb0> /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && a00096b0: e59f50fc ldr r5, [pc, #252] ; a00097b4 <_Event_Surrender+0x130> a00096b4: e5957000 ldr r7, [r5] a00096b8: e3570000 cmp r7, #0 a00096bc: 0a000002 beq a00096cc <_Event_Surrender+0x48> a00096c0: e5955004 ldr r5, [r5, #4] <== NOT EXECUTED a00096c4: e1540005 cmp r4, r5 <== NOT EXECUTED a00096c8: 0a000024 beq a0009760 <_Event_Surrender+0xdc> <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); a00096cc: e5945010 ldr r5, [r4, #16] } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { a00096d0: e3150c01 tst r5, #256 ; 0x100 a00096d4: 0a000014 beq a000972c <_Event_Surrender+0xa8> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { a00096d8: e153000c cmp r3, ip a00096dc: 0a000001 beq a00096e8 <_Event_Surrender+0x64> a00096e0: e3160002 tst r6, #2 <== NOT EXECUTED a00096e4: 0a000010 beq a000972c <_Event_Surrender+0xa8> <== NOT EXECUTED api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; a00096e8: e5943028 ldr r3, [r4, #40] ; 0x28 RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); a00096ec: e1c2200c bic r2, r2, ip /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); a00096f0: e5812000 str r2, [r1] the_thread->Wait.count = 0; a00096f4: e3a02000 mov r2, #0 a00096f8: e5842024 str r2, [r4, #36] ; 0x24 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; a00096fc: e583c000 str ip, [r3] static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a0009700: e10f3000 mrs r3, CPSR a0009704: e129f000 msr CPSR_fc, r0 a0009708: e129f003 msr CPSR_fc, r3 _ISR_Flash( level ); if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000970c: e5943050 ldr r3, [r4, #80] ; 0x50 a0009710: e3530002 cmp r3, #2 a0009714: 0a000008 beq a000973c <_Event_Surrender+0xb8> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0009718: e129f000 msr CPSR_fc, r0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a000971c: e59f1094 ldr r1, [pc, #148] ; a00097b8 <_Event_Surrender+0x134> a0009720: e1a00004 mov r0, r4 } return; } } _ISR_Enable( level ); } a0009724: e8bd40f0 pop {r4, r5, r6, r7, lr} a0009728: ea000905 b a000bb44 <_Thread_Clear_state> a000972c: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED a0009730: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED a0009734: e129f000 msr CPSR_fc, r0 a0009738: e8bd80f0 pop {r4, r5, r6, r7, pc} RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; a000973c: e3a03003 mov r3, #3 a0009740: e5843050 str r3, [r4, #80] ; 0x50 a0009744: e129f000 msr CPSR_fc, r0 _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); a0009748: e2840048 add r0, r4, #72 ; 0x48 a000974c: eb000def bl a000cf10 <_Watchdog_Remove> a0009750: e59f1060 ldr r1, [pc, #96] ; a00097b8 <_Event_Surrender+0x134> a0009754: e1a00004 mov r0, r4 } return; } } _ISR_Enable( level ); } a0009758: e8bd40f0 pop {r4, r5, r6, r7, lr} a000975c: ea0008f8 b a000bb44 <_Thread_Clear_state> * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || a0009760: e59f5054 ldr r5, [pc, #84] ; a00097bc <_Event_Surrender+0x138><== NOT EXECUTED a0009764: e5957000 ldr r7, [r5] <== NOT EXECUTED /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && a0009768: e3570002 cmp r7, #2 <== NOT EXECUTED a000976c: 0a000002 beq a000977c <_Event_Surrender+0xf8> <== NOT EXECUTED ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { a0009770: e5957000 ldr r7, [r5] <== NOT EXECUTED * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || a0009774: e3570001 cmp r7, #1 <== NOT EXECUTED a0009778: 1affffd3 bne a00096cc <_Event_Surrender+0x48> <== NOT EXECUTED (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { a000977c: e153000c cmp r3, ip <== NOT EXECUTED a0009780: 0a000001 beq a000978c <_Event_Surrender+0x108> <== NOT EXECUTED a0009784: e3160002 tst r6, #2 <== NOT EXECUTED a0009788: 0a000007 beq a00097ac <_Event_Surrender+0x128> <== NOT EXECUTED api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; a000978c: e5943028 ldr r3, [r4, #40] ; 0x28 <== NOT EXECUTED a0009790: e1c2200c bic r2, r2, ip <== NOT EXECUTED if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); a0009794: e5812000 str r2, [r1] <== NOT EXECUTED the_thread->Wait.count = 0; a0009798: e3a02000 mov r2, #0 <== NOT EXECUTED a000979c: e5842024 str r2, [r4, #36] ; 0x24 <== NOT EXECUTED *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; a00097a0: e583c000 str ip, [r3] <== NOT EXECUTED _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; a00097a4: e3a03003 mov r3, #3 <== NOT EXECUTED a00097a8: e5853000 str r3, [r5] <== NOT EXECUTED a00097ac: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED a00097b0: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== a00097c0 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { a00097c0: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED a00097c4: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); a00097c8: e1a0100d mov r1, sp <== NOT EXECUTED a00097cc: eb0009c7 bl a000bef0 <_Thread_Get> <== NOT EXECUTED switch ( location ) { a00097d0: e59d3000 ldr r3, [sp] <== NOT EXECUTED a00097d4: e3530000 cmp r3, #0 <== NOT EXECUTED a00097d8: 1a000010 bne a0009820 <_Event_Timeout+0x60> <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a00097dc: e10f2000 mrs r2, CPSR <== NOT EXECUTED a00097e0: e3821080 orr r1, r2, #128 ; 0x80 <== NOT EXECUTED a00097e4: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; a00097e8: e5803024 str r3, [r0, #36] ; 0x24 <== NOT EXECUTED if ( _Thread_Is_executing( the_thread ) ) { a00097ec: e59f304c ldr r3, [pc, #76] ; a0009840 <_Event_Timeout+0x80><== NOT EXECUTED a00097f0: e5933004 ldr r3, [r3, #4] <== NOT EXECUTED a00097f4: e1500003 cmp r0, r3 <== NOT EXECUTED a00097f8: 0a00000a beq a0009828 <_Event_Timeout+0x68> <== NOT EXECUTED if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; a00097fc: e3a03006 mov r3, #6 <== NOT EXECUTED a0009800: e5803034 str r3, [r0, #52] ; 0x34 <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0009804: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED a0009808: e59f1034 ldr r1, [pc, #52] ; a0009844 <_Event_Timeout+0x84><== NOT EXECUTED a000980c: eb0008cc bl a000bb44 <_Thread_Clear_state> <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; a0009810: e59f3030 ldr r3, [pc, #48] ; a0009848 <_Event_Timeout+0x88><== NOT EXECUTED a0009814: e5932000 ldr r2, [r3] <== NOT EXECUTED a0009818: e2422001 sub r2, r2, #1 <== NOT EXECUTED a000981c: e5832000 str r2, [r3] <== NOT EXECUTED case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } a0009820: e28dd004 add sp, sp, #4 <== NOT EXECUTED a0009824: e8bd8000 pop {pc} <== NOT EXECUTED } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) a0009828: e59f301c ldr r3, [pc, #28] ; a000984c <_Event_Timeout+0x8c><== NOT EXECUTED a000982c: e5931000 ldr r1, [r3] <== NOT EXECUTED a0009830: e3510001 cmp r1, #1 <== NOT EXECUTED _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; a0009834: 03a01002 moveq r1, #2 <== NOT EXECUTED a0009838: 05831000 streq r1, [r3] <== NOT EXECUTED a000983c: eaffffee b a00097fc <_Event_Timeout+0x3c> <== NOT EXECUTED =============================================================================== a000f288 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { a000f288: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} a000f28c: e1a08002 mov r8, r2 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; a000f290: e5902010 ldr r2, [r0, #16] Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { a000f294: e24dd01c sub sp, sp, #28 a000f298: e1a05001 mov r5, r1 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { a000f29c: e2911004 adds r1, r1, #4 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { a000f2a0: e1a07000 mov r7, r0 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { a000f2a4: e58d1000 str r1, [sp] Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { a000f2a8: e1a0b003 mov fp, r3 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; a000f2ac: e58d200c str r2, [sp, #12] Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { a000f2b0: 2a000078 bcs a000f498 <_Heap_Allocate_aligned_with_boundary+0x210> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { a000f2b4: e3530000 cmp r3, #0 a000f2b8: 1a000074 bne a000f490 <_Heap_Allocate_aligned_with_boundary+0x208> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } a000f2bc: e5979008 ldr r9, [r7, #8] do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { a000f2c0: e1570009 cmp r7, r9 a000f2c4: 0a000073 beq a000f498 <_Heap_Allocate_aligned_with_boundary+0x210> 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 a000f2c8: e59d300c ldr r3, [sp, #12] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; a000f2cc: e2651004 rsb r1, r5, #4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { a000f2d0: e3a06001 mov r6, #1 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 a000f2d4: e2833007 add r3, r3, #7 a000f2d8: e58d3010 str r3, [sp, #16] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; a000f2dc: e58d1014 str r1, [sp, #20] /* * 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 ) { a000f2e0: e599a004 ldr sl, [r9, #4] a000f2e4: e59d2000 ldr r2, [sp] a000f2e8: e152000a cmp r2, sl a000f2ec: 2a00004e bcs a000f42c <_Heap_Allocate_aligned_with_boundary+0x1a4> if ( alignment == 0 ) { a000f2f0: 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; a000f2f4: 02894008 addeq r4, r9, #8 a000f2f8: 0a000051 beq a000f444 <_Heap_Allocate_aligned_with_boundary+0x1bc> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } a000f2fc: 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_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; a000f300: 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; a000f304: 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; a000f308: 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; a000f30c: 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_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; a000f310: e081400a add r4, r1, sl if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } a000f314: 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; a000f318: e0633002 rsb r3, r3, r2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f31c: 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 a000f320: e083a00a add sl, r3, sl a000f324: 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; a000f328: e2893008 add r3, r9, #8 a000f32c: e58d3008 str r3, [sp, #8] RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f330: eb0015a6 bl a00149d0 <__umodsi3> a000f334: 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 ) { a000f338: e15a0004 cmp sl, r4 a000f33c: 2a000003 bcs a000f350 <_Heap_Allocate_aligned_with_boundary+0xc8> a000f340: e1a0000a mov r0, sl <== NOT EXECUTED a000f344: e1a01008 mov r1, r8 <== NOT EXECUTED a000f348: eb0015a0 bl a00149d0 <__umodsi3> <== NOT EXECUTED a000f34c: e060400a rsb r4, r0, sl <== NOT EXECUTED } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { a000f350: e35b0000 cmp fp, #0 a000f354: 0a000026 beq a000f3f4 <_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; a000f358: e084a005 add sl, r4, r5 <== NOT EXECUTED a000f35c: e1a0000a mov r0, sl <== NOT EXECUTED a000f360: e1a0100b mov r1, fp <== NOT EXECUTED a000f364: eb001599 bl a00149d0 <__umodsi3> <== NOT EXECUTED a000f368: e060000a rsb r0, r0, sl <== NOT EXECUTED /* 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 ) { a000f36c: e15a0000 cmp sl, r0 <== NOT EXECUTED a000f370: 93a0a000 movls sl, #0 <== NOT EXECUTED a000f374: 83a0a001 movhi sl, #1 <== NOT EXECUTED a000f378: e1540000 cmp r4, r0 <== NOT EXECUTED a000f37c: 23a0a000 movcs sl, #0 <== NOT EXECUTED a000f380: e35a0000 cmp sl, #0 <== NOT EXECUTED a000f384: 0a00001a beq a000f3f4 <_Heap_Allocate_aligned_with_boundary+0x16c><== NOT EXECUTED alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; a000f388: e59d1008 ldr r1, [sp, #8] <== NOT EXECUTED a000f38c: e0813005 add r3, r1, r5 <== NOT EXECUTED uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { a000f390: e1530000 cmp r3, r0 <== NOT EXECUTED a000f394: 958d9018 strls r9, [sp, #24] <== NOT EXECUTED a000f398: 91a09003 movls r9, r3 <== NOT EXECUTED a000f39c: 9a000002 bls a000f3ac <_Heap_Allocate_aligned_with_boundary+0x124><== NOT EXECUTED a000f3a0: ea000021 b a000f42c <_Heap_Allocate_aligned_with_boundary+0x1a4><== NOT EXECUTED a000f3a4: e1590000 cmp r9, r0 <== NOT EXECUTED a000f3a8: 8a00003c bhi a000f4a0 <_Heap_Allocate_aligned_with_boundary+0x218><== NOT EXECUTED return 0; } alloc_begin = boundary_line - alloc_size; a000f3ac: e0654000 rsb r4, r5, r0 <== NOT EXECUTED a000f3b0: e1a01008 mov r1, r8 <== NOT EXECUTED a000f3b4: e1a00004 mov r0, r4 <== NOT EXECUTED a000f3b8: eb001584 bl a00149d0 <__umodsi3> <== NOT EXECUTED a000f3bc: e0604004 rsb r4, r0, r4 <== NOT EXECUTED alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; a000f3c0: e084a005 add sl, r4, r5 <== NOT EXECUTED a000f3c4: e1a0000a mov r0, sl <== NOT EXECUTED a000f3c8: e1a0100b mov r1, fp <== NOT EXECUTED a000f3cc: eb00157f bl a00149d0 <__umodsi3> <== NOT EXECUTED a000f3d0: e060000a rsb r0, r0, sl <== NOT EXECUTED /* 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 ) { a000f3d4: e15a0000 cmp sl, r0 <== NOT EXECUTED a000f3d8: 93a0a000 movls sl, #0 <== NOT EXECUTED a000f3dc: 83a0a001 movhi sl, #1 <== NOT EXECUTED a000f3e0: e1540000 cmp r4, r0 <== NOT EXECUTED a000f3e4: 23a0a000 movcs sl, #0 <== NOT EXECUTED a000f3e8: e35a0000 cmp sl, #0 <== NOT EXECUTED a000f3ec: 1affffec bne a000f3a4 <_Heap_Allocate_aligned_with_boundary+0x11c><== NOT EXECUTED a000f3f0: e59d9018 ldr r9, [sp, #24] <== NOT EXECUTED 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 ) { a000f3f4: e59d2008 ldr r2, [sp, #8] a000f3f8: e1520004 cmp r2, r4 a000f3fc: 8a00000a bhi a000f42c <_Heap_Allocate_aligned_with_boundary+0x1a4> a000f400: e59d100c ldr r1, [sp, #12] a000f404: e1a00004 mov r0, r4 a000f408: eb001570 bl a00149d0 <__umodsi3> a000f40c: e3e0a007 mvn sl, #7 a000f410: e069a00a rsb sl, r9, sl 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 ) { a000f414: e59d1004 ldr r1, [sp, #4] uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a000f418: e08aa004 add sl, sl, r4 a000f41c: e060300a rsb r3, r0, sl a000f420: e15a0000 cmp sl, r0 a000f424: 11510003 cmpne r1, r3 a000f428: 9a000005 bls a000f444 <_Heap_Allocate_aligned_with_boundary+0x1bc> if ( alloc_begin != 0 ) { break; } block = block->next; a000f42c: e5999008 ldr r9, [r9, #8] a000f430: e2863001 add r3, r6, #1 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { a000f434: e1570009 cmp r7, r9 a000f438: 0a00001d beq a000f4b4 <_Heap_Allocate_aligned_with_boundary+0x22c> a000f43c: e1a06003 mov r6, r3 a000f440: eaffffa6 b a000f2e0 <_Heap_Allocate_aligned_with_boundary+0x58> } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { a000f444: e3540000 cmp r4, #0 a000f448: 0afffff7 beq a000f42c <_Heap_Allocate_aligned_with_boundary+0x1a4> search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; a000f44c: e5972048 ldr r2, [r7, #72] ; 0x48 stats->searches += search_count; a000f450: e597304c ldr r3, [r7, #76] ; 0x4c block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); a000f454: e1a00007 mov r0, r7 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; a000f458: e2822001 add r2, r2, #1 stats->searches += search_count; a000f45c: e0833006 add r3, r3, r6 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; a000f460: e5872048 str r2, [r7, #72] ; 0x48 stats->searches += search_count; a000f464: e587304c str r3, [r7, #76] ; 0x4c block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); a000f468: e1a01009 mov r1, r9 a000f46c: e1a02004 mov r2, r4 a000f470: e1a03005 mov r3, r5 a000f474: ebffedf8 bl a000ac5c <_Heap_Block_allocate> a000f478: e1a00004 mov r0, r4 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { a000f47c: e5973044 ldr r3, [r7, #68] ; 0x44 a000f480: e1530006 cmp r3, r6 stats->max_search = search_count; a000f484: 35876044 strcc r6, [r7, #68] ; 0x44 } return (void *) alloc_begin; } a000f488: e28dd01c add sp, sp, #28 a000f48c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { a000f490: e1550003 cmp r5, r3 <== NOT EXECUTED a000f494: 9a000008 bls a000f4bc <_Heap_Allocate_aligned_with_boundary+0x234><== NOT EXECUTED do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { a000f498: e3a00000 mov r0, #0 a000f49c: eafffff9 b a000f488 <_Heap_Allocate_aligned_with_boundary+0x200> a000f4a0: e59d9018 ldr r9, [sp, #24] <== NOT EXECUTED if ( alloc_begin != 0 ) { break; } block = block->next; a000f4a4: e2863001 add r3, r6, #1 <== NOT EXECUTED a000f4a8: e5999008 ldr r9, [r9, #8] <== NOT EXECUTED do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { a000f4ac: e1570009 cmp r7, r9 <== NOT EXECUTED a000f4b0: 1affffe1 bne a000f43c <_Heap_Allocate_aligned_with_boundary+0x1b4><== NOT EXECUTED a000f4b4: e3a00000 mov r0, #0 a000f4b8: eaffffef b a000f47c <_Heap_Allocate_aligned_with_boundary+0x1f4> if ( boundary < alloc_size ) { return NULL; } if ( alignment == 0 ) { alignment = page_size; a000f4bc: e3580000 cmp r8, #0 <== NOT EXECUTED a000f4c0: 01a08002 moveq r8, r2 <== NOT EXECUTED a000f4c4: eaffff7c b a000f2bc <_Heap_Allocate_aligned_with_boundary+0x34><== NOT EXECUTED =============================================================================== a000ac5c <_Heap_Block_allocate>: Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { a000ac5c: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} } _Heap_Protection_block_initialize( heap, block ); return block; } a000ac60: e5917004 ldr r7, [r1, #4] Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { a000ac64: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; a000ac68: e2426008 sub r6, r2, #8 - 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; a000ac6c: e3c71001 bic r1, r7, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a000ac70: e0858001 add r8, r5, r1 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; a000ac74: e598c004 ldr ip, [r8, #4] a000ac78: e1a0a003 mov sl, r3 a000ac7c: e1a04000 mov r4, r0 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { a000ac80: e31c0001 tst ip, #1 ) { Heap_Statistics *const stats = &heap->stats; uintptr_t const alloc_area_begin = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_area_offset = alloc_begin - alloc_area_begin; a000ac84: e0653006 rsb r3, r5, r6 /* Statistics */ --stats->free_blocks; ++stats->used_blocks; stats->free_size -= _Heap_Block_size( block ); } else { free_list_anchor = _Heap_Free_list_head( heap ); a000ac88: 11a09000 movne r9, r0 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { a000ac8c: 1a00000c bne a000acc4 <_Heap_Block_allocate+0x68> free_list_anchor = block->prev; _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; a000ac90: e590e038 ldr lr, [r0, #56] ; 0x38 ++stats->used_blocks; a000ac94: e590c040 ldr ip, [r0, #64] ; 0x40 stats->free_size -= _Heap_Block_size( block ); a000ac98: e590b030 ldr fp, [r0, #48] ; 0x30 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { free_list_anchor = block->prev; a000ac9c: e595900c ldr r9, [r5, #12] } _Heap_Protection_block_initialize( heap, block ); return block; } a000aca0: e5950008 ldr r0, [r5, #8] free_list_anchor = block->prev; _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; a000aca4: e24ee001 sub lr, lr, #1 ++stats->used_blocks; a000aca8: e28cc001 add ip, ip, #1 stats->free_size -= _Heap_Block_size( block ); a000acac: e061100b rsb r1, r1, fp RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; a000acb0: e5890008 str r0, [r9, #8] next->prev = prev; a000acb4: e580900c str r9, [r0, #12] free_list_anchor = block->prev; _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; a000acb8: e584e038 str lr, [r4, #56] ; 0x38 ++stats->used_blocks; a000acbc: e584c040 str ip, [r4, #64] ; 0x40 stats->free_size -= _Heap_Block_size( block ); a000acc0: e5841030 str r1, [r4, #48] ; 0x30 } else { free_list_anchor = _Heap_Free_list_head( heap ); } if ( alloc_area_offset < heap->page_size ) { a000acc4: e5941010 ldr r1, [r4, #16] a000acc8: e1530001 cmp r3, r1 a000accc: 3a000027 bcc a000ad70 <_Heap_Block_allocate+0x114> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000acd0: e1a00002 mov r0, r2 a000acd4: eb00273d bl a00149d0 <__umodsi3> _HAssert( block_size >= heap->min_block_size ); _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; a000acd8: e5943030 ldr r3, [r4, #48] ; 0x30 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a000acdc: e0606006 rsb r6, r0, r6 _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); uintptr_t const new_block_begin = (uintptr_t) new_block; uintptr_t const new_block_size = block_end - new_block_begin; block_end = new_block_begin; block_size = block_end - block_begin; a000ace0: e0651006 rsb r1, r5, r6 _HAssert( block_size >= heap->min_block_size ); _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; a000ace4: e0833001 add r3, r3, r1 if ( _Heap_Is_prev_used( block ) ) { a000ace8: e3170001 tst r7, #1 uintptr_t block_end = block_begin + block_size; Heap_Block *const new_block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); uintptr_t const new_block_begin = (uintptr_t) new_block; uintptr_t const new_block_size = block_end - new_block_begin; a000acec: e0668008 rsb r8, r6, r8 _HAssert( block_size >= heap->min_block_size ); _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; a000acf0: e5843030 str r3, [r4, #48] ; 0x30 if ( _Heap_Is_prev_used( block ) ) { a000acf4: 1a000013 bne a000ad48 <_Heap_Block_allocate+0xec> RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Prev_block( const Heap_Block *block ) { return (Heap_Block *) ((uintptr_t) block - block->prev_size); a000acf8: e5953000 ldr r3, [r5] <== NOT EXECUTED } else { Heap_Block *const prev_block = _Heap_Prev_block( block ); uintptr_t const prev_block_size = _Heap_Block_size( prev_block ); block = prev_block; block_size += prev_block_size; a000acfc: e1a02009 mov r2, r9 <== NOT EXECUTED a000ad00: e0635005 rsb r5, r3, r5 <== NOT EXECUTED - 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; a000ad04: e5953004 ldr r3, [r5, #4] <== NOT EXECUTED a000ad08: e3c33001 bic r3, r3, #1 <== NOT EXECUTED a000ad0c: e0811003 add r1, r1, r3 <== NOT EXECUTED } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; a000ad10: e3813001 orr r3, r1, #1 a000ad14: e5853004 str r3, [r5, #4] new_block->prev_size = block_size; a000ad18: e5861000 str r1, [r6] new_block->size_and_flag = new_block_size; _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); a000ad1c: e1a00004 mov r0, r4 a000ad20: e1a0300a mov r3, sl } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; a000ad24: e5868004 str r8, [r6, #4] _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); a000ad28: e1a01006 mov r1, r6 a000ad2c: ebffff17 bl a000a990 <_Heap_Block_split> alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { a000ad30: e5943030 ldr r3, [r4, #48] ; 0x30 a000ad34: e5942034 ldr r2, [r4, #52] ; 0x34 } _Heap_Protection_block_initialize( heap, block ); return block; } a000ad38: e1a00006 mov r0, r6 alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { a000ad3c: e1520003 cmp r2, r3 stats->min_free_size = stats->free_size; a000ad40: 85843034 strhi r3, [r4, #52] ; 0x34 } _Heap_Protection_block_initialize( heap, block ); return block; } a000ad44: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} _Heap_Free_list_insert_after( free_list_anchor, block ); free_list_anchor = block; /* Statistics */ ++stats->free_blocks; a000ad48: e5940038 ldr r0, [r4, #56] ; 0x38 RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; a000ad4c: e5993008 ldr r3, [r9, #8] new_block->next = next; new_block->prev = block_before; a000ad50: e585900c str r9, [r5, #12] a000ad54: e2800001 add r0, r0, #1 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; a000ad58: e5853008 str r3, [r5, #8] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; a000ad5c: e583500c str r5, [r3, #12] { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; a000ad60: e5895008 str r5, [r9, #8] a000ad64: e1a02005 mov r2, r5 a000ad68: e5840038 str r0, [r4, #56] ; 0x38 a000ad6c: eaffffe7 b a000ad10 <_Heap_Block_allocate+0xb4> Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { _Heap_Block_split( heap, block, free_list_anchor, alloc_size ); a000ad70: e1a00004 mov r0, r4 a000ad74: e1a02009 mov r2, r9 a000ad78: e083300a add r3, r3, sl a000ad7c: e1a01005 mov r1, r5 a000ad80: ebffff02 bl a000a990 <_Heap_Block_split> alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { a000ad84: e5943030 ldr r3, [r4, #48] ; 0x30 a000ad88: e5942034 ldr r2, [r4, #52] ; 0x34 Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { _Heap_Block_split( heap, block, free_list_anchor, alloc_size ); a000ad8c: e1a06005 mov r6, r5 } _Heap_Protection_block_initialize( heap, block ); return block; } a000ad90: e1a00006 mov r0, r6 alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { a000ad94: e1520003 cmp r2, r3 stats->min_free_size = stats->free_size; a000ad98: 85843034 strhi r3, [r4, #52] ; 0x34 } _Heap_Protection_block_initialize( heap, block ); return block; } a000ad9c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} =============================================================================== a000a990 <_Heap_Block_split>: Heap_Control *heap, Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { a000a990: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr} Heap_Statistics *const stats = &heap->stats; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; a000a994: e5906014 ldr r6, [r0, #20] uintptr_t alloc_size ) { Heap_Statistics *const stats = &heap->stats; uintptr_t const page_size = heap->page_size; a000a998: e5907010 ldr r7, [r0, #16] Heap_Control *heap, Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { a000a99c: e1a05001 mov r5, r1 Heap_Statistics *const stats = &heap->stats; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const min_alloc_size = min_block_size - HEAP_BLOCK_HEADER_SIZE; a000a9a0: e2468008 sub r8, r6, #8 return heap->stats.size; } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Max( uintptr_t a, uintptr_t b ) { return a > b ? a : b; a000a9a4: e1530008 cmp r3, r8 a000a9a8: 21a08003 movcs r8, r3 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const used_size = a000a9ac: e2888008 add r8, r8, #8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; a000a9b0: e1a01007 mov r1, r7 Heap_Control *heap, Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { a000a9b4: e1a04000 mov r4, r0 a000a9b8: e1a00008 mov r0, r8 a000a9bc: e1a09002 mov r9, r2 a000a9c0: eb002802 bl a00149d0 <__umodsi3> } _Heap_Protection_block_initialize( heap, block ); return block; } a000a9c4: e595a004 ldr sl, [r5, #4] if ( remainder != 0 ) { a000a9c8: e3500000 cmp r0, #0 return value - remainder + alignment; a000a9cc: 10887007 addne r7, r8, r7 - 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; a000a9d0: e3ca2001 bic r2, sl, #1 uintptr_t const used_size = _Heap_Max( alloc_size, min_alloc_size ) + HEAP_BLOCK_HEADER_SIZE; uintptr_t const used_block_size = _Heap_Align_up( used_size, page_size ); uintptr_t const free_size = block_size + HEAP_ALLOC_BONUS - used_size; a000a9d4: e2823004 add r3, r2, #4 uintptr_t remainder = value % alignment; if ( remainder != 0 ) { return value - remainder + alignment; } else { return value; a000a9d8: 01a07008 moveq r7, r8 uintptr_t const free_size_limit = min_block_size + HEAP_ALLOC_BONUS; a000a9dc: e2866004 add r6, r6, #4 uintptr_t const used_size = _Heap_Max( alloc_size, min_alloc_size ) + HEAP_BLOCK_HEADER_SIZE; uintptr_t const used_block_size = _Heap_Align_up( used_size, page_size ); uintptr_t const free_size = block_size + HEAP_ALLOC_BONUS - used_size; a000a9e0: e0688003 rsb r8, r8, r3 ) { uintptr_t remainder = value % alignment; if ( remainder != 0 ) { return value - remainder + alignment; a000a9e4: 10607007 rsbne r7, r0, r7 Heap_Block *next_block = _Heap_Block_at( block, block_size ); _HAssert( used_size <= block_size + HEAP_ALLOC_BONUS ); _HAssert( used_size + free_size == block_size + HEAP_ALLOC_BONUS ); if ( free_size >= free_size_limit ) { a000a9e8: e1580006 cmp r8, r6 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a000a9ec: e0853002 add r3, r5, r2 a000a9f0: 3a00001c bcc a000aa68 <_Heap_Block_split+0xd8> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a000a9f4: e20aa001 and sl, sl, #1 block->size_and_flag = size | flag; a000a9f8: e187a00a orr sl, r7, sl a000a9fc: e585a004 str sl, [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; a000aa00: e5931004 ldr r1, [r3, #4] _HAssert( used_block_size + free_block_size == block_size ); _Heap_Block_set_size( block, used_block_size ); /* Statistics */ stats->free_size += free_block_size; a000aa04: e5940030 ldr r0, [r4, #48] ; 0x30 _HAssert( used_size <= block_size + HEAP_ALLOC_BONUS ); _HAssert( used_size + free_size == block_size + HEAP_ALLOC_BONUS ); if ( free_size >= free_size_limit ) { Heap_Block *const free_block = _Heap_Block_at( block, used_block_size ); uintptr_t free_block_size = block_size - used_block_size; a000aa08: e0672002 rsb r2, r7, r2 a000aa0c: e3c11001 bic r1, r1, #1 } _Heap_Protection_block_initialize( heap, block ); return block; } a000aa10: e083c001 add ip, r3, r1 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; a000aa14: e59cc004 ldr ip, [ip, #4] _HAssert( used_block_size + free_block_size == block_size ); _Heap_Block_set_size( block, used_block_size ); /* Statistics */ stats->free_size += free_block_size; a000aa18: e0800002 add r0, r0, r2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a000aa1c: e0875005 add r5, r7, r5 if ( _Heap_Is_used( next_block ) ) { a000aa20: e31c0001 tst ip, #1 _HAssert( used_block_size + free_block_size == block_size ); _Heap_Block_set_size( block, used_block_size ); /* Statistics */ stats->free_size += free_block_size; a000aa24: e5840030 str r0, [r4, #48] ; 0x30 if ( _Heap_Is_used( next_block ) ) { a000aa28: 1a000012 bne a000aa78 <_Heap_Block_split+0xe8> } _Heap_Protection_block_initialize( heap, block ); return block; } a000aa2c: e5930008 ldr r0, [r3, #8] <== NOT EXECUTED a000aa30: e593300c ldr r3, [r3, #12] <== NOT EXECUTED } else { uintptr_t const next_block_size = _Heap_Block_size( next_block ); _Heap_Free_list_replace( next_block, free_block ); free_block_size += next_block_size; a000aa34: e0822001 add r2, r2, r1 <== NOT EXECUTED ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; a000aa38: e5850008 str r0, [r5, #8] <== NOT EXECUTED new_block->prev = prev; a000aa3c: e585300c str r3, [r5, #12] <== NOT EXECUTED next->prev = new_block; prev->next = new_block; a000aa40: e5835008 str r5, [r3, #8] <== NOT EXECUTED Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; a000aa44: e580500c str r5, [r0, #12] <== NOT EXECUTED RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a000aa48: e0823005 add r3, r2, r5 <== NOT EXECUTED next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; a000aa4c: e3821001 orr r1, r2, #1 a000aa50: e5851004 str r1, [r5, #4] next_block->prev_size = free_block_size; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; a000aa54: e5931004 ldr r1, [r3, #4] next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; next_block->prev_size = free_block_size; a000aa58: e5832000 str r2, [r3] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; a000aa5c: e3c12001 bic r2, r1, #1 a000aa60: e5832004 str r2, [r3, #4] a000aa64: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} _Heap_Protection_block_initialize( heap, free_block ); } else { next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; a000aa68: e5932004 ldr r2, [r3, #4] a000aa6c: e3822001 orr r2, r2, #1 a000aa70: e5832004 str r2, [r3, #4] a000aa74: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} if ( _Heap_Is_used( next_block ) ) { _Heap_Free_list_insert_after( free_list_anchor, free_block ); /* Statistics */ ++stats->free_blocks; a000aa78: e5940038 ldr r0, [r4, #56] ; 0x38 RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; a000aa7c: e5991008 ldr r1, [r9, #8] new_block->next = next; new_block->prev = block_before; a000aa80: e585900c str r9, [r5, #12] a000aa84: e2800001 add r0, r0, #1 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; a000aa88: e5851008 str r1, [r5, #8] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; a000aa8c: e581500c str r5, [r1, #12] { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; a000aa90: e5895008 str r5, [r9, #8] a000aa94: e5840038 str r0, [r4, #56] ; 0x38 a000aa98: eaffffeb b a000aa4c <_Heap_Block_split+0xbc> =============================================================================== a000f814 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { a000f814: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} a000f818: e1a05000 mov r5, r0 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { a000f81c: e0916002 adds r6, r1, r2 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { a000f820: e1a04001 mov r4, r1 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; a000f824: e5908020 ldr r8, [r0, #32] Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; a000f828: e5951030 ldr r1, [r5, #48] ; 0x30 Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; a000f82c: e5900010 ldr r0, [r0, #16] Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { a000f830: e24dd024 sub sp, sp, #36 ; 0x24 Heap_Block *start_block = first_block; Heap_Block *merge_below_block = NULL; Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; a000f834: e3a07000 mov r7, #0 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { a000f838: e58d3010 str r3, [sp, #16] Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; a000f83c: e58d0008 str r0, [sp, #8] Heap_Block *start_block = first_block; Heap_Block *merge_below_block = NULL; Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; a000f840: e58d7020 str r7, [sp, #32] Heap_Block *extend_last_block = NULL; a000f844: e58d701c str r7, [sp, #28] uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; a000f848: e5953014 ldr r3, [r5, #20] uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; a000f84c: e58d1018 str r1, [sp, #24] uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { return false; a000f850: 21a00007 movcs r0, r7 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { a000f854: 3a000001 bcc a000f860 <_Heap_Extend+0x4c> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } a000f858: e28dd024 add sp, sp, #36 ; 0x24 a000f85c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} if ( extend_area_end < extend_area_begin ) { return false; } extend_area_ok = _Heap_Get_first_and_last_block( a000f860: e28dc020 add ip, sp, #32 a000f864: e1a01002 mov r1, r2 a000f868: e58dc000 str ip, [sp] a000f86c: e1a00004 mov r0, r4 a000f870: e28dc01c add ip, sp, #28 a000f874: e59d2008 ldr r2, [sp, #8] a000f878: e58dc004 str ip, [sp, #4] a000f87c: ebffed5f bl a000ae00 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { a000f880: e3500000 cmp r0, #0 a000f884: 0afffff3 beq a000f858 <_Heap_Extend+0x44> a000f888: e1a09008 mov r9, r8 a000f88c: e1a0b007 mov fp, r7 a000f890: e58d700c str r7, [sp, #12] a000f894: e58d7014 str r7, [sp, #20] return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; a000f898: e1590008 cmp r9, r8 a000f89c: 05953018 ldreq r3, [r5, #24] uintptr_t const sub_area_end = start_block->prev_size; a000f8a0: e599a000 ldr sl, [r9] return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; a000f8a4: 11a03009 movne r3, r9 uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( a000f8a8: e1530006 cmp r3, r6 a000f8ac: 3154000a cmpcc r4, sl a000f8b0: 3a00006c bcc a000fa68 <_Heap_Extend+0x254> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { a000f8b4: e1530006 cmp r3, r6 a000f8b8: 058d9014 streq r9, [sp, #20] a000f8bc: 0a000001 beq a000f8c8 <_Heap_Extend+0xb4> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { a000f8c0: e156000a cmp r6, sl a000f8c4: 31a0b009 movcc fp, r9 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f8c8: e1a0000a mov r0, sl a000f8cc: e59d1008 ldr r1, [sp, #8] a000f8d0: eb001593 bl a0014f24 <__umodsi3> a000f8d4: e24a3008 sub r3, sl, #8 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { a000f8d8: e15a0004 cmp sl, r4 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a000f8dc: e0603003 rsb r3, r0, r3 start_block->prev_size = extend_area_end; a000f8e0: 05896000 streq r6, [r9] RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area( uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) a000f8e4: 058d300c streq r3, [sp, #12] merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { a000f8e8: 0a000001 beq a000f8f4 <_Heap_Extend+0xe0> a000f8ec: e154000a cmp r4, sl a000f8f0: 81a07003 movhi r7, r3 - 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; a000f8f4: e5939004 ldr r9, [r3, #4] a000f8f8: e3c99001 bic r9, r9, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a000f8fc: e0839009 add r9, r3, r9 } else if ( sub_area_end < extend_area_begin ) { link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); a000f900: e1580009 cmp r8, r9 a000f904: 1affffe3 bne a000f898 <_Heap_Extend+0x84> if ( extend_area_begin < heap->area_begin ) { a000f908: e5953018 ldr r3, [r5, #24] a000f90c: e1540003 cmp r4, r3 heap->area_begin = extend_area_begin; a000f910: 35854018 strcc r4, [r5, #24] } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); if ( extend_area_begin < heap->area_begin ) { a000f914: 3a000002 bcc a000f924 <_Heap_Extend+0x110> heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { a000f918: e595301c ldr r3, [r5, #28] <== NOT EXECUTED a000f91c: e1560003 cmp r6, r3 <== NOT EXECUTED heap->area_end = extend_area_end; a000f920: 8585601c strhi r6, [r5, #28] <== NOT EXECUTED } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; a000f924: e59d3020 ldr r3, [sp, #32] a000f928: e59d201c ldr r2, [sp, #28] extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { a000f92c: e595c020 ldr ip, [r5, #32] } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; a000f930: e5836000 str r6, [r3] heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = a000f934: e0631002 rsb r1, r3, r2 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; a000f938: e3810001 orr r0, r1, #1 _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; a000f93c: e5821000 str r1, [r2] extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { a000f940: e15c0003 cmp ip, r3 extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; a000f944: e3a01000 mov r1, #0 extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = a000f948: e5830004 str r0, [r3, #4] extend_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; a000f94c: e5821004 str r1, [r2, #4] _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { heap->first_block = extend_first_block; a000f950: 85853020 strhi r3, [r5, #32] extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { a000f954: 8a000002 bhi a000f964 <_Heap_Extend+0x150> heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { a000f958: e5953024 ldr r3, [r5, #36] ; 0x24 <== NOT EXECUTED a000f95c: e1530002 cmp r3, r2 <== NOT EXECUTED heap->last_block = extend_last_block; a000f960: 35852024 strcc r2, [r5, #36] ; 0x24 <== NOT EXECUTED } if ( merge_below_block != NULL ) { a000f964: e59d3014 ldr r3, [sp, #20] a000f968: e3530000 cmp r3, #0 a000f96c: 0a000050 beq a000fab4 <_Heap_Extend+0x2a0> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; a000f970: e5958010 ldr r8, [r5, #16] <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); a000f974: e2844008 add r4, r4, #8 <== NOT EXECUTED RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; a000f978: e1a00004 mov r0, r4 <== NOT EXECUTED a000f97c: e1a01008 mov r1, r8 <== NOT EXECUTED a000f980: eb001567 bl a0014f24 <__umodsi3> <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; a000f984: e59dc014 ldr ip, [sp, #20] <== NOT EXECUTED if ( remainder != 0 ) { a000f988: e3500000 cmp r0, #0 <== NOT EXECUTED return value - remainder + alignment; a000f98c: 10844008 addne r4, r4, r8 <== NOT EXECUTED a000f990: 10604004 rsbne r4, r0, r4 <== NOT EXECUTED ) { uintptr_t const page_size = heap->page_size; uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = a000f994: e2441008 sub r1, r4, #8 <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; a000f998: e59c2000 ldr r2, [ip] <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = a000f99c: e061300c rsb r3, r1, ip <== NOT EXECUTED first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; a000f9a0: e3833001 orr r3, r3, #1 <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; a000f9a4: e5042008 str r2, [r4, #-8] <== NOT EXECUTED new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; a000f9a8: e5813004 str r3, [r1, #4] <== NOT EXECUTED _Heap_Free_block( heap, new_first_block ); a000f9ac: e1a00005 mov r0, r5 <== NOT EXECUTED a000f9b0: ebffff8f bl a000f7f4 <_Heap_Free_block> <== NOT EXECUTED link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { a000f9b4: e59d000c ldr r0, [sp, #12] a000f9b8: e3500000 cmp r0, #0 a000f9bc: 0a00002b beq a000fa70 <_Heap_Extend+0x25c> ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( extend_area_end - last_block_begin - HEAP_BLOCK_HEADER_SIZE, a000f9c0: e2466008 sub r6, r6, #8 <== NOT EXECUTED uintptr_t extend_area_end ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( a000f9c4: e0606006 rsb r6, r0, r6 <== NOT EXECUTED RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f9c8: e5951010 ldr r1, [r5, #16] <== NOT EXECUTED a000f9cc: e1a00006 mov r0, r6 <== NOT EXECUTED a000f9d0: eb001553 bl a0014f24 <__umodsi3> <== NOT EXECUTED ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) a000f9d4: e59d100c ldr r1, [sp, #12] <== NOT EXECUTED a000f9d8: e0606006 rsb r6, r0, r6 <== NOT EXECUTED | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); a000f9dc: e1a00005 mov r0, r5 <== NOT EXECUTED ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) a000f9e0: e5913004 ldr r3, [r1, #4] <== NOT EXECUTED page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = a000f9e4: e0862001 add r2, r6, r1 <== NOT EXECUTED (last_block->size_and_flag - last_block_new_size) a000f9e8: e0663003 rsb r3, r6, r3 <== NOT EXECUTED | HEAP_PREV_BLOCK_USED; a000f9ec: e3833001 orr r3, r3, #1 <== NOT EXECUTED page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = a000f9f0: e5823004 str r3, [r2, #4] <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a000f9f4: e5913004 ldr r3, [r1, #4] <== NOT EXECUTED a000f9f8: e2033001 and r3, r3, #1 <== NOT EXECUTED block->size_and_flag = size | flag; a000f9fc: e1866003 orr r6, r6, r3 <== NOT EXECUTED a000fa00: e5816004 str r6, [r1, #4] <== NOT EXECUTED (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); a000fa04: ebffff7a bl a000f7f4 <_Heap_Free_block> <== NOT EXECUTED extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { a000fa08: e59d200c ldr r2, [sp, #12] a000fa0c: e59d3014 ldr r3, [sp, #20] a000fa10: e3520000 cmp r2, #0 a000fa14: 03530000 cmpeq r3, #0 a000fa18: 0a000021 beq a000faa4 <_Heap_Extend+0x290> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } a000fa1c: e5953024 ldr r3, [r5, #36] ; 0x24 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( a000fa20: e595c020 ldr ip, [r5, #32] _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; a000fa24: e5952030 ldr r2, [r5, #48] ; 0x30 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a000fa28: e5930004 ldr r0, [r3, #4] * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( a000fa2c: e063c00c rsb ip, r3, ip a000fa30: e59d4018 ldr r4, [sp, #24] RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a000fa34: e2000001 and r0, r0, #1 /* Statistics */ stats->size += extended_size; a000fa38: e595102c ldr r1, [r5, #44] ; 0x2c block->size_and_flag = size | flag; a000fa3c: e18c0000 orr r0, ip, r0 if ( extended_size_ptr != NULL ) a000fa40: e59dc010 ldr ip, [sp, #16] _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; a000fa44: e0642002 rsb r2, r4, r2 /* Statistics */ stats->size += extended_size; a000fa48: e0811002 add r1, r1, r2 if ( extended_size_ptr != NULL ) a000fa4c: e35c0000 cmp ip, #0 a000fa50: e5830004 str r0, [r3, #4] _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; a000fa54: e585102c str r1, [r5, #44] ; 0x2c if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; a000fa58: 13a00001 movne r0, #1 /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; a000fa5c: 158c2000 strne r2, [ip] return true; a000fa60: 03a00001 moveq r0, #1 a000fa64: eaffff7b b a000f858 <_Heap_Extend+0x44> _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; a000fa68: e3a00000 mov r0, #0 <== NOT EXECUTED a000fa6c: eaffff79 b a000f858 <_Heap_Extend+0x44> <== NOT EXECUTED ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { a000fa70: e3570000 cmp r7, #0 a000fa74: 0affffe3 beq a000fa08 <_Heap_Extend+0x1f4> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a000fa78: e5971004 ldr r1, [r7, #4] <== NOT EXECUTED ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); a000fa7c: e59d2020 ldr r2, [sp, #32] <== NOT EXECUTED } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( a000fa80: e59d301c ldr r3, [sp, #28] <== NOT EXECUTED a000fa84: e2011001 and r1, r1, #1 <== NOT EXECUTED ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); a000fa88: e0672002 rsb r2, r7, r2 <== NOT EXECUTED block->size_and_flag = size | flag; a000fa8c: e1822001 orr r2, r2, r1 <== NOT EXECUTED a000fa90: e5872004 str r2, [r7, #4] <== NOT EXECUTED last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; a000fa94: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED a000fa98: e3822001 orr r2, r2, #1 <== NOT EXECUTED a000fa9c: e5832004 str r2, [r3, #4] <== NOT EXECUTED a000faa0: eaffffd8 b a000fa08 <_Heap_Extend+0x1f4> <== NOT EXECUTED extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { _Heap_Free_block( heap, extend_first_block ); a000faa4: e1a00005 mov r0, r5 a000faa8: e59d1020 ldr r1, [sp, #32] a000faac: ebffff50 bl a000f7f4 <_Heap_Free_block> a000fab0: eaffffd9 b a000fa1c <_Heap_Extend+0x208> heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { a000fab4: e35b0000 cmp fp, #0 { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; a000fab8: 1062b00b rsbne fp, r2, fp a000fabc: 138bb001 orrne fp, fp, #1 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = a000fac0: 1582b004 strne fp, [r2, #4] a000fac4: eaffffba b a000f9b4 <_Heap_Extend+0x1a0> =============================================================================== a000f4c8 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { a000f4c8: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} a000f4cc: e1a04000 mov r4, r0 a000f4d0: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f4d4: e1a00001 mov r0, r1 a000f4d8: e5941010 ldr r1, [r4, #16] a000f4dc: eb00153b bl a00149d0 <__umodsi3> 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 a000f4e0: e5943020 ldr r3, [r4, #32] RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a000f4e4: e2455008 sub r5, r5, #8 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a000f4e8: 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; a000f4ec: e1550003 cmp r5, r3 a000f4f0: 3a000030 bcc a000f5b8 <_Heap_Free+0xf0> a000f4f4: e5941024 ldr r1, [r4, #36] ; 0x24 a000f4f8: e1550001 cmp r5, r1 a000f4fc: 8a00002d bhi a000f5b8 <_Heap_Free+0xf0> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f500: 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; a000f504: 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); a000f508: 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; a000f50c: e1530002 cmp r3, r2 a000f510: 8a000028 bhi a000f5b8 <_Heap_Free+0xf0> a000f514: e1510002 cmp r1, r2 _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; a000f518: 33a00000 movcc r0, #0 a000f51c: 3a000027 bcc a000f5c0 <_Heap_Free+0xf8> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f520: 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 ) ) { a000f524: e2170001 ands r0, r7, #1 a000f528: 0a000024 beq a000f5c0 <_Heap_Free+0xf8> return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); a000f52c: 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; a000f530: e3c77001 bic r7, r7, #1 a000f534: 03a08000 moveq r8, #0 a000f538: 0a000004 beq a000f550 <_Heap_Free+0x88> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f53c: 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; a000f540: e5900004 ldr r0, [r0, #4] return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) a000f544: e3100001 tst r0, #1 a000f548: 13a08000 movne r8, #0 a000f54c: 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 ) ) { a000f550: e21c0001 ands r0, ip, #1 a000f554: 1a00001a bne a000f5c4 <_Heap_Free+0xfc> uintptr_t const prev_size = block->prev_size; a000f558: 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); a000f55c: 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; a000f560: e153000a cmp r3, sl a000f564: 8a000015 bhi a000f5c0 <_Heap_Free+0xf8> a000f568: e151000a cmp r1, sl a000f56c: 3a000013 bcc a000f5c0 <_Heap_Free+0xf8> 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; a000f570: 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) ) { a000f574: e2100001 ands r0, r0, #1 a000f578: 0a000010 beq a000f5c0 <_Heap_Free+0xf8> _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ a000f57c: e3580000 cmp r8, #0 a000f580: 0a000038 beq a000f668 <_Heap_Free+0x1a0> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; a000f584: e5940038 ldr r0, [r4, #56] ; 0x38 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f588: 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; a000f58c: e0867007 add r7, r6, r7 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f590: e592200c ldr r2, [r2, #12] _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; a000f594: e087c00c add ip, r7, ip _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; a000f598: e2400001 sub r0, r0, #1 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; a000f59c: 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; a000f5a0: e5823008 str r3, [r2, #8] next->prev = prev; a000f5a4: 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; a000f5a8: e5840038 str r0, [r4, #56] ; 0x38 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; a000f5ac: 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; a000f5b0: e78ac00c str ip, [sl, ip] a000f5b4: ea00000e b a000f5f4 <_Heap_Free+0x12c> _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; a000f5b8: e3a00000 mov r0, #0 a000f5bc: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f5c0: 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 */ a000f5c4: e3580000 cmp r8, #0 a000f5c8: 0a000014 beq a000f620 <_Heap_Free+0x158> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } a000f5cc: e5923008 ldr r3, [r2, #8] a000f5d0: e592200c ldr r2, [r2, #12] 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; a000f5d4: e0877006 add r7, r7, r6 _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; a000f5d8: e3871001 orr r1, r7, #1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; a000f5dc: e5853008 str r3, [r5, #8] new_block->prev = prev; a000f5e0: e585200c str r2, [r5, #12] next->prev = new_block; prev->next = new_block; a000f5e4: e5825008 str r5, [r2, #8] Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; a000f5e8: e583500c str r5, [r3, #12] a000f5ec: e5851004 str r1, [r5, #4] next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; a000f5f0: e7857007 str r7, [r5, r7] stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; a000f5f4: e5942040 ldr r2, [r4, #64] ; 0x40 ++stats->frees; a000f5f8: e5943050 ldr r3, [r4, #80] ; 0x50 stats->free_size += block_size; a000f5fc: e5941030 ldr r1, [r4, #48] ; 0x30 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; a000f600: e2422001 sub r2, r2, #1 ++stats->frees; a000f604: e2833001 add r3, r3, #1 stats->free_size += block_size; a000f608: e0816006 add r6, r1, r6 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; a000f60c: e5842040 str r2, [r4, #64] ; 0x40 ++stats->frees; a000f610: e5843050 str r3, [r4, #80] ; 0x50 stats->free_size += block_size; a000f614: e5846030 str r6, [r4, #48] ; 0x30 return( true ); a000f618: e3a00001 mov r0, #1 a000f61c: 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; a000f620: e3863001 orr r3, r6, #1 a000f624: e5853004 str r3, [r5, #4] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; a000f628: e5943038 ldr r3, [r4, #56] ; 0x38 if ( stats->max_free_blocks < stats->free_blocks ) { a000f62c: e594c03c ldr ip, [r4, #60] ; 0x3c } 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; a000f630: 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; a000f634: e5941008 ldr r1, [r4, #8] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; a000f638: 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; a000f63c: e3c00001 bic r0, r0, #1 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { a000f640: e153000c cmp r3, ip new_block->next = next; a000f644: e5851008 str r1, [r5, #8] new_block->prev = block_before; a000f648: 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; a000f64c: e5820004 str r0, [r2, #4] block_before->next = new_block; next->prev = new_block; a000f650: e581500c str r5, [r1, #12] next_block->prev_size = block_size; a000f654: 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; a000f658: e5845008 str r5, [r4, #8] /* Statistics */ ++stats->free_blocks; a000f65c: e5843038 str r3, [r4, #56] ; 0x38 if ( stats->max_free_blocks < stats->free_blocks ) { stats->max_free_blocks = stats->free_blocks; a000f660: 8584303c strhi r3, [r4, #60] ; 0x3c a000f664: eaffffe2 b a000f5f4 <_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; a000f668: e086c00c add ip, r6, ip prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; a000f66c: e38c3001 orr r3, ip, #1 a000f670: e58a3004 str r3, [sl, #4] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; a000f674: e5923004 ldr r3, [r2, #4] next_block->prev_size = size; a000f678: e785c006 str ip, [r5, r6] _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; a000f67c: e3c33001 bic r3, r3, #1 a000f680: e5823004 str r3, [r2, #4] a000f684: eaffffda b a000f5f4 <_Heap_Free+0x12c> =============================================================================== a001654c <_Heap_Resize_block>: void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { a001654c: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} a0016550: e1a04000 mov r4, r0 a0016554: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a0016558: e1a00001 mov r0, r1 a001655c: e5941010 ldr r1, [r4, #16] a0016560: e1a07003 mov r7, r3 a0016564: e1a0a002 mov sl, r2 a0016568: ebfff918 bl a00149d0 <__umodsi3> 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; a001656c: e5943020 ldr r3, [r4, #32] a0016570: e59d601c ldr r6, [sp, #28] RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a0016574: e2458008 sub r8, r5, #8 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a0016578: e0601008 rsb r1, r0, r8 uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); *old_size = 0; a001657c: e3a02000 mov r2, #0 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; a0016580: e1530001 cmp r3, r1 a0016584: e5872000 str r2, [r7] *new_size = 0; a0016588: e5862000 str r2, [r6] a001658c: 8a000038 bhi a0016674 <_Heap_Resize_block+0x128> a0016590: e5943024 ldr r3, [r4, #36] ; 0x24 a0016594: e1530001 cmp r3, r1 a0016598: 3a000037 bcc a001667c <_Heap_Resize_block+0x130> - 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; a001659c: e5910004 ldr r0, [r1, #4] uintptr_t const block_begin = (uintptr_t) block; uintptr_t block_size = _Heap_Block_size( block ); uintptr_t block_end = block_begin + block_size; uintptr_t alloc_size = block_end - alloc_begin + HEAP_ALLOC_BONUS; a00165a0: e2653004 rsb r3, r5, #4 a00165a4: e3c00001 bic r0, r0, #1 { Heap_Statistics *const stats = &heap->stats; uintptr_t const block_begin = (uintptr_t) block; uintptr_t block_size = _Heap_Block_size( block ); uintptr_t block_end = block_begin + block_size; a00165a8: e0812000 add r2, r1, r0 a00165ac: e592c004 ldr ip, [r2, #4] uintptr_t alloc_size = block_end - alloc_begin + HEAP_ALLOC_BONUS; a00165b0: e0833002 add r3, r3, r2 a00165b4: e3ccc001 bic ip, ip, #1 new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; } } a00165b8: e082800c add r8, r2, ip 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; a00165bc: e5988004 ldr r8, [r8, #4] bool next_block_is_free = _Heap_Is_free( next_block );; _HAssert( _Heap_Is_block_in_heap( heap, next_block ) ); _HAssert( _Heap_Is_prev_used( next_block ) ); *old_size = alloc_size; a00165c0: e5873000 str r3, [r7] RTEMS_INLINE_ROUTINE bool _Heap_Is_free( const Heap_Block *block ) { return !_Heap_Is_used( block ); a00165c4: e3180001 tst r8, #1 a00165c8: 13a07000 movne r7, #0 a00165cc: 03a07001 moveq r7, #1 if ( next_block_is_free ) { a00165d0: e3570000 cmp r7, #0 block_size += next_block_size; alloc_size += next_block_size; a00165d4: 1083300c addne r3, r3, ip _HAssert( _Heap_Is_prev_used( next_block ) ); *old_size = alloc_size; if ( next_block_is_free ) { block_size += next_block_size; a00165d8: 1080000c addne r0, r0, ip alloc_size += next_block_size; } if ( new_alloc_size > alloc_size ) { a00165dc: e15a0003 cmp sl, r3 a00165e0: 8a000027 bhi a0016684 <_Heap_Resize_block+0x138> return HEAP_RESIZE_UNSATISFIED; } if ( next_block_is_free ) { a00165e4: e3570000 cmp r7, #0 a00165e8: 0a000011 beq a0016634 <_Heap_Resize_block+0xe8> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a00165ec: e5917004 ldr r7, [r1, #4] <== NOT EXECUTED RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a00165f0: e0803001 add r3, r0, r1 <== NOT EXECUTED next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; /* Statistics */ --stats->free_blocks; a00165f4: e594e038 ldr lr, [r4, #56] ; 0x38 <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; a00165f8: e2077001 and r7, r7, #1 <== NOT EXECUTED block->size_and_flag = size | flag; a00165fc: e1800007 orr r0, r0, r7 <== NOT EXECUTED a0016600: e5810004 str r0, [r1, #4] <== NOT EXECUTED stats->free_size -= next_block_size; a0016604: e5948030 ldr r8, [r4, #48] ; 0x30 <== NOT EXECUTED _Heap_Block_set_size( block, block_size ); _Heap_Free_list_remove( next_block ); next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; a0016608: e5937004 ldr r7, [r3, #4] <== NOT EXECUTED new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; } } a001660c: e5920008 ldr r0, [r2, #8] <== NOT EXECUTED a0016610: e592200c ldr r2, [r2, #12] <== NOT EXECUTED _Heap_Block_set_size( block, block_size ); _Heap_Free_list_remove( next_block ); next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; a0016614: e3877001 orr r7, r7, #1 <== NOT EXECUTED /* Statistics */ --stats->free_blocks; a0016618: e24ee001 sub lr, lr, #1 <== NOT EXECUTED stats->free_size -= next_block_size; a001661c: e06cc008 rsb ip, ip, r8 <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; a0016620: e5820008 str r0, [r2, #8] <== NOT EXECUTED next->prev = prev; a0016624: e580200c str r2, [r0, #12] <== NOT EXECUTED _Heap_Block_set_size( block, block_size ); _Heap_Free_list_remove( next_block ); next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; a0016628: e5837004 str r7, [r3, #4] <== NOT EXECUTED /* Statistics */ --stats->free_blocks; a001662c: e584e038 str lr, [r4, #56] ; 0x38 <== NOT EXECUTED stats->free_size -= next_block_size; a0016630: e584c030 str ip, [r4, #48] ; 0x30 <== NOT EXECUTED } block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); a0016634: e1a02005 mov r2, r5 a0016638: e1a0300a mov r3, sl a001663c: e1a00004 mov r0, r4 a0016640: ebffd185 bl a000ac5c <_Heap_Block_allocate> - 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; a0016644: e5902004 ldr r2, [r0, #4] a0016648: e1a03000 mov r3, r0 *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; /* Statistics */ ++stats->resizes; return HEAP_RESIZE_SUCCESSFUL; a001664c: e3a00000 mov r0, #0 a0016650: e3c22001 bic r2, r2, #1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); a0016654: e2822004 add r2, r2, #4 block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; a0016658: e0655002 rsb r5, r5, r2 a001665c: e0833005 add r3, r3, r5 a0016660: e5863000 str r3, [r6] /* Statistics */ ++stats->resizes; a0016664: e5943054 ldr r3, [r4, #84] ; 0x54 a0016668: e2833001 add r3, r3, #1 a001666c: e5843054 str r3, [r4, #84] ; 0x54 a0016670: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} new_alloc_size, old_size, new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; a0016674: e3a00002 mov r0, #2 <== NOT EXECUTED a0016678: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED a001667c: e3a00002 mov r0, #2 <== NOT EXECUTED } } a0016680: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED block_size += next_block_size; alloc_size += next_block_size; } if ( new_alloc_size > alloc_size ) { return HEAP_RESIZE_UNSATISFIED; a0016684: e3a00001 mov r0, #1 *new_size = 0; _Heap_Protection_block_check( heap, block ); if ( _Heap_Is_block_in_heap( heap, block ) ) { return _Heap_Resize_block_checked( a0016688: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} =============================================================================== a001668c <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { a001668c: e92d40f0 push {r4, r5, r6, r7, lr} a0016690: e1a04000 mov r4, r0 a0016694: e1a05001 mov r5, r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a0016698: e1a00001 mov r0, r1 a001669c: e5941010 ldr r1, [r4, #16] a00166a0: e1a07002 mov r7, r2 a00166a4: ebfff8c9 bl a00149d0 <__umodsi3> 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 a00166a8: e5943020 ldr r3, [r4, #32] RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); a00166ac: e2456008 sub r6, r5, #8 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); a00166b0: 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; a00166b4: e1500003 cmp r0, r3 a00166b8: 3a000012 bcc a0016708 <_Heap_Size_of_alloc_area+0x7c> a00166bc: e5942024 ldr r2, [r4, #36] ; 0x24 a00166c0: e1500002 cmp r0, r2 a00166c4: 8a00000f bhi a0016708 <_Heap_Size_of_alloc_area+0x7c> - 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; a00166c8: e5906004 ldr r6, [r0, #4] a00166cc: 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); a00166d0: 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; a00166d4: e1530006 cmp r3, r6 a00166d8: 8a00000a bhi a0016708 <_Heap_Size_of_alloc_area+0x7c> a00166dc: e1520006 cmp r2, r6 if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; a00166e0: 33a00000 movcc r0, #0 a00166e4: 3a000009 bcc a0016710 <_Heap_Size_of_alloc_area+0x84> 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; a00166e8: 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 ) a00166ec: e2100001 ands r0, r0, #1 a00166f0: 0a000006 beq a0016710 <_Heap_Size_of_alloc_area+0x84> ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; a00166f4: e2655004 rsb r5, r5, #4 a00166f8: e0856006 add r6, r5, r6 a00166fc: e5876000 str r6, [r7] return true; a0016700: e3a00001 mov r0, #1 a0016704: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; a0016708: e3a00000 mov r0, #0 <== NOT EXECUTED a001670c: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; } a0016710: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== a000b9c0 <_Heap_Walk>: 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() ) ) { a000b9c0: e59f3584 ldr r3, [pc, #1412] ; a000bf4c <_Heap_Walk+0x58c> bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { a000b9c4: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} 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; a000b9c8: e31200ff tst r2, #255 ; 0xff if ( !_System_state_Is_up( _System_state_Get() ) ) { a000b9cc: 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; a000b9d0: e59f2578 ldr r2, [pc, #1400] ; a000bf50 <_Heap_Walk+0x590> a000b9d4: e59f9578 ldr r9, [pc, #1400] ; a000bf54 <_Heap_Walk+0x594> bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { a000b9d8: e1a0a001 mov sl, r1 uintptr_t const page_size = heap->page_size; a000b9dc: e5901010 ldr r1, [r0, #16] 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; a000b9e0: 11a09002 movne r9, r2 if ( !_System_state_Is_up( _System_state_Get() ) ) { a000b9e4: 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; a000b9e8: e5902014 ldr r2, [r0, #20] Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; a000b9ec: e5903024 ldr r3, [r0, #36] ; 0x24 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { a000b9f0: e24dd038 sub sp, sp, #56 ; 0x38 a000b9f4: e1a04000 mov r4, r0 uintptr_t const page_size = heap->page_size; a000b9f8: e58d1024 str r1, [sp, #36] ; 0x24 uintptr_t const min_block_size = heap->min_block_size; a000b9fc: e58d2028 str r2, [sp, #40] ; 0x28 Heap_Block *const first_block = heap->first_block; a000ba00: e5908020 ldr r8, [r0, #32] Heap_Block *const last_block = heap->last_block; a000ba04: 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() ) ) { a000ba08: 0a000002 beq a000ba18 <_Heap_Walk+0x58> } block = next_block; } while ( block != first_block ); return true; a000ba0c: e3a00001 mov r0, #1 } a000ba10: e28dd038 add sp, sp, #56 ; 0x38 a000ba14: 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)( a000ba18: e594101c ldr r1, [r4, #28] a000ba1c: e5900018 ldr r0, [r0, #24] a000ba20: e5942008 ldr r2, [r4, #8] a000ba24: e594300c ldr r3, [r4, #12] a000ba28: e59dc028 ldr ip, [sp, #40] ; 0x28 a000ba2c: e58d1008 str r1, [sp, #8] a000ba30: e59d102c ldr r1, [sp, #44] ; 0x2c a000ba34: e58d0004 str r0, [sp, #4] a000ba38: e58d2014 str r2, [sp, #20] a000ba3c: e58d1010 str r1, [sp, #16] a000ba40: e58d3018 str r3, [sp, #24] a000ba44: e59f250c ldr r2, [pc, #1292] ; a000bf58 <_Heap_Walk+0x598> a000ba48: e58dc000 str ip, [sp] a000ba4c: e58d800c str r8, [sp, #12] a000ba50: e1a0000a mov r0, sl a000ba54: e3a01000 mov r1, #0 a000ba58: e59d3024 ldr r3, [sp, #36] ; 0x24 a000ba5c: e12fff39 blx r9 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { a000ba60: e59d2024 ldr r2, [sp, #36] ; 0x24 a000ba64: e3520000 cmp r2, #0 a000ba68: 0a000024 beq a000bb00 <_Heap_Walk+0x140> (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { a000ba6c: e59d3024 ldr r3, [sp, #36] ; 0x24 a000ba70: e2135007 ands r5, r3, #7 a000ba74: 1a000027 bne a000bb18 <_Heap_Walk+0x158> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; a000ba78: e59d0028 ldr r0, [sp, #40] ; 0x28 a000ba7c: e59d1024 ldr r1, [sp, #36] ; 0x24 a000ba80: ebffe561 bl a000500c <__umodsi3> ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { a000ba84: e250b000 subs fp, r0, #0 a000ba88: 1a000028 bne a000bb30 <_Heap_Walk+0x170> a000ba8c: e2880008 add r0, r8, #8 a000ba90: e59d1024 ldr r1, [sp, #36] ; 0x24 a000ba94: ebffe55c bl a000500c <__umodsi3> ); return false; } if ( a000ba98: e2506000 subs r6, r0, #0 a000ba9c: 1a00002a bne a000bb4c <_Heap_Walk+0x18c> block = next_block; } while ( block != first_block ); return true; } a000baa0: e598b004 ldr fp, [r8, #4] ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { a000baa4: e21b5001 ands r5, fp, #1 a000baa8: 0a0000f4 beq a000be80 <_Heap_Walk+0x4c0> - 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; a000baac: e59dc02c ldr ip, [sp, #44] ; 0x2c a000bab0: e59c3004 ldr r3, [ip, #4] a000bab4: 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); a000bab8: 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; a000babc: e5935004 ldr r5, [r3, #4] ); return false; } if ( _Heap_Is_free( last_block ) ) { a000bac0: e2155001 ands r5, r5, #1 a000bac4: 0a000007 beq a000bae8 <_Heap_Walk+0x128> ); return false; } if ( a000bac8: e1580003 cmp r8, r3 a000bacc: 0a000025 beq a000bb68 <_Heap_Walk+0x1a8> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( a000bad0: e1a0000a mov r0, sl <== NOT EXECUTED a000bad4: e3a01001 mov r1, #1 <== NOT EXECUTED a000bad8: e59f247c ldr r2, [pc, #1148] ; a000bf5c <_Heap_Walk+0x59c> <== NOT EXECUTED a000badc: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bae0: e1a00006 mov r0, r6 <== NOT EXECUTED a000bae4: eaffffc9 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( a000bae8: e1a0000a mov r0, sl <== NOT EXECUTED a000baec: e3a01001 mov r1, #1 <== NOT EXECUTED a000baf0: e59f2468 ldr r2, [pc, #1128] ; a000bf60 <_Heap_Walk+0x5a0> <== NOT EXECUTED a000baf4: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000baf8: e1a00005 mov r0, r5 <== NOT EXECUTED a000bafc: eaffffc3 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); a000bb00: e1a0000a mov r0, sl a000bb04: e3a01001 mov r1, #1 a000bb08: e59f2454 ldr r2, [pc, #1108] ; a000bf64 <_Heap_Walk+0x5a4> a000bb0c: e12fff39 blx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bb10: e59d0024 ldr r0, [sp, #36] ; 0x24 a000bb14: eaffffbd b a000ba10 <_Heap_Walk+0x50> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( a000bb18: e1a0000a mov r0, sl a000bb1c: e3a01001 mov r1, #1 a000bb20: e59f2440 ldr r2, [pc, #1088] ; a000bf68 <_Heap_Walk+0x5a8> a000bb24: e12fff39 blx r9 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bb28: e3a00000 mov r0, #0 a000bb2c: eaffffb7 b a000ba10 <_Heap_Walk+0x50> return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( a000bb30: e1a0000a mov r0, sl <== NOT EXECUTED a000bb34: e3a01001 mov r1, #1 <== NOT EXECUTED a000bb38: e59f242c ldr r2, [pc, #1068] ; a000bf6c <_Heap_Walk+0x5ac> <== NOT EXECUTED a000bb3c: e59d3028 ldr r3, [sp, #40] ; 0x28 <== NOT EXECUTED a000bb40: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bb44: e1a00005 mov r0, r5 <== NOT EXECUTED a000bb48: eaffffb0 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( a000bb4c: e1a0000a mov r0, sl <== NOT EXECUTED a000bb50: e3a01001 mov r1, #1 <== NOT EXECUTED a000bb54: e59f2414 ldr r2, [pc, #1044] ; a000bf70 <_Heap_Walk+0x5b0> <== NOT EXECUTED a000bb58: e1a03008 mov r3, r8 <== NOT EXECUTED a000bb5c: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bb60: e1a0000b mov r0, fp <== NOT EXECUTED a000bb64: eaffffa9 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED block = next_block; } while ( block != first_block ); return true; } a000bb68: e5946008 ldr r6, [r4, #8] int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; a000bb6c: 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 ) { a000bb70: e1540006 cmp r4, r6 a000bb74: 05943020 ldreq r3, [r4, #32] a000bb78: 0a00002b beq a000bc2c <_Heap_Walk+0x26c> block = next_block; } while ( block != first_block ); return true; } a000bb7c: 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; a000bb80: e1530006 cmp r3, r6 a000bb84: 8a0000c3 bhi a000be98 <_Heap_Walk+0x4d8> a000bb88: e594c024 ldr ip, [r4, #36] ; 0x24 a000bb8c: e15c0006 cmp ip, r6 a000bb90: 3a0000c0 bcc a000be98 <_Heap_Walk+0x4d8> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; a000bb94: e2860008 add r0, r6, #8 a000bb98: e1a01007 mov r1, r7 a000bb9c: e58d3020 str r3, [sp, #32] a000bba0: e58dc01c str ip, [sp, #28] a000bba4: ebffe518 bl a000500c <__umodsi3> ); return false; } if ( a000bba8: e3500000 cmp r0, #0 a000bbac: e59d3020 ldr r3, [sp, #32] a000bbb0: e59dc01c ldr ip, [sp, #28] a000bbb4: 1a0000d2 bne a000bf04 <_Heap_Walk+0x544> - 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; a000bbb8: e5962004 ldr r2, [r6, #4] a000bbbc: e3c22001 bic r2, r2, #1 block = next_block; } while ( block != first_block ); return true; } a000bbc0: e0862002 add r2, r6, 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; a000bbc4: e5922004 ldr r2, [r2, #4] ); return false; } if ( _Heap_Is_used( free_block ) ) { a000bbc8: e3120001 tst r2, #1 a000bbcc: 1a0000dc bne a000bf44 <_Heap_Walk+0x584> a000bbd0: e58d8030 str r8, [sp, #48] ; 0x30 a000bbd4: e58db034 str fp, [sp, #52] ; 0x34 a000bbd8: e1a02004 mov r2, r4 a000bbdc: e1a08003 mov r8, r3 a000bbe0: e1a0b00c mov fp, ip ); return false; } if ( free_block->prev != prev_block ) { a000bbe4: e596100c ldr r1, [r6, #12] a000bbe8: e1510002 cmp r1, r2 a000bbec: 1a0000cc bne a000bf24 <_Heap_Walk+0x564> return false; } prev_block = free_block; free_block = free_block->next; a000bbf0: e5965008 ldr r5, [r6, #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 ) { a000bbf4: e1540005 cmp r4, r5 a000bbf8: 0a000008 beq a000bc20 <_Heap_Walk+0x260> 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; a000bbfc: e1580005 cmp r8, r5 a000bc00: 9a000077 bls a000bde4 <_Heap_Walk+0x424> if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( a000bc04: e1a0000a mov r0, sl <== NOT EXECUTED a000bc08: e3a01001 mov r1, #1 <== NOT EXECUTED a000bc0c: e59f2360 ldr r2, [pc, #864] ; a000bf74 <_Heap_Walk+0x5b4> <== NOT EXECUTED a000bc10: e1a03005 mov r3, r5 <== NOT EXECUTED a000bc14: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bc18: e3a00000 mov r0, #0 <== NOT EXECUTED a000bc1c: eaffff7b b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED a000bc20: e1a03008 mov r3, r8 a000bc24: e59db034 ldr fp, [sp, #52] ; 0x34 a000bc28: e59d8030 ldr r8, [sp, #48] ; 0x30 ); return false; } if ( _Heap_Is_used( free_block ) ) { a000bc2c: 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; a000bc30: 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); a000bc34: 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; a000bc38: e1530005 cmp r3, r5 a000bc3c: 9a000007 bls a000bc60 <_Heap_Walk+0x2a0> 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)( a000bc40: e1a0000a mov r0, sl <== NOT EXECUTED a000bc44: e58d5000 str r5, [sp] <== NOT EXECUTED a000bc48: e3a01001 mov r1, #1 <== NOT EXECUTED a000bc4c: e59f2324 ldr r2, [pc, #804] ; a000bf78 <_Heap_Walk+0x5b8> <== NOT EXECUTED a000bc50: e1a03006 mov r3, r6 <== NOT EXECUTED a000bc54: e12fff39 blx r9 <== NOT EXECUTED "block 0x%08x: next block 0x%08x not in heap\n", block, next_block ); return false; a000bc58: e3a00000 mov r0, #0 <== NOT EXECUTED a000bc5c: eaffff6b b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED a000bc60: e5943024 ldr r3, [r4, #36] ; 0x24 a000bc64: e1530005 cmp r3, r5 a000bc68: 3afffff4 bcc a000bc40 <_Heap_Walk+0x280> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; a000bc6c: e59d1024 ldr r1, [sp, #36] ; 0x24 a000bc70: e1a00007 mov r0, r7 a000bc74: ebffe4e4 bl a000500c <__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; a000bc78: e59d102c ldr r1, [sp, #44] ; 0x2c a000bc7c: e0563001 subs r3, r6, r1 a000bc80: 13a03001 movne r3, #1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { a000bc84: e3500000 cmp r0, #0 a000bc88: 0a000001 beq a000bc94 <_Heap_Walk+0x2d4> a000bc8c: e3530000 cmp r3, #0 <== NOT EXECUTED a000bc90: 1a000082 bne a000bea0 <_Heap_Walk+0x4e0> <== NOT EXECUTED ); return false; } if ( block_size < min_block_size && is_not_last_block ) { a000bc94: e59d2028 ldr r2, [sp, #40] ; 0x28 a000bc98: e1520007 cmp r2, r7 a000bc9c: 9a000001 bls a000bca8 <_Heap_Walk+0x2e8> a000bca0: e3530000 cmp r3, #0 <== NOT EXECUTED a000bca4: 1a000085 bne a000bec0 <_Heap_Walk+0x500> <== NOT EXECUTED ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { a000bca8: e1560005 cmp r6, r5 a000bcac: 3a000001 bcc a000bcb8 <_Heap_Walk+0x2f8> a000bcb0: e3530000 cmp r3, #0 a000bcb4: 1a00008a bne a000bee4 <_Heap_Walk+0x524> 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; a000bcb8: e5953004 ldr r3, [r5, #4] a000bcbc: e20bb001 and fp, fp, #1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { a000bcc0: e3130001 tst r3, #1 a000bcc4: 0a000016 beq a000bd24 <_Heap_Walk+0x364> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { a000bcc8: e35b0000 cmp fp, #0 a000bccc: 0a00000b beq a000bd00 <_Heap_Walk+0x340> (*printer)( a000bcd0: e58d7000 str r7, [sp] a000bcd4: e1a0000a mov r0, sl a000bcd8: e3a01000 mov r1, #0 a000bcdc: e59f2298 ldr r2, [pc, #664] ; a000bf7c <_Heap_Walk+0x5bc> a000bce0: e1a03006 mov r3, r6 a000bce4: e12fff39 blx r9 block->prev_size ); } block = next_block; } while ( block != first_block ); a000bce8: e1580005 cmp r8, r5 a000bcec: 0affff46 beq a000ba0c <_Heap_Walk+0x4c> a000bcf0: e595b004 ldr fp, [r5, #4] a000bcf4: e5943020 ldr r3, [r4, #32] a000bcf8: e1a06005 mov r6, r5 a000bcfc: eaffffcb b a000bc30 <_Heap_Walk+0x270> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( a000bd00: e58d7000 str r7, [sp] a000bd04: e5963000 ldr r3, [r6] a000bd08: e1a0000a mov r0, sl a000bd0c: e1a0100b mov r1, fp a000bd10: e58d3004 str r3, [sp, #4] a000bd14: e59f2264 ldr r2, [pc, #612] ; a000bf80 <_Heap_Walk+0x5c0> a000bd18: e1a03006 mov r3, r6 a000bd1c: e12fff39 blx r9 a000bd20: eafffff0 b a000bce8 <_Heap_Walk+0x328> 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 ? a000bd24: 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)( a000bd28: e5943008 ldr r3, [r4, #8] block = next_block; } while ( block != first_block ); return true; } a000bd2c: 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)( a000bd30: e1530002 cmp r3, r2 a000bd34: 059f0248 ldreq r0, [pc, #584] ; a000bf84 <_Heap_Walk+0x5c4> a000bd38: 0a000003 beq a000bd4c <_Heap_Walk+0x38c> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), a000bd3c: e59f3244 ldr r3, [pc, #580] ; a000bf88 <_Heap_Walk+0x5c8> a000bd40: e1540002 cmp r4, r2 a000bd44: e59f0240 ldr r0, [pc, #576] ; a000bf8c <_Heap_Walk+0x5cc> a000bd48: 01a00003 moveq r0, r3 block->next, block->next == last_free_block ? a000bd4c: 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)( a000bd50: e1510003 cmp r1, r3 a000bd54: 059f1234 ldreq r1, [pc, #564] ; a000bf90 <_Heap_Walk+0x5d0> a000bd58: 0a000003 beq a000bd6c <_Heap_Walk+0x3ac> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") a000bd5c: e59fc230 ldr ip, [pc, #560] ; a000bf94 <_Heap_Walk+0x5d4> a000bd60: e1540003 cmp r4, r3 a000bd64: e59f1220 ldr r1, [pc, #544] ; a000bf8c <_Heap_Walk+0x5cc> a000bd68: 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)( a000bd6c: e58d2004 str r2, [sp, #4] a000bd70: e58d0008 str r0, [sp, #8] a000bd74: e58d300c str r3, [sp, #12] a000bd78: e58d1010 str r1, [sp, #16] a000bd7c: e1a03006 mov r3, r6 a000bd80: e58d7000 str r7, [sp] a000bd84: e1a0000a mov r0, sl a000bd88: e3a01000 mov r1, #0 a000bd8c: e59f2204 ldr r2, [pc, #516] ; a000bf98 <_Heap_Walk+0x5d8> a000bd90: e12fff39 blx r9 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { a000bd94: e5953000 ldr r3, [r5] a000bd98: e1570003 cmp r7, r3 a000bd9c: 1a000026 bne a000be3c <_Heap_Walk+0x47c> ); return false; } if ( !prev_used ) { a000bda0: e35b0000 cmp fp, #0 a000bda4: 0a00002e beq a000be64 <_Heap_Walk+0x4a4> block = next_block; } while ( block != first_block ); return true; } a000bda8: 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 ) { a000bdac: e1540003 cmp r4, r3 a000bdb0: 0a000004 beq a000bdc8 <_Heap_Walk+0x408> if ( free_block == block ) { a000bdb4: e1560003 cmp r6, r3 a000bdb8: 0affffca beq a000bce8 <_Heap_Walk+0x328> return true; } free_block = free_block->next; a000bdbc: 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 ) { a000bdc0: e1540003 cmp r4, r3 a000bdc4: 1afffffa bne a000bdb4 <_Heap_Walk+0x3f4> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( a000bdc8: e1a0000a mov r0, sl <== NOT EXECUTED a000bdcc: e3a01001 mov r1, #1 <== NOT EXECUTED a000bdd0: e59f21c4 ldr r2, [pc, #452] ; a000bf9c <_Heap_Walk+0x5dc> <== NOT EXECUTED a000bdd4: e1a03006 mov r3, r6 <== NOT EXECUTED a000bdd8: e12fff39 blx r9 <== NOT EXECUTED return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; a000bddc: e3a00000 mov r0, #0 <== NOT EXECUTED a000bde0: eaffff0a b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED 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; a000bde4: e155000b cmp r5, fp RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; a000bde8: e2850008 add r0, r5, #8 a000bdec: 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; a000bdf0: 8affff83 bhi a000bc04 <_Heap_Walk+0x244> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; a000bdf4: ebffe484 bl a000500c <__umodsi3> ); return false; } if ( a000bdf8: e3500000 cmp r0, #0 a000bdfc: 1a000041 bne a000bf08 <_Heap_Walk+0x548> - 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; a000be00: e5953004 ldr r3, [r5, #4] ); return false; } if ( _Heap_Is_used( free_block ) ) { a000be04: e1a02006 mov r2, r6 a000be08: e1a06005 mov r6, r5 a000be0c: e3c33001 bic r3, r3, #1 block = next_block; } while ( block != first_block ); return true; } a000be10: 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; a000be14: e5933004 ldr r3, [r3, #4] ); return false; } if ( _Heap_Is_used( free_block ) ) { a000be18: e3130001 tst r3, #1 a000be1c: 0affff70 beq a000bbe4 <_Heap_Walk+0x224> (*printer)( a000be20: e1a0000a mov r0, sl <== NOT EXECUTED a000be24: e3a01001 mov r1, #1 <== NOT EXECUTED a000be28: e59f2170 ldr r2, [pc, #368] ; a000bfa0 <_Heap_Walk+0x5e0> <== NOT EXECUTED a000be2c: e1a03005 mov r3, r5 <== NOT EXECUTED a000be30: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000be34: e3a00000 mov r0, #0 <== NOT EXECUTED a000be38: eafffef4 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( a000be3c: e58d3004 str r3, [sp, #4] <== NOT EXECUTED a000be40: e1a0000a mov r0, sl <== NOT EXECUTED a000be44: e58d7000 str r7, [sp] <== NOT EXECUTED a000be48: e58d5008 str r5, [sp, #8] <== NOT EXECUTED a000be4c: e3a01001 mov r1, #1 <== NOT EXECUTED a000be50: e59f214c ldr r2, [pc, #332] ; a000bfa4 <_Heap_Walk+0x5e4> <== NOT EXECUTED a000be54: e1a03006 mov r3, r6 <== NOT EXECUTED a000be58: e12fff39 blx r9 <== NOT EXECUTED return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; a000be5c: e3a00000 mov r0, #0 <== NOT EXECUTED a000be60: eafffeea b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED return false; } if ( !prev_used ) { (*printer)( a000be64: e1a0000a mov r0, sl <== NOT EXECUTED a000be68: e3a01001 mov r1, #1 <== NOT EXECUTED a000be6c: e59f2134 ldr r2, [pc, #308] ; a000bfa8 <_Heap_Walk+0x5e8> <== NOT EXECUTED a000be70: e1a03006 mov r3, r6 <== NOT EXECUTED a000be74: e12fff39 blx r9 <== NOT EXECUTED return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; a000be78: e1a0000b mov r0, fp <== NOT EXECUTED a000be7c: eafffee3 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( a000be80: e1a0000a mov r0, sl <== NOT EXECUTED a000be84: e3a01001 mov r1, #1 <== NOT EXECUTED a000be88: e59f211c ldr r2, [pc, #284] ; a000bfac <_Heap_Walk+0x5ec> <== NOT EXECUTED a000be8c: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000be90: e1a00005 mov r0, r5 <== NOT EXECUTED a000be94: eafffedd b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED 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; a000be98: e1a05006 mov r5, r6 <== NOT EXECUTED a000be9c: eaffff58 b a000bc04 <_Heap_Walk+0x244> <== NOT EXECUTED return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( a000bea0: e1a0000a mov r0, sl <== NOT EXECUTED a000bea4: e58d7000 str r7, [sp] <== NOT EXECUTED a000bea8: e3a01001 mov r1, #1 <== NOT EXECUTED a000beac: e59f20fc ldr r2, [pc, #252] ; a000bfb0 <_Heap_Walk+0x5f0> <== NOT EXECUTED a000beb0: e1a03006 mov r3, r6 <== NOT EXECUTED a000beb4: e12fff39 blx r9 <== NOT EXECUTED "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; a000beb8: e3a00000 mov r0, #0 <== NOT EXECUTED a000bebc: eafffed3 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( a000bec0: e58d2004 str r2, [sp, #4] <== NOT EXECUTED a000bec4: e1a0000a mov r0, sl <== NOT EXECUTED a000bec8: e58d7000 str r7, [sp] <== NOT EXECUTED a000becc: e3a01001 mov r1, #1 <== NOT EXECUTED a000bed0: e59f20dc ldr r2, [pc, #220] ; a000bfb4 <_Heap_Walk+0x5f4> <== NOT EXECUTED a000bed4: e1a03006 mov r3, r6 <== NOT EXECUTED a000bed8: e12fff39 blx r9 <== NOT EXECUTED block, block_size, min_block_size ); return false; a000bedc: e3a00000 mov r0, #0 <== NOT EXECUTED a000bee0: eafffeca b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( a000bee4: e1a0000a mov r0, sl <== NOT EXECUTED a000bee8: e58d5000 str r5, [sp] <== NOT EXECUTED a000beec: e3a01001 mov r1, #1 <== NOT EXECUTED a000bef0: e59f20c0 ldr r2, [pc, #192] ; a000bfb8 <_Heap_Walk+0x5f8> <== NOT EXECUTED a000bef4: e1a03006 mov r3, r6 <== NOT EXECUTED a000bef8: e12fff39 blx r9 <== NOT EXECUTED "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; a000befc: e3a00000 mov r0, #0 <== NOT EXECUTED a000bf00: eafffec2 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED ); return false; } if ( a000bf04: e1a05006 mov r5, r6 <== NOT EXECUTED !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( a000bf08: e1a0000a mov r0, sl <== NOT EXECUTED a000bf0c: e3a01001 mov r1, #1 <== NOT EXECUTED a000bf10: e59f20a4 ldr r2, [pc, #164] ; a000bfbc <_Heap_Walk+0x5fc> <== NOT EXECUTED a000bf14: e1a03005 mov r3, r5 <== NOT EXECUTED a000bf18: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bf1c: e3a00000 mov r0, #0 <== NOT EXECUTED a000bf20: eafffeba b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED return false; } if ( free_block->prev != prev_block ) { (*printer)( a000bf24: e58d1000 str r1, [sp] <== NOT EXECUTED a000bf28: e1a0000a mov r0, sl <== NOT EXECUTED a000bf2c: e3a01001 mov r1, #1 <== NOT EXECUTED a000bf30: e59f2088 ldr r2, [pc, #136] ; a000bfc0 <_Heap_Walk+0x600> <== NOT EXECUTED a000bf34: e1a03006 mov r3, r6 <== NOT EXECUTED a000bf38: e12fff39 blx r9 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; a000bf3c: e3a00000 mov r0, #0 <== NOT EXECUTED a000bf40: eafffeb2 b a000ba10 <_Heap_Walk+0x50> <== NOT EXECUTED ); return false; } if ( _Heap_Is_used( free_block ) ) { a000bf44: e1a05006 mov r5, r6 <== NOT EXECUTED a000bf48: eaffffb4 b a000be20 <_Heap_Walk+0x460> <== NOT EXECUTED =============================================================================== a000b968 <_Heap_Walk_print>: static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { a000b968: e92d000c push {r2, r3} <== NOT EXECUTED a000b96c: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED va_list ap; if ( error ) { a000b970: e31100ff tst r1, #255 ; 0xff <== NOT EXECUTED { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { a000b974: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a000b978: e1a01000 mov r1, r0 <== NOT EXECUTED va_list ap; if ( error ) { a000b97c: 1a00000a bne a000b9ac <_Heap_Walk_print+0x44> <== NOT EXECUTED printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); a000b980: e59f0030 ldr r0, [pc, #48] ; a000b9b8 <_Heap_Walk_print+0x50><== NOT EXECUTED a000b984: ebfff03a bl a0007a74 <== NOT EXECUTED } va_start( ap, fmt ); a000b988: e28d300c add r3, sp, #12 <== NOT EXECUTED vprintk( fmt, ap ); a000b98c: e59d0008 ldr r0, [sp, #8] <== NOT EXECUTED a000b990: e1a01003 mov r1, r3 <== NOT EXECUTED printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); a000b994: e58d3000 str r3, [sp] <== NOT EXECUTED vprintk( fmt, ap ); a000b998: ebfff7bb bl a000988c <== NOT EXECUTED va_end( ap ); } a000b99c: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000b9a0: e49de004 pop {lr} ; (ldr lr, [sp], #4) <== NOT EXECUTED a000b9a4: e28dd008 add sp, sp, #8 <== NOT EXECUTED a000b9a8: e12fff1e bx lr <== NOT EXECUTED static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { va_list ap; if ( error ) { printk( "FAIL[%d]: ", source ); a000b9ac: e59f0008 ldr r0, [pc, #8] ; a000b9bc <_Heap_Walk_print+0x54><== NOT EXECUTED a000b9b0: ebfff02f bl a0007a74 <== NOT EXECUTED a000b9b4: eafffff3 b a000b988 <_Heap_Walk_print+0x20> <== NOT EXECUTED =============================================================================== a000ada0 <_Internal_error_Occurred>: bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; a000ada0: e59f303c ldr r3, [pc, #60] ; a000ade4 <_Internal_error_Occurred+0x44> void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { a000ada4: e201c0ff and ip, r1, #255 ; 0xff a000ada8: e52de004 push {lr} ; (str lr, [sp, #-4]!) _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); a000adac: e1a0100c mov r1, ip bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; a000adb0: e5830000 str r0, [r3] _Internal_errors_What_happened.is_internal = is_internal; a000adb4: e5c3c004 strb ip, [r3, #4] _Internal_errors_What_happened.the_error = the_error; a000adb8: e5832008 str r2, [r3, #8] void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { a000adbc: e1a04002 mov r4, r2 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); a000adc0: eb000781 bl a000cbcc <_User_extensions_Fatal> RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; a000adc4: e59f301c ldr r3, [pc, #28] ; a000ade8 <_Internal_error_Occurred+0x48><== NOT EXECUTED a000adc8: e3a02005 mov r2, #5 <== NOT EXECUTED a000adcc: e5832000 str r2, [r3] <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000add0: e10f2000 mrs r2, CPSR <== NOT EXECUTED a000add4: e3823080 orr r3, r2, #128 ; 0x80 <== NOT EXECUTED a000add8: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); a000addc: e1a00004 mov r0, r4 <== NOT EXECUTED a000ade0: eafffffe b a000ade0 <_Internal_error_Occurred+0x40> <== NOT EXECUTED =============================================================================== a000aea8 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { a000aea8: 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 ) a000aeac: e5904034 ldr r4, [r0, #52] ; 0x34 */ void _Objects_Extend_information( Objects_Information *information ) { a000aeb0: e24dd014 sub sp, sp, #20 a000aeb4: e1a05000 mov r5, r0 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) a000aeb8: e3540000 cmp r4, #0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); a000aebc: e1d070b8 ldrh r7, [r0, #8] index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) a000aec0: 0a00009c beq a000b138 <_Objects_Extend_information+0x290> block_count = 0; else { block_count = information->maximum / information->allocation_size; a000aec4: e1d081b4 ldrh r8, [r0, #20] a000aec8: e1d0a1b0 ldrh sl, [r0, #16] a000aecc: e1a01008 mov r1, r8 a000aed0: e1a0000a mov r0, sl a000aed4: eb002677 bl a00148b8 <__aeabi_uidiv> a000aed8: e1a03800 lsl r3, r0, #16 for ( ; block < block_count; block++ ) { a000aedc: e1b03823 lsrs r3, r3, #16 a000aee0: 0a00009a beq a000b150 <_Objects_Extend_information+0x2a8> if ( information->object_blocks[ block ] == NULL ) { a000aee4: e5949000 ldr r9, [r4] a000aee8: e3590000 cmp r9, #0 a000aeec: 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 ); a000aef0: 01a06007 moveq r6, r7 index_base = minimum_index; block = 0; a000aef4: 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 ) { a000aef8: 0a00000c beq a000af30 <_Objects_Extend_information+0x88> a000aefc: e1a02004 mov r2, r4 a000af00: 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 ); a000af04: e1a06007 mov r6, r7 index_base = minimum_index; block = 0; a000af08: e3a04000 mov r4, #0 a000af0c: ea000002 b a000af1c <_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 ) { a000af10: e5b29004 ldr r9, [r2, #4]! a000af14: e3590000 cmp r9, #0 a000af18: 0a000004 beq a000af30 <_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++ ) { a000af1c: e2844001 add r4, r4, #1 a000af20: e1530004 cmp r3, r4 if ( information->object_blocks[ block ] == NULL ) { do_extend = false; break; } else index_base += information->allocation_size; a000af24: 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++ ) { a000af28: 8afffff8 bhi a000af10 <_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; a000af2c: e3a09001 mov r9, #1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; a000af30: 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 ) { a000af34: e35a0801 cmp sl, #65536 ; 0x10000 a000af38: 2a000064 bcs a000b0d0 <_Objects_Extend_information+0x228> /* * 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 ) { a000af3c: 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; a000af40: e5950018 ldr r0, [r5, #24] if ( information->auto_extend ) { a000af44: 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; a000af48: e0000091 mul r0, r1, r0 if ( information->auto_extend ) { a000af4c: 1a000061 bne a000b0d8 <_Objects_Extend_information+0x230> new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); a000af50: e58d3000 str r3, [sp] a000af54: eb000864 bl a000d0ec <_Workspace_Allocate_or_fatal_error> a000af58: e59d3000 ldr r3, [sp] a000af5c: e1a08000 mov r8, r0 } /* * Do we need to grow the tables? */ if ( do_extend ) { a000af60: e3590000 cmp r9, #0 a000af64: 0a00003a beq a000b054 <_Objects_Extend_information+0x1ac> */ /* * Up the block count and maximum */ block_count++; a000af68: e283b001 add fp, r3, #1 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + a000af6c: e08b008b add r0, fp, fp, lsl #1 ((maximum + minimum_index) * sizeof(Objects_Control *)); a000af70: e08a0000 add r0, sl, r0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + a000af74: e0800007 add r0, r0, r7 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); a000af78: e1a00100 lsl r0, r0, #2 a000af7c: e58d3000 str r3, [sp] a000af80: eb00084f bl a000d0c4 <_Workspace_Allocate> if ( !object_blocks ) { a000af84: e2509000 subs r9, r0, #0 a000af88: e59d3000 ldr r3, [sp] a000af8c: 0a000074 beq a000b164 <_Objects_Extend_information+0x2bc> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { a000af90: e1d521b0 ldrh r2, [r5, #16] RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); a000af94: e089c10b add ip, r9, fp, lsl #2 a000af98: e089b18b add fp, r9, fp, lsl #3 a000af9c: e1570002 cmp r7, r2 a000afa0: 3a000052 bcc a000b0f0 <_Objects_Extend_information+0x248> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { a000afa4: e3570000 cmp r7, #0 a000afa8: 13a02000 movne r2, #0 a000afac: 11a0100b movne r1, fp local_table[ index ] = NULL; a000afb0: 11a00002 movne r0, r2 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { a000afb4: 0a000003 beq a000afc8 <_Objects_Extend_information+0x120> a000afb8: e2822001 add r2, r2, #1 a000afbc: e1570002 cmp r7, r2 local_table[ index ] = NULL; a000afc0: e4810004 str r0, [r1], #4 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { a000afc4: 8afffffb bhi a000afb8 <_Objects_Extend_information+0x110> a000afc8: 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 ); a000afcc: e1d511b4 ldrh r1, [r5, #20] } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; a000afd0: e3a00000 mov r0, #0 a000afd4: e7890003 str r0, [r9, r3] inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); a000afd8: e0861001 add r1, r6, r1 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; a000afdc: e1560001 cmp r6, r1 /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; a000afe0: e78c0003 str r0, [ip, r3] for ( index=index_base ; a000afe4: 2a000005 bcs a000b000 <_Objects_Extend_information+0x158> a000afe8: e08b2106 add r2, fp, r6, lsl #2 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( a000afec: 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++ ) { a000aff0: 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 ; a000aff4: e1530001 cmp r3, r1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; a000aff8: 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 ; a000affc: 3afffffb bcc a000aff0 <_Objects_Extend_information+0x148> a000b000: e10f3000 mrs r3, CPSR a000b004: e3832080 orr r2, r3, #128 ; 0x80 a000b008: e129f002 msr CPSR_fc, r2 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | a000b00c: 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( a000b010: e1d510b4 ldrh r1, [r5, #4] 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; a000b014: e1a0a80a lsl sl, sl, #16 a000b018: e1a02c02 lsl r2, r2, #24 a000b01c: e3822801 orr r2, r2, #65536 ; 0x10000 a000b020: e1a0a82a lsr sl, sl, #16 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | a000b024: 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) | a000b028: e182200a orr r2, r2, sl local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; a000b02c: e5950034 ldr r0, [r5, #52] ; 0x34 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; a000b030: e585c030 str ip, [r5, #48] ; 0x30 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; a000b034: e5859034 str r9, [r5, #52] ; 0x34 information->inactive_per_block = inactive_per_block; information->local_table = local_table; a000b038: e585b01c str fp, [r5, #28] information->maximum = (Objects_Maximum) maximum; a000b03c: e1c5a1b0 strh sl, [r5, #16] information->maximum_id = _Objects_Build_id( a000b040: e585200c str r2, [r5, #12] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000b044: e129f003 msr CPSR_fc, r3 information->maximum ); _ISR_Enable( level ); if ( old_tables ) a000b048: e3500000 cmp r0, #0 a000b04c: 0a000000 beq a000b054 <_Objects_Extend_information+0x1ac> _Workspace_Free( old_tables ); a000b050: eb000821 bl a000d0dc <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; a000b054: e5953034 ldr r3, [r5, #52] ; 0x34 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( a000b058: e28d7008 add r7, sp, #8 a000b05c: e1a01008 mov r1, r8 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; a000b060: e7838104 str r8, [r3, r4, lsl #2] /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( a000b064: e1a00007 mov r0, r7 a000b068: e1d521b4 ldrh r2, [r5, #20] a000b06c: e5953018 ldr r3, [r5, #24] a000b070: eb000ff5 bl a000f04c <_Chain_Initialize> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; a000b074: e1a04104 lsl r4, r4, #2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); a000b078: 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 ) { a000b07c: ea000009 b a000b0a8 <_Objects_Extend_information+0x200> a000b080: e5953000 ldr r3, [r5] the_object->id = _Objects_Build_id( a000b084: e1d520b4 ldrh r2, [r5, #4] information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); a000b088: e1a00008 mov r0, r8 a000b08c: e1a03c03 lsl r3, r3, #24 a000b090: e3833801 orr r3, r3, #65536 ; 0x10000 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | a000b094: 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) | a000b098: e1833006 orr r3, r3, r6 */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { the_object->id = _Objects_Build_id( a000b09c: e5813008 str r3, [r1, #8] information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); a000b0a0: ebfffce3 bl a000a434 <_Chain_Append> index++; a000b0a4: 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 ) { a000b0a8: e1a00007 mov r0, r7 a000b0ac: ebfffcf3 bl a000a480 <_Chain_Get> a000b0b0: e2501000 subs r1, r0, #0 a000b0b4: 1afffff1 bne a000b080 <_Objects_Extend_information+0x1d8> index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); a000b0b8: e1d522bc ldrh r2, [r5, #44] ; 0x2c _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; a000b0bc: e1d531b4 ldrh r3, [r5, #20] a000b0c0: e5951030 ldr r1, [r5, #48] ; 0x30 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); a000b0c4: e0832002 add r2, r3, r2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; a000b0c8: e7813004 str r3, [r1, r4] information->inactive = a000b0cc: e1c522bc strh r2, [r5, #44] ; 0x2c (Objects_Maximum)(information->inactive + information->allocation_size); } a000b0d0: e28dd014 add sp, sp, #20 a000b0d4: 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 ); a000b0d8: e58d3000 str r3, [sp] a000b0dc: eb0007f8 bl a000d0c4 <_Workspace_Allocate> if ( !new_object_block ) a000b0e0: e2508000 subs r8, r0, #0 a000b0e4: e59d3000 ldr r3, [sp] a000b0e8: 1affff9c bne a000af60 <_Objects_Extend_information+0xb8> a000b0ec: eafffff7 b a000b0d0 <_Objects_Extend_information+0x228> /* * 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, a000b0f0: e1a03103 lsl r3, r3, #2 a000b0f4: e5951034 ldr r1, [r5, #52] ; 0x34 a000b0f8: e1a02003 mov r2, r3 a000b0fc: e88d1008 stm sp, {r3, ip} a000b100: eb001a57 bl a0011a64 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, a000b104: e89d1008 ldm sp, {r3, ip} a000b108: e5951030 ldr r1, [r5, #48] ; 0x30 a000b10c: e1a0000c mov r0, ip a000b110: e1a02003 mov r2, r3 a000b114: eb001a52 bl a0011a64 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); a000b118: e1d521b0 ldrh r2, [r5, #16] information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, a000b11c: e1a0000b mov r0, fp a000b120: e595101c ldr r1, [r5, #28] information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); a000b124: 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, a000b128: e1a02102 lsl r2, r2, #2 a000b12c: eb001a4c bl a0011a64 a000b130: e89d1008 ldm sp, {r3, ip} a000b134: eaffffa4 b a000afcc <_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 ) a000b138: e1d0a1b0 ldrh sl, [r0, #16] a000b13c: 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 ); a000b140: 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; a000b144: e3a09001 mov r9, #1 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; a000b148: e1a03004 mov r3, r4 a000b14c: eaffff77 b a000af30 <_Objects_Extend_information+0x88> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { a000b150: 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 ); a000b154: 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; a000b158: e3a09001 mov r9, #1 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; a000b15c: e1a04003 mov r4, r3 <== NOT EXECUTED a000b160: eaffff72 b a000af30 <_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 ); a000b164: e1a00008 mov r0, r8 a000b168: eb0007db bl a000d0dc <_Workspace_Free> return; a000b16c: eaffffd7 b a000b0d0 <_Objects_Extend_information+0x228> =============================================================================== a000b1fc <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { a000b1fc: e1a01801 lsl r1, r1, #16 a000b200: e92d4030 push {r4, r5, lr} Objects_Information *info; int the_class_api_maximum; if ( !the_class ) a000b204: e1b04821 lsrs r4, r1, #16 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { a000b208: e1a05000 mov r5, r0 Objects_Information *info; int the_class_api_maximum; if ( !the_class ) a000b20c: 1a000001 bne a000b218 <_Objects_Get_information+0x1c> return NULL; a000b210: e1a00004 mov r0, r4 <== NOT EXECUTED a000b214: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED /* * This call implicitly validates the_api so we do not call * _Objects_Is_api_valid above here. */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); a000b218: eb00111a bl a000f688 <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) a000b21c: e3500000 cmp r0, #0 a000b220: 1a000000 bne a000b228 <_Objects_Get_information+0x2c> if ( info->maximum == 0 ) return NULL; #endif return info; } a000b224: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); if ( the_class_api_maximum == 0 ) return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) a000b228: e1500004 cmp r0, r4 return NULL; a000b22c: 33a00000 movcc r0, #0 */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); if ( the_class_api_maximum == 0 ) return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) a000b230: 3afffffb bcc a000b224 <_Objects_Get_information+0x28> return NULL; if ( !_Objects_Information_table[ the_api ] ) a000b234: e59f3024 ldr r3, [pc, #36] ; a000b260 <_Objects_Get_information+0x64> a000b238: e7930105 ldr r0, [r3, r5, lsl #2] a000b23c: e3500000 cmp r0, #0 a000b240: 0afffff7 beq a000b224 <_Objects_Get_information+0x28> return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; a000b244: e7900104 ldr r0, [r0, r4, lsl #2] if ( !info ) a000b248: e3500000 cmp r0, #0 a000b24c: 0afffff4 beq a000b224 <_Objects_Get_information+0x28> * In a multprocessing configuration, we may access remote objects. * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) a000b250: e1d031b0 ldrh r3, [r0, #16] return NULL; a000b254: e3530000 cmp r3, #0 a000b258: 03a00000 moveq r0, #0 a000b25c: e8bd8030 pop {r4, r5, pc} =============================================================================== a000b264 <_Objects_Get_isr_disable>: { Objects_Control *the_object; uint32_t index; ISR_Level level; index = id - information->minimum_id + 1; a000b264: e590c008 ldr ip, [r0, #8] Objects_Information *information, Objects_Id id, Objects_Locations *location, ISR_Level *level_p ) { a000b268: e52d4004 push {r4} ; (str r4, [sp, #-4]!) Objects_Control *the_object; uint32_t index; ISR_Level level; index = id - information->minimum_id + 1; a000b26c: e26cc001 rsb ip, ip, #1 a000b270: e08cc001 add ip, ip, r1 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000b274: e10f4000 mrs r4, CPSR a000b278: e3841080 orr r1, r4, #128 ; 0x80 a000b27c: e129f001 msr CPSR_fc, r1 _ISR_Disable( level ); if ( information->maximum >= index ) { a000b280: e1d011b0 ldrh r1, [r0, #16] a000b284: e15c0001 cmp ip, r1 a000b288: 8a000008 bhi a000b2b0 <_Objects_Get_isr_disable+0x4c> if ( (the_object = information->local_table[ index ]) != NULL ) { a000b28c: e590101c ldr r1, [r0, #28] a000b290: e791010c ldr r0, [r1, ip, lsl #2] a000b294: e3500000 cmp r0, #0 *location = OBJECTS_LOCAL; a000b298: 13a01000 movne r1, #0 a000b29c: 15821000 strne r1, [r2] *level_p = level; a000b2a0: 15834000 strne r4, [r3] index = id - information->minimum_id + 1; _ISR_Disable( level ); if ( information->maximum >= index ) { if ( (the_object = information->local_table[ index ]) != NULL ) { a000b2a4: 0a000006 beq a000b2c4 <_Objects_Get_isr_disable+0x60> _Objects_MP_Is_remote( information, id, location, &the_object ); return the_object; #else return NULL; #endif } a000b2a8: e8bd0010 pop {r4} a000b2ac: e12fff1e bx lr static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000b2b0: e129f004 msr CPSR_fc, r4 <== NOT EXECUTED _ISR_Enable( level ); *location = OBJECTS_ERROR; return NULL; } _ISR_Enable( level ); *location = OBJECTS_ERROR; a000b2b4: e3a03001 mov r3, #1 <== NOT EXECUTED a000b2b8: e5823000 str r3, [r2] <== NOT EXECUTED #if defined(RTEMS_MULTIPROCESSING) _Objects_MP_Is_remote( information, id, location, &the_object ); return the_object; #else return NULL; a000b2bc: e3a00000 mov r0, #0 <== NOT EXECUTED a000b2c0: eafffff8 b a000b2a8 <_Objects_Get_isr_disable+0x44> <== NOT EXECUTED a000b2c4: e129f004 msr CPSR_fc, r4 <== NOT EXECUTED *location = OBJECTS_LOCAL; *level_p = level; return the_object; } _ISR_Enable( level ); *location = OBJECTS_ERROR; a000b2c8: e3a03001 mov r3, #1 <== NOT EXECUTED a000b2cc: e5823000 str r3, [r2] <== NOT EXECUTED return NULL; a000b2d0: eafffff4 b a000b2a8 <_Objects_Get_isr_disable+0x44> <== NOT EXECUTED =============================================================================== a000ce00 <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { a000ce00: e92d4070 push {r4, r5, r6, lr} <== NOT EXECUTED char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) a000ce04: e2515000 subs r5, r1, #0 <== NOT EXECUTED char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { a000ce08: e1a04002 mov r4, r2 <== NOT EXECUTED a000ce0c: e24dd00c sub sp, sp, #12 <== NOT EXECUTED Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) return NULL; a000ce10: 01a04005 moveq r4, r5 <== NOT EXECUTED char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) a000ce14: 1a000002 bne a000ce24 <_Objects_Get_name_as_string+0x24> <== NOT EXECUTED _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } a000ce18: e1a00004 mov r0, r4 <== NOT EXECUTED a000ce1c: e28dd00c add sp, sp, #12 <== NOT EXECUTED a000ce20: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) a000ce24: e3540000 cmp r4, #0 <== NOT EXECUTED a000ce28: 0afffffa beq a000ce18 <_Objects_Get_name_as_string+0x18> <== NOT EXECUTED return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; a000ce2c: e3500000 cmp r0, #0 <== NOT EXECUTED a000ce30: 059f30c4 ldreq r3, [pc, #196] ; a000cefc <_Objects_Get_name_as_string+0xfc><== NOT EXECUTED a000ce34: 11a06000 movne r6, r0 <== NOT EXECUTED a000ce38: 05933004 ldreq r3, [r3, #4] <== NOT EXECUTED a000ce3c: 05936008 ldreq r6, [r3, #8] <== NOT EXECUTED information = _Objects_Get_information_id( tmpId ); a000ce40: e1a00006 mov r0, r6 <== NOT EXECUTED a000ce44: ebffffb2 bl a000cd14 <_Objects_Get_information_id> <== NOT EXECUTED if ( !information ) a000ce48: e2503000 subs r3, r0, #0 <== NOT EXECUTED return NULL; a000ce4c: 01a04003 moveq r4, r3 <== NOT EXECUTED return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; information = _Objects_Get_information_id( tmpId ); if ( !information ) a000ce50: 0afffff0 beq a000ce18 <_Objects_Get_name_as_string+0x18> <== NOT EXECUTED return NULL; the_object = _Objects_Get( information, tmpId, &location ); a000ce54: e1a01006 mov r1, r6 <== NOT EXECUTED a000ce58: e28d2008 add r2, sp, #8 <== NOT EXECUTED a000ce5c: eb000028 bl a000cf04 <_Objects_Get> <== NOT EXECUTED switch ( location ) { a000ce60: e59d3008 ldr r3, [sp, #8] <== NOT EXECUTED a000ce64: e3530000 cmp r3, #0 <== NOT EXECUTED #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; a000ce68: 13a04000 movne r4, #0 <== NOT EXECUTED information = _Objects_Get_information_id( tmpId ); if ( !information ) return NULL; the_object = _Objects_Get( information, tmpId, &location ); switch ( location ) { a000ce6c: 1affffe9 bne a000ce18 <_Objects_Get_name_as_string+0x18> <== NOT EXECUTED if ( information->is_string ) { s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; a000ce70: e590100c ldr r1, [r0, #12] <== NOT EXECUTED s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { a000ce74: e2555001 subs r5, r5, #1 <== NOT EXECUTED lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; a000ce78: e5cd3004 strb r3, [sp, #4] <== NOT EXECUTED } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; a000ce7c: e1a02c21 lsr r2, r1, #24 <== NOT EXECUTED lname[ 1 ] = (u32_name >> 16) & 0xff; a000ce80: e1a0c821 lsr ip, r1, #16 <== NOT EXECUTED lname[ 2 ] = (u32_name >> 8) & 0xff; a000ce84: e1a00421 lsr r0, r1, #8 <== NOT EXECUTED } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; a000ce88: e5cd2000 strb r2, [sp] <== NOT EXECUTED lname[ 1 ] = (u32_name >> 16) & 0xff; a000ce8c: e5cdc001 strb ip, [sp, #1] <== NOT EXECUTED lname[ 2 ] = (u32_name >> 8) & 0xff; a000ce90: e5cd0002 strb r0, [sp, #2] <== NOT EXECUTED lname[ 3 ] = (u32_name >> 0) & 0xff; a000ce94: e5cd1003 strb r1, [sp, #3] <== NOT EXECUTED s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { a000ce98: 0a000015 beq a000cef4 <_Objects_Get_name_as_string+0xf4> <== NOT EXECUTED a000ce9c: e3520000 cmp r2, #0 <== NOT EXECUTED a000cea0: 0a000013 beq a000cef4 <_Objects_Get_name_as_string+0xf4> <== NOT EXECUTED a000cea4: e59fc054 ldr ip, [pc, #84] ; a000cf00 <_Objects_Get_name_as_string+0x100><== NOT EXECUTED a000cea8: e1a01004 mov r1, r4 <== NOT EXECUTED a000ceac: ea000002 b a000cebc <_Objects_Get_name_as_string+0xbc> <== NOT EXECUTED a000ceb0: e7dd2003 ldrb r2, [sp, r3] <== NOT EXECUTED a000ceb4: e3520000 cmp r2, #0 <== NOT EXECUTED a000ceb8: 0a000009 beq a000cee4 <_Objects_Get_name_as_string+0xe4> <== NOT EXECUTED *d = (isprint((unsigned char)*s)) ? *s : '*'; a000cebc: e59c0000 ldr r0, [ip] <== NOT EXECUTED s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { a000cec0: e2833001 add r3, r3, #1 <== NOT EXECUTED *d = (isprint((unsigned char)*s)) ? *s : '*'; a000cec4: e0800002 add r0, r0, r2 <== NOT EXECUTED a000cec8: e5d00001 ldrb r0, [r0, #1] <== NOT EXECUTED a000cecc: e3100097 tst r0, #151 ; 0x97 <== NOT EXECUTED a000ced0: 03a0202a moveq r2, #42 ; 0x2a <== NOT EXECUTED a000ced4: e4c12001 strb r2, [r1], #1 <== NOT EXECUTED s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { a000ced8: e1530005 cmp r3, r5 <== NOT EXECUTED a000cedc: e1a00001 mov r0, r1 <== NOT EXECUTED a000cee0: 3afffff2 bcc a000ceb0 <_Objects_Get_name_as_string+0xb0> <== NOT EXECUTED *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; a000cee4: e3a03000 mov r3, #0 <== NOT EXECUTED a000cee8: e5c03000 strb r3, [r0] <== NOT EXECUTED _Thread_Enable_dispatch(); a000ceec: eb0002e0 bl a000da74 <_Thread_Enable_dispatch> <== NOT EXECUTED return name; a000cef0: eaffffc8 b a000ce18 <_Objects_Get_name_as_string+0x18> <== NOT EXECUTED s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { a000cef4: e1a00004 mov r0, r4 <== NOT EXECUTED a000cef8: eafffff9 b a000cee4 <_Objects_Get_name_as_string+0xe4> <== NOT EXECUTED =============================================================================== a001cbb4 <_Objects_Get_no_protection>: /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; a001cbb4: e590c008 ldr ip, [r0, #8] if ( information->maximum >= index ) { a001cbb8: e1d031b0 ldrh r3, [r0, #16] /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; a001cbbc: e26cc001 rsb ip, ip, #1 a001cbc0: e08cc001 add ip, ip, r1 if ( information->maximum >= index ) { a001cbc4: e15c0003 cmp ip, r3 a001cbc8: 8a000005 bhi a001cbe4 <_Objects_Get_no_protection+0x30> if ( (the_object = information->local_table[ index ]) != NULL ) { a001cbcc: e590301c ldr r3, [r0, #28] a001cbd0: e793010c ldr r0, [r3, ip, lsl #2] a001cbd4: e3500000 cmp r0, #0 *location = OBJECTS_LOCAL; a001cbd8: 13a03000 movne r3, #0 a001cbdc: 15823000 strne r3, [r2] * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; if ( information->maximum >= index ) { if ( (the_object = information->local_table[ index ]) != NULL ) { a001cbe0: 112fff1e bxne lr /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; a001cbe4: e3a03001 mov r3, #1 a001cbe8: e5823000 str r3, [r2] return NULL; a001cbec: e3a00000 mov r0, #0 } a001cbf0: e12fff1e bx lr =============================================================================== a000c9e0 <_Objects_Id_to_name>: /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; a000c9e0: e3500000 cmp r0, #0 a000c9e4: 059f3078 ldreq r3, [pc, #120] ; a000ca64 <_Objects_Id_to_name+0x84> */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { a000c9e8: e92d4010 push {r4, lr} /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; a000c9ec: 05933004 ldreq r3, [r3, #4] */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { a000c9f0: e1a04001 mov r4, r1 /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; a000c9f4: 11a01000 movne r1, r0 a000c9f8: 05931008 ldreq r1, [r3, #8] */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { a000c9fc: e24dd004 sub sp, sp, #4 a000ca00: e1a03c21 lsr r3, r1, #24 a000ca04: e2033007 and r3, r3, #7 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) a000ca08: e2432001 sub r2, r3, #1 a000ca0c: e3520002 cmp r2, #2 a000ca10: 8a000010 bhi a000ca58 <_Objects_Id_to_name+0x78> the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) a000ca14: e59f204c ldr r2, [pc, #76] ; a000ca68 <_Objects_Id_to_name+0x88> a000ca18: e7923103 ldr r3, [r2, r3, lsl #2] a000ca1c: e3530000 cmp r3, #0 a000ca20: 0a00000c beq a000ca58 <_Objects_Id_to_name+0x78> */ RTEMS_INLINE_ROUTINE uint32_t _Objects_Get_class( Objects_Id id ) { return (uint32_t) a000ca24: e1a02da1 lsr r2, r1, #27 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; a000ca28: e7930102 ldr r0, [r3, r2, lsl #2] if ( !information ) a000ca2c: e3500000 cmp r0, #0 a000ca30: 0a000008 beq a000ca58 <_Objects_Id_to_name+0x78> #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); a000ca34: e1a0200d mov r2, sp a000ca38: ebffffc8 bl a000c960 <_Objects_Get> if ( !the_object ) a000ca3c: e3500000 cmp r0, #0 a000ca40: 0a000004 beq a000ca58 <_Objects_Id_to_name+0x78> return OBJECTS_INVALID_ID; *name = the_object->name; a000ca44: e590300c ldr r3, [r0, #12] <== NOT EXECUTED a000ca48: e5843000 str r3, [r4] <== NOT EXECUTED _Thread_Enable_dispatch(); a000ca4c: eb0002e4 bl a000d5e4 <_Thread_Enable_dispatch> <== NOT EXECUTED return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; a000ca50: e3a00000 mov r0, #0 <== NOT EXECUTED a000ca54: ea000000 b a000ca5c <_Objects_Id_to_name+0x7c> <== NOT EXECUTED the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; a000ca58: e3a00003 mov r0, #3 return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } a000ca5c: e28dd004 add sp, sp, #4 a000ca60: e8bd8010 pop {r4, pc} =============================================================================== a000b438 <_Objects_Name_to_id_u32>: Objects_Name name_for_mp; #endif /* ASSERT: information->is_string == false */ if ( !id ) a000b438: e3530000 cmp r3, #0 Objects_Information *information, uint32_t name, uint32_t node, Objects_Id *id ) { a000b43c: e92d0030 push {r4, r5} #endif /* ASSERT: information->is_string == false */ if ( !id ) return OBJECTS_INVALID_ADDRESS; a000b440: 03a00002 moveq r0, #2 Objects_Name name_for_mp; #endif /* ASSERT: information->is_string == false */ if ( !id ) a000b444: 0a000005 beq a000b460 <_Objects_Name_to_id_u32+0x28> return OBJECTS_INVALID_ADDRESS; if ( name == 0 ) a000b448: e3510000 cmp r1, #0 a000b44c: 0a000002 beq a000b45c <_Objects_Name_to_id_u32+0x24> return OBJECTS_INVALID_NAME; search_local_node = false; if ( information->maximum != 0 && a000b450: e1d051b0 ldrh r5, [r0, #16] a000b454: e3550000 cmp r5, #0 a000b458: 1a000002 bne a000b468 <_Objects_Name_to_id_u32+0x30> return OBJECTS_INVALID_NAME; name_for_mp.name_u32 = name; return _Objects_MP_Global_name_search( information, name_for_mp, node, id ); #else return OBJECTS_INVALID_NAME; a000b45c: e3a00001 mov r0, #1 <== NOT EXECUTED #endif } a000b460: e8bd0030 pop {r4, r5} a000b464: e12fff1e bx lr if ( name == 0 ) return OBJECTS_INVALID_NAME; search_local_node = false; if ( information->maximum != 0 && a000b468: e3720106 cmn r2, #-2147483647 ; 0x80000001 a000b46c: 13520000 cmpne r2, #0 a000b470: 1a00000b bne a000b4a4 <_Objects_Name_to_id_u32+0x6c> _Objects_Is_local_node( node ) )) search_local_node = true; if ( search_local_node ) { for ( index = 1; index <= information->maximum; index++ ) { a000b474: e590c01c ldr ip, [r0, #28] a000b478: e3a02001 mov r2, #1 the_object = information->local_table[ index ]; a000b47c: e5bc0004 ldr r0, [ip, #4]! _Objects_Is_local_node( node ) )) search_local_node = true; if ( search_local_node ) { for ( index = 1; index <= information->maximum; index++ ) { a000b480: e2822001 add r2, r2, #1 the_object = information->local_table[ index ]; if ( !the_object ) a000b484: e3500000 cmp r0, #0 a000b488: 0a000002 beq a000b498 <_Objects_Name_to_id_u32+0x60> continue; if ( name == the_object->name.name_u32 ) { a000b48c: e590400c ldr r4, [r0, #12] a000b490: e1540001 cmp r4, r1 a000b494: 0a000005 beq a000b4b0 <_Objects_Name_to_id_u32+0x78> _Objects_Is_local_node( node ) )) search_local_node = true; if ( search_local_node ) { for ( index = 1; index <= information->maximum; index++ ) { a000b498: e1550002 cmp r5, r2 a000b49c: 2afffff6 bcs a000b47c <_Objects_Name_to_id_u32+0x44> a000b4a0: eaffffed b a000b45c <_Objects_Name_to_id_u32+0x24> <== NOT EXECUTED search_local_node = false; if ( information->maximum != 0 && (node == OBJECTS_SEARCH_ALL_NODES || node == OBJECTS_SEARCH_LOCAL_NODE || a000b4a4: e3520001 cmp r2, #1 a000b4a8: 1affffeb bne a000b45c <_Objects_Name_to_id_u32+0x24> a000b4ac: eafffff0 b a000b474 <_Objects_Name_to_id_u32+0x3c> the_object = information->local_table[ index ]; if ( !the_object ) continue; if ( name == the_object->name.name_u32 ) { *id = the_object->id; a000b4b0: e5902008 ldr r2, [r0, #8] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; a000b4b4: e3a00000 mov r0, #0 the_object = information->local_table[ index ]; if ( !the_object ) continue; if ( name == the_object->name.name_u32 ) { *id = the_object->id; a000b4b8: e5832000 str r2, [r3] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; a000b4bc: eaffffe7 b a000b460 <_Objects_Name_to_id_u32+0x28> =============================================================================== a000d7f4 <_Objects_Set_name>: { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); a000d7f4: e1d033b8 ldrh r3, [r0, #56] ; 0x38 <== NOT EXECUTED bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { a000d7f8: e92d4030 push {r4, r5, lr} <== NOT EXECUTED size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); a000d7fc: e1a00002 mov r0, r2 <== NOT EXECUTED bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { a000d800: e1a05001 mov r5, r1 <== NOT EXECUTED size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); a000d804: e1a01003 mov r1, r3 <== NOT EXECUTED bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { a000d808: e1a04002 mov r4, r2 <== NOT EXECUTED size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); a000d80c: eb001d91 bl a0014e58 <== NOT EXECUTED d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( a000d810: e5d42000 ldrb r2, [r4] <== NOT EXECUTED a000d814: e3500001 cmp r0, #1 <== NOT EXECUTED a000d818: e1a02c02 lsl r2, r2, #24 <== NOT EXECUTED a000d81c: 9a00000c bls a000d854 <_Objects_Set_name+0x60> <== NOT EXECUTED a000d820: e5d43001 ldrb r3, [r4, #1] <== NOT EXECUTED a000d824: e3500002 cmp r0, #2 <== NOT EXECUTED a000d828: e1822803 orr r2, r2, r3, lsl #16 <== NOT EXECUTED a000d82c: 0a000009 beq a000d858 <_Objects_Set_name+0x64> <== NOT EXECUTED a000d830: e5d43002 ldrb r3, [r4, #2] <== NOT EXECUTED a000d834: e3500003 cmp r0, #3 <== NOT EXECUTED ); } return true; } a000d838: e3a00001 mov r0, #1 <== NOT EXECUTED d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( a000d83c: e1822403 orr r2, r2, r3, lsl #8 <== NOT EXECUTED a000d840: 15d43003 ldrbne r3, [r4, #3] <== NOT EXECUTED a000d844: 03a03020 moveq r3, #32 <== NOT EXECUTED a000d848: e1823003 orr r3, r2, r3 <== NOT EXECUTED a000d84c: e585300c str r3, [r5, #12] <== NOT EXECUTED ); } return true; } a000d850: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( a000d854: e3822602 orr r2, r2, #2097152 ; 0x200000 <== NOT EXECUTED a000d858: e3822a02 orr r2, r2, #8192 ; 0x2000 <== NOT EXECUTED a000d85c: e3a03020 mov r3, #32 <== NOT EXECUTED a000d860: e1823003 orr r3, r2, r3 <== NOT EXECUTED a000d864: e585300c str r3, [r5, #12] <== NOT EXECUTED ); } return true; } a000d868: e3a00001 mov r0, #1 <== NOT EXECUTED a000d86c: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a000b4c0 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { a000b4c0: 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 ); a000b4c4: e1d040b8 ldrh r4, [r0, #8] block_count = (information->maximum - index_base) / a000b4c8: e1d051b4 ldrh r5, [r0, #20] */ void _Objects_Shrink_information( Objects_Information *information ) { a000b4cc: 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) / a000b4d0: e1d001b0 ldrh r0, [r0, #16] a000b4d4: e1a01005 mov r1, r5 a000b4d8: e0640000 rsb r0, r4, r0 a000b4dc: eb0024f5 bl a00148b8 <__aeabi_uidiv> information->allocation_size; for ( block = 0; block < block_count; block++ ) { a000b4e0: e3500000 cmp r0, #0 a000b4e4: 0a00000d beq a000b520 <_Objects_Shrink_information+0x60> if ( information->inactive_per_block[ block ] == a000b4e8: e5962030 ldr r2, [r6, #48] ; 0x30 a000b4ec: e5923000 ldr r3, [r2] a000b4f0: 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++ ) { a000b4f4: 13a03000 movne r3, #0 if ( information->inactive_per_block[ block ] == a000b4f8: 1a000005 bne a000b514 <_Objects_Shrink_information+0x54> a000b4fc: ea000008 b a000b524 <_Objects_Shrink_information+0x64> <== NOT EXECUTED a000b500: e5b21004 ldr r1, [r2, #4]! information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; a000b504: e0844005 add r4, r4, r5 a000b508: 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 ] == a000b50c: e1550001 cmp r5, r1 a000b510: 0a000004 beq a000b528 <_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++ ) { a000b514: e2833001 add r3, r3, #1 a000b518: e1500003 cmp r0, r3 a000b51c: 8afffff7 bhi a000b500 <_Objects_Shrink_information+0x40> a000b520: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( information->inactive_per_block[ block ] == a000b524: e3a07000 mov r7, #0 <== NOT EXECUTED information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); a000b528: e5960020 ldr r0, [r6, #32] a000b52c: ea000002 b a000b53c <_Objects_Shrink_information+0x7c> if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); a000b530: e3550000 cmp r5, #0 a000b534: 0a00000b beq a000b568 <_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; a000b538: e1a00005 mov r0, r5 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); do { index = _Objects_Get_index( the_object->id ); a000b53c: 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; a000b540: e5905000 ldr r5, [r0] if ((index >= index_base) && a000b544: e1530004 cmp r3, r4 a000b548: 3afffff8 bcc a000b530 <_Objects_Shrink_information+0x70> (index < (index_base + information->allocation_size))) { a000b54c: e1d621b4 ldrh r2, [r6, #20] a000b550: 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) && a000b554: e1530002 cmp r3, r2 a000b558: 2afffff4 bcs a000b530 <_Objects_Shrink_information+0x70> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); a000b55c: ebfffbbf bl a000a460 <_Chain_Extract> } } while ( the_object ); a000b560: e3550000 cmp r5, #0 a000b564: 1afffff3 bne a000b538 <_Objects_Shrink_information+0x78> /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); a000b568: e5963034 ldr r3, [r6, #52] ; 0x34 a000b56c: e7930007 ldr r0, [r3, r7] a000b570: eb0006d9 bl a000d0dc <_Workspace_Free> information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; a000b574: e1d602bc ldrh r0, [r6, #44] ; 0x2c a000b578: 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; a000b57c: e5961034 ldr r1, [r6, #52] ; 0x34 information->inactive_per_block[ block ] = 0; a000b580: e5962030 ldr r2, [r6, #48] ; 0x30 information->inactive -= information->allocation_size; a000b584: 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; a000b588: e7815007 str r5, [r1, r7] information->inactive_per_block[ block ] = 0; a000b58c: e7825007 str r5, [r2, r7] information->inactive -= information->allocation_size; a000b590: e1c632bc strh r3, [r6, #44] ; 0x2c return; a000b594: e8bd80f0 pop {r4, r5, r6, r7, pc} =============================================================================== a000bd48 <_Protected_heap_Get_information>: bool _Protected_heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { a000bd48: e92d4070 push {r4, r5, r6, lr} if ( !the_heap ) a000bd4c: e2505000 subs r5, r0, #0 bool _Protected_heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { a000bd50: e1a06001 mov r6, r1 if ( !the_heap ) a000bd54: 0a00000d beq a000bd90 <_Protected_heap_Get_information+0x48> return false; if ( !the_info ) a000bd58: e3510000 cmp r1, #0 a000bd5c: 0a000009 beq a000bd88 <_Protected_heap_Get_information+0x40> return false; _RTEMS_Lock_allocator(); a000bd60: e59f4030 ldr r4, [pc, #48] ; a000bd98 <_Protected_heap_Get_information+0x50> a000bd64: e5940000 ldr r0, [r4] a000bd68: ebfffb74 bl a000ab40 <_API_Mutex_Lock> _Heap_Get_information( the_heap, the_info ); a000bd6c: e1a00005 mov r0, r5 a000bd70: e1a01006 mov r1, r6 a000bd74: eb0010f0 bl a001013c <_Heap_Get_information> _RTEMS_Unlock_allocator(); a000bd78: e5940000 ldr r0, [r4] a000bd7c: ebfffb8b bl a000abb0 <_API_Mutex_Unlock> return true; a000bd80: e3a00001 mov r0, #1 a000bd84: e8bd8070 pop {r4, r5, r6, pc} { if ( !the_heap ) return false; if ( !the_info ) return false; a000bd88: e1a00001 mov r0, r1 _RTEMS_Lock_allocator(); _Heap_Get_information( the_heap, the_info ); _RTEMS_Unlock_allocator(); return true; } a000bd8c: e8bd8070 pop {r4, r5, r6, pc} Heap_Control *the_heap, Heap_Information_block *the_info ) { if ( !the_heap ) return false; a000bd90: e1a00005 mov r0, r5 <== NOT EXECUTED a000bd94: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED =============================================================================== a0010b68 <_Protected_heap_Walk>: * then it is forbidden to lock a mutex. But since we are inside * a critical section, it should be safe to walk it unlocked. * * NOTE: Dispatching is also disabled during initialization. */ if ( !_Thread_Dispatch_disable_level ) { a0010b68: e59f3054 ldr r3, [pc, #84] ; a0010bc4 <_Protected_heap_Walk+0x5c><== NOT EXECUTED bool _Protected_heap_Walk( Heap_Control *the_heap, int source, bool do_dump ) { a0010b6c: e92d40f0 push {r4, r5, r6, r7, lr} <== NOT EXECUTED * then it is forbidden to lock a mutex. But since we are inside * a critical section, it should be safe to walk it unlocked. * * NOTE: Dispatching is also disabled during initialization. */ if ( !_Thread_Dispatch_disable_level ) { a0010b70: e5933000 ldr r3, [r3] <== NOT EXECUTED bool _Protected_heap_Walk( Heap_Control *the_heap, int source, bool do_dump ) { a0010b74: e1a07000 mov r7, r0 <== NOT EXECUTED a0010b78: e1a06001 mov r6, r1 <== NOT EXECUTED * then it is forbidden to lock a mutex. But since we are inside * a critical section, it should be safe to walk it unlocked. * * NOTE: Dispatching is also disabled during initialization. */ if ( !_Thread_Dispatch_disable_level ) { a0010b7c: e3530000 cmp r3, #0 <== NOT EXECUTED bool _Protected_heap_Walk( Heap_Control *the_heap, int source, bool do_dump ) { a0010b80: e20250ff and r5, r2, #255 ; 0xff <== NOT EXECUTED * then it is forbidden to lock a mutex. But since we are inside * a critical section, it should be safe to walk it unlocked. * * NOTE: Dispatching is also disabled during initialization. */ if ( !_Thread_Dispatch_disable_level ) { a0010b84: 0a000002 beq a0010b94 <_Protected_heap_Walk+0x2c> <== NOT EXECUTED _RTEMS_Lock_allocator(); status = _Heap_Walk( the_heap, source, do_dump ); _RTEMS_Unlock_allocator(); } else { status = _Heap_Walk( the_heap, source, do_dump ); a0010b88: e1a02005 mov r2, r5 <== NOT EXECUTED } return status; } a0010b8c: e8bd40f0 pop {r4, r5, r6, r7, lr} <== NOT EXECUTED if ( !_Thread_Dispatch_disable_level ) { _RTEMS_Lock_allocator(); status = _Heap_Walk( the_heap, source, do_dump ); _RTEMS_Unlock_allocator(); } else { status = _Heap_Walk( the_heap, source, do_dump ); a0010b90: eafffbf2 b a000fb60 <_Heap_Walk> <== NOT EXECUTED * a critical section, it should be safe to walk it unlocked. * * NOTE: Dispatching is also disabled during initialization. */ if ( !_Thread_Dispatch_disable_level ) { _RTEMS_Lock_allocator(); a0010b94: e59f402c ldr r4, [pc, #44] ; a0010bc8 <_Protected_heap_Walk+0x60><== NOT EXECUTED a0010b98: e5940000 ldr r0, [r4] <== NOT EXECUTED a0010b9c: ebfff7e2 bl a000eb2c <_API_Mutex_Lock> <== NOT EXECUTED status = _Heap_Walk( the_heap, source, do_dump ); a0010ba0: e1a02005 mov r2, r5 <== NOT EXECUTED a0010ba4: e1a01006 mov r1, r6 <== NOT EXECUTED a0010ba8: e1a00007 mov r0, r7 <== NOT EXECUTED a0010bac: ebfffbeb bl a000fb60 <_Heap_Walk> <== NOT EXECUTED a0010bb0: e1a05000 mov r5, r0 <== NOT EXECUTED _RTEMS_Unlock_allocator(); a0010bb4: e5940000 ldr r0, [r4] <== NOT EXECUTED a0010bb8: ebfff7f7 bl a000eb9c <_API_Mutex_Unlock> <== NOT EXECUTED } else { status = _Heap_Walk( the_heap, source, do_dump ); } return status; } a0010bbc: e1a00005 mov r0, r5 <== NOT EXECUTED a0010bc0: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== a000ef54 <_RTEMS_Tasks_Invoke_task_variable_dtor>: { void (*dtor)(void *); void *value; dtor = tvp->dtor; if (_Thread_Is_executing(the_thread)) { a000ef54: e59f203c ldr r2, [pc, #60] ; a000ef98 <_RTEMS_Tasks_Invoke_task_variable_dtor+0x44><== NOT EXECUTED ) { void (*dtor)(void *); void *value; dtor = tvp->dtor; a000ef58: e5913010 ldr r3, [r1, #16] <== NOT EXECUTED void _RTEMS_Tasks_Invoke_task_variable_dtor( Thread_Control *the_thread, rtems_task_variable_t *tvp ) { a000ef5c: e92d4010 push {r4, lr} <== NOT EXECUTED void (*dtor)(void *); void *value; dtor = tvp->dtor; if (_Thread_Is_executing(the_thread)) { a000ef60: e5922004 ldr r2, [r2, #4] <== NOT EXECUTED void _RTEMS_Tasks_Invoke_task_variable_dtor( Thread_Control *the_thread, rtems_task_variable_t *tvp ) { a000ef64: e1a04001 mov r4, r1 <== NOT EXECUTED void (*dtor)(void *); void *value; dtor = tvp->dtor; if (_Thread_Is_executing(the_thread)) { a000ef68: e1520000 cmp r2, r0 <== NOT EXECUTED value = *tvp->ptr; a000ef6c: 05912004 ldreq r2, [r1, #4] <== NOT EXECUTED *tvp->ptr = tvp->gval; a000ef70: 05911008 ldreq r1, [r1, #8] <== NOT EXECUTED } else { value = tvp->tval; a000ef74: 1594000c ldrne r0, [r4, #12] <== NOT EXECUTED void (*dtor)(void *); void *value; dtor = tvp->dtor; if (_Thread_Is_executing(the_thread)) { value = *tvp->ptr; a000ef78: 05920000 ldreq r0, [r2] <== NOT EXECUTED *tvp->ptr = tvp->gval; a000ef7c: 05821000 streq r1, [r2] <== NOT EXECUTED } else { value = tvp->tval; } if ( dtor ) a000ef80: e3530000 cmp r3, #0 <== NOT EXECUTED a000ef84: 0a000000 beq a000ef8c <_RTEMS_Tasks_Invoke_task_variable_dtor+0x38><== NOT EXECUTED (*dtor)(value); a000ef88: e12fff33 blx r3 <== NOT EXECUTED _Workspace_Free(tvp); a000ef8c: e1a00004 mov r0, r4 <== NOT EXECUTED } a000ef90: e8bd4010 pop {r4, lr} <== NOT EXECUTED } if ( dtor ) (*dtor)(value); _Workspace_Free(tvp); a000ef94: eafff850 b a000d0dc <_Workspace_Free> <== NOT EXECUTED =============================================================================== a000ee20 <_RTEMS_tasks_Delete_extension>: void _RTEMS_tasks_Delete_extension( Thread_Control *executing, Thread_Control *deleted ) { a000ee20: e92d4030 push {r4, r5, lr} a000ee24: e1a05001 mov r5, r1 /* * Free per task variable memory */ tvp = deleted->task_variables; a000ee28: e5911100 ldr r1, [r1, #256] ; 0x100 deleted->task_variables = NULL; a000ee2c: e3a03000 mov r3, #0 a000ee30: e5853100 str r3, [r5, #256] ; 0x100 while (tvp) { a000ee34: e1510003 cmp r1, r3 a000ee38: 1a000001 bne a000ee44 <_RTEMS_tasks_Delete_extension+0x24> a000ee3c: ea000005 b a000ee58 <_RTEMS_tasks_Delete_extension+0x38> next = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( deleted, tvp ); tvp = next; a000ee40: e1a01004 mov r1, r4 <== NOT EXECUTED */ tvp = deleted->task_variables; deleted->task_variables = NULL; while (tvp) { next = (rtems_task_variable_t *)tvp->next; a000ee44: e5914000 ldr r4, [r1] <== NOT EXECUTED _RTEMS_Tasks_Invoke_task_variable_dtor( deleted, tvp ); a000ee48: e1a00005 mov r0, r5 <== NOT EXECUTED a000ee4c: eb000040 bl a000ef54 <_RTEMS_Tasks_Invoke_task_variable_dtor><== NOT EXECUTED * Free per task variable memory */ tvp = deleted->task_variables; deleted->task_variables = NULL; while (tvp) { a000ee50: e3540000 cmp r4, #0 <== NOT EXECUTED a000ee54: 1afffff9 bne a000ee40 <_RTEMS_tasks_Delete_extension+0x20> <== NOT EXECUTED /* * Free API specific memory */ (void) _Workspace_Free( deleted->API_Extensions[ THREAD_API_RTEMS ] ); a000ee58: e59500f4 ldr r0, [r5, #244] ; 0xf4 a000ee5c: ebfff89e bl a000d0dc <_Workspace_Free> deleted->API_Extensions[ THREAD_API_RTEMS ] = NULL; a000ee60: e3a03000 mov r3, #0 a000ee64: e58530f4 str r3, [r5, #244] ; 0xf4 } a000ee68: e8bd8030 pop {r4, r5, pc} =============================================================================== a000ed14 <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; a000ed14: e5903100 ldr r3, [r0, #256] ; 0x100 while (tvp) { a000ed18: e3530000 cmp r3, #0 a000ed1c: 0a000007 beq a000ed40 <_RTEMS_tasks_Switch_extension+0x2c> tvp->tval = *tvp->ptr; a000ed20: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED *tvp->ptr = tvp->gval; a000ed24: e5930008 ldr r0, [r3, #8] <== NOT EXECUTED * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; a000ed28: e592c000 ldr ip, [r2] <== NOT EXECUTED a000ed2c: e583c00c str ip, [r3, #12] <== NOT EXECUTED *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; a000ed30: e5933000 ldr r3, [r3] <== NOT EXECUTED */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; a000ed34: e5820000 str r0, [r2] <== NOT EXECUTED /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { a000ed38: e3530000 cmp r3, #0 <== NOT EXECUTED a000ed3c: 1afffff7 bne a000ed20 <_RTEMS_tasks_Switch_extension+0xc> <== NOT EXECUTED tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; a000ed40: e5913100 ldr r3, [r1, #256] ; 0x100 while (tvp) { a000ed44: e3530000 cmp r3, #0 a000ed48: 012fff1e bxeq lr tvp->gval = *tvp->ptr; a000ed4c: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED *tvp->ptr = tvp->tval; a000ed50: e593100c ldr r1, [r3, #12] <== NOT EXECUTED tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; a000ed54: e5920000 ldr r0, [r2] <== NOT EXECUTED a000ed58: e5830008 str r0, [r3, #8] <== NOT EXECUTED *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; a000ed5c: e5933000 ldr r3, [r3] <== NOT EXECUTED } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; *tvp->ptr = tvp->tval; a000ed60: e5821000 str r1, [r2] <== NOT EXECUTED *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { a000ed64: e3530000 cmp r3, #0 <== NOT EXECUTED a000ed68: 1afffff7 bne a000ed4c <_RTEMS_tasks_Switch_extension+0x38> <== NOT EXECUTED a000ed6c: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b0a0 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { a000b0a0: e92d4010 push {r4, lr} <== NOT EXECUTED a000b0a4: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a000b0a8: e1a01000 mov r1, r0 <== NOT EXECUTED a000b0ac: e1a0200d mov r2, sp <== NOT EXECUTED a000b0b0: e59f0094 ldr r0, [pc, #148] ; a000b14c <_Rate_monotonic_Timeout+0xac><== NOT EXECUTED a000b0b4: eb000791 bl a000cf00 <_Objects_Get> <== NOT EXECUTED /* * When we get here, the Timer is already off the chain so we do not * have to worry about that -- hence no _Watchdog_Remove(). */ the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a000b0b8: e59d3000 ldr r3, [sp] <== NOT EXECUTED a000b0bc: e1a04000 mov r4, r0 <== NOT EXECUTED a000b0c0: e3530000 cmp r3, #0 <== NOT EXECUTED a000b0c4: 1a000010 bne a000b10c <_Rate_monotonic_Timeout+0x6c> <== NOT EXECUTED case OBJECTS_LOCAL: the_thread = the_period->owner; a000b0c8: e5900040 ldr r0, [r0, #64] ; 0x40 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_PERIOD); a000b0cc: e5903010 ldr r3, [r0, #16] <== NOT EXECUTED if ( _States_Is_waiting_for_period( the_thread->current_state ) && a000b0d0: e3130901 tst r3, #16384 ; 0x4000 <== NOT EXECUTED a000b0d4: 0a000003 beq a000b0e8 <_Rate_monotonic_Timeout+0x48> <== NOT EXECUTED a000b0d8: e5902020 ldr r2, [r0, #32] <== NOT EXECUTED a000b0dc: e5943008 ldr r3, [r4, #8] <== NOT EXECUTED a000b0e0: e1520003 cmp r2, r3 <== NOT EXECUTED a000b0e4: 0a000014 beq a000b13c <_Rate_monotonic_Timeout+0x9c> <== NOT EXECUTED _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { a000b0e8: e5943038 ldr r3, [r4, #56] ; 0x38 <== NOT EXECUTED a000b0ec: e3530001 cmp r3, #1 <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; a000b0f0: 13a03004 movne r3, #4 <== NOT EXECUTED a000b0f4: 15843038 strne r3, [r4, #56] ; 0x38 <== NOT EXECUTED _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { a000b0f8: 0a000005 beq a000b114 <_Rate_monotonic_Timeout+0x74> <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; a000b0fc: e59f304c ldr r3, [pc, #76] ; a000b150 <_Rate_monotonic_Timeout+0xb0><== NOT EXECUTED a000b100: e5932000 ldr r2, [r3] <== NOT EXECUTED a000b104: e2422001 sub r2, r2, #1 <== NOT EXECUTED a000b108: e5832000 str r2, [r3] <== NOT EXECUTED case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } a000b10c: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000b110: e8bd8010 pop {r4, pc} <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; a000b114: e3a03003 mov r3, #3 <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); a000b118: e1a00004 mov r0, r4 <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; a000b11c: e5843038 str r3, [r4, #56] ; 0x38 <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); a000b120: ebfffe5d bl a000aa9c <_Rate_monotonic_Initiate_statistics> <== NOT EXECUTED Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000b124: e594303c ldr r3, [r4, #60] ; 0x3c <== NOT EXECUTED _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000b128: e59f0024 ldr r0, [pc, #36] ; a000b154 <_Rate_monotonic_Timeout+0xb4><== NOT EXECUTED a000b12c: e2841010 add r1, r4, #16 <== NOT EXECUTED Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000b130: e584301c str r3, [r4, #28] <== NOT EXECUTED _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000b134: eb000e5f bl a000eab8 <_Watchdog_Insert> <== NOT EXECUTED a000b138: eaffffef b a000b0fc <_Rate_monotonic_Timeout+0x5c> <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a000b13c: e59f1014 ldr r1, [pc, #20] ; a000b158 <_Rate_monotonic_Timeout+0xb8><== NOT EXECUTED a000b140: eb00098a bl a000d770 <_Thread_Clear_state> <== NOT EXECUTED the_thread = the_period->owner; if ( _States_Is_waiting_for_period( the_thread->current_state ) && the_thread->Wait.id == the_period->Object.id ) { _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); a000b144: e1a00004 mov r0, r4 <== NOT EXECUTED a000b148: eafffff4 b a000b120 <_Rate_monotonic_Timeout+0x80> <== NOT EXECUTED =============================================================================== a000acc4 <_TOD_Get_uptime_as_timespec>: */ void _TOD_Get_uptime_as_timespec( struct timespec *uptime ) { a000acc4: e92d4010 push {r4, lr} <== NOT EXECUTED a000acc8: e24dd008 sub sp, sp, #8 <== NOT EXECUTED a000accc: e1a04000 mov r4, r0 <== NOT EXECUTED Timestamp_Control uptime_ts; /* assume time checked for NULL by caller */ _TOD_Get_uptime( &uptime_ts ); a000acd0: e1a0000d mov r0, sp <== NOT EXECUTED a000acd4: eb001284 bl a000f6ec <_TOD_Get_uptime> <== NOT EXECUTED _Timestamp_To_timespec( &uptime_ts, uptime ); a000acd8: e89d000c ldm sp, {r2, r3} <== NOT EXECUTED a000acdc: e884000c stm r4, {r2, r3} <== NOT EXECUTED } a000ace0: e28dd008 add sp, sp, #8 <== NOT EXECUTED a000ace4: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a000c34c <_TOD_Set>: rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000c34c: e59f3068 ldr r3, [pc, #104] ; a000c3bc <_TOD_Set+0x70> */ void _TOD_Set( const struct timespec *time ) { a000c350: e92d4030 push {r4, r5, lr} a000c354: e5932000 ldr r2, [r3] a000c358: e1a05000 mov r5, r0 a000c35c: e2822001 add r2, r2, #1 a000c360: e5832000 str r2, [r3] long seconds; _Thread_Disable_dispatch(); _TOD_Deactivate(); seconds = _TOD_Seconds_since_epoch(); a000c364: e59f4054 ldr r4, [pc, #84] ; a000c3c0 <_TOD_Set+0x74> if ( time->tv_sec < seconds ) a000c368: e5902000 ldr r2, [r0] long seconds; _Thread_Disable_dispatch(); _TOD_Deactivate(); seconds = _TOD_Seconds_since_epoch(); a000c36c: e5943000 ldr r3, [r4] if ( time->tv_sec < seconds ) a000c370: e1530002 cmp r3, r2 a000c374: ca00000b bgt a000c3a8 <_TOD_Set+0x5c> Watchdog_Adjust_directions direction, Watchdog_Interval units ) { _Watchdog_Adjust( &_Watchdog_Seconds_chain, direction, units ); a000c378: e59f0044 ldr r0, [pc, #68] ; a000c3c4 <_TOD_Set+0x78> a000c37c: e3a01000 mov r1, #0 a000c380: e0632002 rsb r2, r3, r2 a000c384: eb0009bc bl a000ea7c <_Watchdog_Adjust> _Watchdog_Adjust_seconds( WATCHDOG_BACKWARD, seconds - time->tv_sec ); else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); a000c388: e895000c ldm r5, {r2, r3} a000c38c: e5843004 str r3, [r4, #4] _TOD_Is_set = true; a000c390: e59f3030 ldr r3, [pc, #48] ; a000c3c8 <_TOD_Set+0x7c> _Watchdog_Adjust_seconds( WATCHDOG_BACKWARD, seconds - time->tv_sec ); else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); a000c394: e5842000 str r2, [r4] _TOD_Is_set = true; a000c398: e3a02001 mov r2, #1 a000c39c: e5c32000 strb r2, [r3] _TOD_Activate(); _Thread_Enable_dispatch(); } a000c3a0: e8bd4030 pop {r4, r5, lr} _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); _TOD_Is_set = true; _TOD_Activate(); _Thread_Enable_dispatch(); a000c3a4: ea0005b2 b a000da74 <_Thread_Enable_dispatch> a000c3a8: e59f0014 ldr r0, [pc, #20] ; a000c3c4 <_TOD_Set+0x78> <== NOT EXECUTED a000c3ac: e3a01001 mov r1, #1 <== NOT EXECUTED a000c3b0: e0622003 rsb r2, r2, r3 <== NOT EXECUTED a000c3b4: eb0009b0 bl a000ea7c <_Watchdog_Adjust> <== NOT EXECUTED a000c3b8: eafffff2 b a000c388 <_TOD_Set+0x3c> <== NOT EXECUTED =============================================================================== a000a910 <_TOD_Tickle_ticks>: { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); a000a910: e59f2064 ldr r2, [pc, #100] ; a000a97c <_TOD_Tickle_ticks+0x6c> /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; a000a914: e59f3064 ldr r3, [pc, #100] ; a000a980 <_TOD_Tickle_ticks+0x70> * * Output parameters: NONE */ void _TOD_Tickle_ticks( void ) { a000a918: e92d4010 push {r4, lr} Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); a000a91c: e592100c ldr r1, [r2, #12] /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; a000a920: e5932000 ldr r2, [r3] { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); a000a924: e3a0cffa mov ip, #1000 ; 0x3e8 a000a928: e00c0c91 mul ip, r1, ip * * Output parameters: NONE */ void _TOD_Tickle_ticks( void ) { a000a92c: e24dd008 sub sp, sp, #8 /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; a000a930: e2822001 add r2, r2, #1 { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); a000a934: e3a0e000 mov lr, #0 /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); a000a938: e1a0100d mov r1, sp /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; a000a93c: e5832000 str r2, [r3] /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); a000a940: e59f003c ldr r0, [pc, #60] ; a000a984 <_TOD_Tickle_ticks+0x74> { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); a000a944: e58de000 str lr, [sp] a000a948: e58dc004 str ip, [sp, #4] /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); a000a94c: eb000826 bl a000c9ec <_Timespec_Add_to> /* we do not care how much the uptime changed */ /* Update the timespec format TOD */ seconds = _Timestamp_Add_to_at_tick( &_TOD_Now, &tick ); a000a950: e59f0030 ldr r0, [pc, #48] ; a000a988 <_TOD_Tickle_ticks+0x78> a000a954: e1a0100d mov r1, sp a000a958: eb000823 bl a000c9ec <_Timespec_Add_to> while ( seconds ) { a000a95c: e2504000 subs r4, r0, #0 a000a960: 0a000003 beq a000a974 <_TOD_Tickle_ticks+0x64> */ RTEMS_INLINE_ROUTINE void _Watchdog_Tickle_seconds( void ) { _Watchdog_Tickle( &_Watchdog_Seconds_chain ); a000a964: e59f0020 ldr r0, [pc, #32] ; a000a98c <_TOD_Tickle_ticks+0x7c><== NOT EXECUTED a000a968: eb000993 bl a000cfbc <_Watchdog_Tickle> <== NOT EXECUTED a000a96c: e2544001 subs r4, r4, #1 <== NOT EXECUTED a000a970: 1afffffb bne a000a964 <_TOD_Tickle_ticks+0x54> <== NOT EXECUTED _Watchdog_Tickle_seconds(); seconds--; } } a000a974: e28dd008 add sp, sp, #8 a000a978: e8bd8010 pop {r4, pc} =============================================================================== a000ab10 <_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(); a000ab10: e59f30bc ldr r3, [pc, #188] ; a000abd4 <_TOD_Validate+0xc4> */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { a000ab14: 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) || a000ab18: 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(); a000ab1c: e593100c ldr r1, [r3, #12] if ((!the_tod) || a000ab20: 0a000029 beq a000abcc <_TOD_Validate+0xbc> ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / a000ab24: e3a0093d mov r0, #999424 ; 0xf4000 a000ab28: e2800d09 add r0, r0, #576 ; 0x240 a000ab2c: eb0046c5 bl a001c648 <__aeabi_uidiv> rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || a000ab30: e5943018 ldr r3, [r4, #24] a000ab34: e1500003 cmp r0, r3 a000ab38: 9a00001f bls a000abbc <_TOD_Validate+0xac> (the_tod->ticks >= ticks_per_second) || a000ab3c: e5943014 ldr r3, [r4, #20] a000ab40: e353003b cmp r3, #59 ; 0x3b a000ab44: 8a00001c bhi a000abbc <_TOD_Validate+0xac> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || a000ab48: e5943010 ldr r3, [r4, #16] a000ab4c: e353003b cmp r3, #59 ; 0x3b a000ab50: 8a000019 bhi a000abbc <_TOD_Validate+0xac> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || a000ab54: e594300c ldr r3, [r4, #12] a000ab58: e3530017 cmp r3, #23 a000ab5c: 8a000016 bhi a000abbc <_TOD_Validate+0xac> (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || a000ab60: 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) || a000ab64: e3500000 cmp r0, #0 a000ab68: 0a000016 beq a000abc8 <_TOD_Validate+0xb8> (the_tod->month == 0) || a000ab6c: e350000c cmp r0, #12 a000ab70: 8a000011 bhi a000abbc <_TOD_Validate+0xac> (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || a000ab74: 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) || a000ab78: e3a03d1f mov r3, #1984 ; 0x7c0 a000ab7c: e2833003 add r3, r3, #3 a000ab80: e1520003 cmp r2, r3 a000ab84: 9a00000c bls a000abbc <_TOD_Validate+0xac> (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) a000ab88: 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) || a000ab8c: e3540000 cmp r4, #0 a000ab90: 0a00000b beq a000abc4 <_TOD_Validate+0xb4> (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) a000ab94: e3120003 tst r2, #3 days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; a000ab98: 059f3038 ldreq r3, [pc, #56] ; a000abd8 <_TOD_Validate+0xc8> else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; a000ab9c: 159f3034 ldrne r3, [pc, #52] ; a000abd8 <_TOD_Validate+0xc8> (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 ]; a000aba0: 0280000d addeq r0, r0, #13 a000aba4: 07930100 ldreq r0, [r3, r0, lsl #2] else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; a000aba8: 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( a000abac: e1500004 cmp r0, r4 a000abb0: 33a00000 movcc r0, #0 a000abb4: 23a00001 movcs r0, #1 a000abb8: 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; a000abbc: e3a00000 mov r0, #0 <== NOT EXECUTED a000abc0: e8bd8010 pop {r4, pc} <== NOT EXECUTED a000abc4: e1a00004 mov r0, r4 <== NOT EXECUTED if ( the_tod->day > days_in_month ) return false; return true; } a000abc8: e8bd8010 pop {r4, pc} <== NOT EXECUTED (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; a000abcc: e1a00004 mov r0, r4 <== NOT EXECUTED a000abd0: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a000bb98 <_Thread_Close>: RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( a000bb98: e1d120b8 ldrh r2, [r1, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000bb9c: e590301c ldr r3, [r0, #28] void _Thread_Close( Objects_Information *information, Thread_Control *the_thread ) { a000bba0: e92d4070 push {r4, r5, r6, lr} a000bba4: e1a04001 mov r4, r1 a000bba8: e3a01000 mov r1, #0 a000bbac: e7831102 str r1, [r3, r2, lsl #2] a000bbb0: e1a05000 mov r5, r0 */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; a000bbb4: e59f6098 ldr r6, [pc, #152] ; a000bc54 <_Thread_Close+0xbc> * disappear and set a transient state on it. So we temporarily * unnest dispatching. */ _Thread_Unnest_dispatch(); _User_extensions_Thread_delete( the_thread ); a000bbb8: e1a00004 mov r0, r4 a000bbbc: e5963000 ldr r3, [r6] a000bbc0: e2433001 sub r3, r3, #1 a000bbc4: e5863000 str r3, [r6] a000bbc8: eb00042b bl a000cc7c <_User_extensions_Thread_delete> rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000bbcc: e5963000 ldr r3, [r6] a000bbd0: e2833001 add r3, r3, #1 a000bbd4: e5863000 str r3, [r6] /* * Now we are in a dispatching critical section again and we * can take the thread OUT of the published set. It is invalid * to use this thread's Id OR name after this call. */ _Objects_Close( information, &the_thread->Object ); a000bbd8: e1a01004 mov r1, r4 a000bbdc: e1a00005 mov r0, r5 a000bbe0: ebfffcab bl a000ae94 <_Objects_Close> /* * By setting the dormant state, the thread will not be considered * for scheduling when we remove any blocking states. */ _Thread_Set_state( the_thread, STATES_DORMANT ); a000bbe4: e1a00004 mov r0, r4 a000bbe8: e3a01001 mov r1, #1 a000bbec: eb0002dc bl a000c764 <_Thread_Set_state> if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { a000bbf0: e1a00004 mov r0, r4 a000bbf4: eb000273 bl a000c5c8 <_Thread_queue_Extract_with_proxy> a000bbf8: e3500000 cmp r0, #0 a000bbfc: 1a000002 bne a000bc0c <_Thread_Close+0x74> if ( _Watchdog_Is_active( &the_thread->Timer ) ) a000bc00: e5943050 ldr r3, [r4, #80] ; 0x50 a000bc04: e3530002 cmp r3, #2 a000bc08: 0a00000e beq a000bc48 <_Thread_Close+0xb0> RTEMS_INLINE_ROUTINE void _Scheduler_Thread_scheduler_free( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_free( the_scheduler, the_thread ); a000bc0c: e59f0044 ldr r0, [pc, #68] ; a000bc58 <_Thread_Close+0xc0> a000bc10: e1a01004 mov r1, r4 a000bc14: e5903018 ldr r3, [r0, #24] a000bc18: e12fff33 blx r3 /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); a000bc1c: e1a00004 mov r0, r4 a000bc20: eb000326 bl a000c8c0 <_Thread_Stack_Free> the_thread->Start.stack = NULL; if ( the_thread->extensions ) a000bc24: e59400fc ldr r0, [r4, #252] ; 0xfc /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; a000bc28: e3a03000 mov r3, #0 a000bc2c: e58430bc str r3, [r4, #188] ; 0xbc if ( the_thread->extensions ) a000bc30: e1500003 cmp r0, r3 a000bc34: 0a000000 beq a000bc3c <_Thread_Close+0xa4> (void) _Workspace_Free( the_thread->extensions ); a000bc38: eb000527 bl a000d0dc <_Workspace_Free> the_thread->extensions = NULL; a000bc3c: e3a03000 mov r3, #0 a000bc40: e58430fc str r3, [r4, #252] ; 0xfc } a000bc44: e8bd8070 pop {r4, r5, r6, pc} */ _Thread_Set_state( the_thread, STATES_DORMANT ); if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); a000bc48: e2840048 add r0, r4, #72 ; 0x48 <== NOT EXECUTED a000bc4c: eb0004af bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a000bc50: eaffffed b a000bc0c <_Thread_Close+0x74> <== NOT EXECUTED =============================================================================== a000bd74 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { a000bd74: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; a000bd78: e59f7138 ldr r7, [pc, #312] ; a000beb8 <_Thread_Dispatch+0x144> * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { a000bd7c: e24dd010 sub sp, sp, #16 Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; a000bd80: e5975004 ldr r5, [r7, #4] static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000bd84: e10f2000 mrs r2, CPSR a000bd88: e3823080 orr r3, r2, #128 ; 0x80 a000bd8c: e129f003 msr CPSR_fc, r3 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { a000bd90: e5d71010 ldrb r1, [r7, #16] a000bd94: e3510000 cmp r1, #0 a000bd98: 0a000043 beq a000beac <_Thread_Dispatch+0x138> heir = _Thread_Heir; a000bd9c: e5974008 ldr r4, [r7, #8] _Thread_Dispatch_disable_level = 1; a000bda0: e59f9114 ldr r9, [pc, #276] ; a000bebc <_Thread_Dispatch+0x148> a000bda4: e3a00001 mov r0, #1 _Thread_Dispatch_necessary = false; a000bda8: e3a01000 mov r1, #0 /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) a000bdac: e1550004 cmp r5, r4 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; a000bdb0: e5890000 str r0, [r9] _Thread_Dispatch_necessary = false; _Thread_Executing = heir; a000bdb4: e5874004 str r4, [r7, #4] executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; a000bdb8: e5c71010 strb r1, [r7, #16] Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); a000bdbc: 01a03002 moveq r3, r2 /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) a000bdc0: 0a000033 beq a000be94 <_Thread_Dispatch+0x120> a000bdc4: e28da008 add sl, sp, #8 a000bdc8: e1a0800d mov r8, sp if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; a000bdcc: e1a06007 mov r6, r7 a000bdd0: ea000007 b a000bdf4 <_Thread_Dispatch+0x80> ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; a000bdd4: e5964008 ldr r4, [r6, #8] <== NOT EXECUTED _Thread_Dispatch_disable_level = 1; a000bdd8: e3a01001 mov r1, #1 <== NOT EXECUTED _Thread_Dispatch_necessary = false; a000bddc: e3a0b000 mov fp, #0 <== NOT EXECUTED /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) a000bde0: e1540005 cmp r4, r5 <== NOT EXECUTED executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; a000bde4: e5891000 str r1, [r9] <== NOT EXECUTED _Thread_Dispatch_necessary = false; _Thread_Executing = heir; a000bde8: e5864004 str r4, [r6, #4] <== NOT EXECUTED executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; a000bdec: e5c6b010 strb fp, [r6, #16] <== NOT EXECUTED /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) a000bdf0: 0a000027 beq a000be94 <_Thread_Dispatch+0x120> <== NOT EXECUTED */ #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) a000bdf4: e594307c ldr r3, [r4, #124] ; 0x7c a000bdf8: e3530001 cmp r3, #1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; a000bdfc: 059fc0bc ldreq ip, [pc, #188] ; a000bec0 <_Thread_Dispatch+0x14c> a000be00: 059c3000 ldreq r3, [ip] a000be04: 05843078 streq r3, [r4, #120] ; 0x78 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000be08: e129f002 msr CPSR_fc, r2 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); a000be0c: e1a0000a mov r0, sl a000be10: eb000d02 bl a000f220 <_TOD_Get_uptime> _Timestamp_Subtract( a000be14: e1a0200d mov r2, sp a000be18: e1a0100a mov r1, sl a000be1c: e59f00a0 ldr r0, [pc, #160] ; a000bec4 <_Thread_Dispatch+0x150> a000be20: eb000308 bl a000ca48 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); a000be24: e1a0100d mov r1, sp a000be28: e2850084 add r0, r5, #132 ; 0x84 a000be2c: eb0002ee bl a000c9ec <_Timespec_Add_to> _Thread_Time_of_last_context_switch = uptime; a000be30: e28dc008 add ip, sp, #8 a000be34: e89c1800 ldm ip, {fp, ip} #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { a000be38: e59f2088 ldr r2, [pc, #136] ; a000bec8 <_Thread_Dispatch+0x154> executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); a000be3c: e1a00005 mov r0, r5 a000be40: e1a01004 mov r1, r4 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { a000be44: e5923000 ldr r3, [r2] &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; a000be48: e59f2074 ldr r2, [pc, #116] ; a000bec4 <_Thread_Dispatch+0x150> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { a000be4c: e3530000 cmp r3, #0 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; a000be50: e8821800 stm r2, {fp, ip} /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; a000be54: 15932000 ldrne r2, [r3] a000be58: 158520f0 strne r2, [r5, #240] ; 0xf0 *_Thread_libc_reent = heir->libc_reent; a000be5c: 159420f0 ldrne r2, [r4, #240] ; 0xf0 a000be60: 15832000 strne r2, [r3] } _User_extensions_Thread_switch( executing, heir ); a000be64: eb0003aa bl a000cd14 <_User_extensions_Thread_switch> if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); a000be68: e28500c0 add r0, r5, #192 ; 0xc0 a000be6c: e28410c0 add r1, r4, #192 ; 0xc0 a000be70: eb000579 bl a000d45c <_CPU_Context_switch> if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; a000be74: e5975004 ldr r5, [r7, #4] static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000be78: e10f3000 mrs r3, CPSR a000be7c: e3832080 orr r2, r3, #128 ; 0x80 a000be80: e129f002 msr CPSR_fc, r2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { a000be84: e5d71010 ldrb r1, [r7, #16] a000be88: e1a02003 mov r2, r3 a000be8c: e3510000 cmp r1, #0 a000be90: 1affffcf bne a000bdd4 <_Thread_Dispatch+0x60> _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; a000be94: e3a01000 mov r1, #0 a000be98: e5891000 str r1, [r9] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000be9c: e129f003 msr CPSR_fc, r3 _ISR_Enable( level ); _API_extensions_Run_postswitch(); a000bea0: ebfff912 bl a000a2f0 <_API_extensions_Run_postswitch> } a000bea4: e28dd010 add sp, sp, #16 a000bea8: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); a000beac: e1a03002 mov r3, r2 a000beb0: e59f9004 ldr r9, [pc, #4] ; a000bebc <_Thread_Dispatch+0x148> a000beb4: eafffff6 b a000be94 <_Thread_Dispatch+0x120> =============================================================================== a000bef0 <_Thread_Get>: uint32_t the_class; Objects_Information **api_information; Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) { a000bef0: e2503000 subs r3, r0, #0 */ Thread_Control *_Thread_Get ( Objects_Id id, Objects_Locations *location ) { a000bef4: e1a02001 mov r2, r1 uint32_t the_class; Objects_Information **api_information; Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) { a000bef8: 0a000014 beq a000bf50 <_Thread_Get+0x60> */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); a000befc: e1a01c23 lsr r1, r3, #24 a000bf00: e2011007 and r1, r1, #7 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) a000bf04: e2410001 sub r0, r1, #1 a000bf08: e3500002 cmp r0, #2 a000bf0c: 8a00000b bhi a000bf40 <_Thread_Get+0x50> */ RTEMS_INLINE_ROUTINE uint32_t _Objects_Get_class( Objects_Id id ) { return (uint32_t) a000bf10: e1a0cda3 lsr ip, r3, #27 *location = OBJECTS_ERROR; goto done; } the_class = _Objects_Get_class( id ); if ( the_class != 1 ) { /* threads are always first class :) */ a000bf14: e35c0001 cmp ip, #1 a000bf18: 1a000008 bne a000bf40 <_Thread_Get+0x50> *location = OBJECTS_ERROR; goto done; } api_information = _Objects_Information_table[ the_api ]; a000bf1c: e59f0054 ldr r0, [pc, #84] ; a000bf78 <_Thread_Get+0x88> a000bf20: e7900101 ldr r0, [r0, r1, lsl #2] /* * There is no way for this to happen if POSIX is enabled. */ #if !defined(RTEMS_POSIX_API) if ( !api_information ) { a000bf24: e3500000 cmp r0, #0 a000bf28: 0a000010 beq a000bf70 <_Thread_Get+0x80> *location = OBJECTS_ERROR; goto done; } #endif information = api_information[ the_class ]; a000bf2c: e5900004 ldr r0, [r0, #4] if ( !information ) { a000bf30: e3500000 cmp r0, #0 a000bf34: 0a00000d beq a000bf70 <_Thread_Get+0x80> *location = OBJECTS_ERROR; goto done; } tp = (Thread_Control *) _Objects_Get( information, id, location ); a000bf38: e1a01003 mov r1, r3 a000bf3c: eafffce4 b a000b2d4 <_Objects_Get> goto done; } the_class = _Objects_Get_class( id ); if ( the_class != 1 ) { /* threads are always first class :) */ *location = OBJECTS_ERROR; a000bf40: e3a03001 mov r3, #1 a000bf44: e5823000 str r3, [r2] { uint32_t the_api; uint32_t the_class; Objects_Information **api_information; Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; a000bf48: e3a00000 mov r0, #0 } the_class = _Objects_Get_class( id ); if ( the_class != 1 ) { /* threads are always first class :) */ *location = OBJECTS_ERROR; goto done; a000bf4c: e12fff1e bx lr rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000bf50: e59f1024 ldr r1, [pc, #36] ; a000bf7c <_Thread_Get+0x8c> a000bf54: e5910000 ldr r0, [r1] a000bf58: e2800001 add r0, r0, #1 a000bf5c: e5810000 str r0, [r1] Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) { _Thread_Disable_dispatch(); *location = OBJECTS_LOCAL; a000bf60: e5823000 str r3, [r2] tp = _Thread_Executing; a000bf64: e59f3014 ldr r3, [pc, #20] ; a000bf80 <_Thread_Get+0x90> a000bf68: e5930004 ldr r0, [r3, #4] goto done; a000bf6c: e12fff1e bx lr } #endif information = api_information[ the_class ]; if ( !information ) { *location = OBJECTS_ERROR; a000bf70: e582c000 str ip, [r2] <== NOT EXECUTED goto done; a000bf74: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000bf84 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { a000bf84: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr} /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; a000bf88: e3a05000 mov r5, #0 a000bf8c: e58150f4 str r5, [r1, #244] ; 0xf4 a000bf90: e58150f8 str r5, [r1, #248] ; 0xf8 extensions_area = NULL; the_thread->libc_reent = NULL; a000bf94: e58150f0 str r5, [r1, #240] ; 0xf0 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { a000bf98: e1a04001 mov r4, r1 a000bf9c: e1a0a000 mov sl, r0 /* * Allocate and Initialize the stack for this thread. */ #if !defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); a000bfa0: e1a00001 mov r0, r1 a000bfa4: e1a01003 mov r1, r3 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { a000bfa8: e1a06003 mov r6, r3 a000bfac: e59d7024 ldr r7, [sp, #36] ; 0x24 a000bfb0: e5dd8028 ldrb r8, [sp, #40] ; 0x28 /* * Allocate and Initialize the stack for this thread. */ #if !defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); a000bfb4: eb000226 bl a000c854 <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) a000bfb8: e1500005 cmp r0, r5 a000bfbc: 13a03000 movne r3, #0 a000bfc0: 03a03001 moveq r3, #1 a000bfc4: e1500006 cmp r0, r6 a000bfc8: 21a06003 movcs r6, r3 a000bfcc: 33836001 orrcc r6, r3, #1 a000bfd0: e1560005 cmp r6, r5 a000bfd4: 1a000045 bne a000c0f0 <_Thread_Initialize+0x16c> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { a000bfd8: e59f9164 ldr r9, [pc, #356] ; a000c144 <_Thread_Initialize+0x1c0> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; a000bfdc: e59430bc ldr r3, [r4, #188] ; 0xbc the_stack->size = size; a000bfe0: e58400b4 str r0, [r4, #180] ; 0xb4 a000bfe4: e5995000 ldr r5, [r9] Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; a000bfe8: e58430b8 str r3, [r4, #184] ; 0xb8 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000bfec: e5846050 str r6, [r4, #80] ; 0x50 a000bff0: e3550000 cmp r5, #0 the_watchdog->routine = routine; a000bff4: e5846064 str r6, [r4, #100] ; 0x64 the_watchdog->id = id; a000bff8: e5846068 str r6, [r4, #104] ; 0x68 the_watchdog->user_data = user_data; a000bffc: e584606c str r6, [r4, #108] ; 0x6c (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; a000c000: 058450fc streq r5, [r4, #252] ; 0xfc #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { a000c004: 1a00003b bne a000c0f8 <_Thread_Initialize+0x174> /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; a000c008: e59d302c ldr r3, [sp, #44] ; 0x2c Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); a000c00c: e59f0134 ldr r0, [pc, #308] ; a000c148 <_Thread_Initialize+0x1c4> } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; a000c010: e3a06000 mov r6, #0 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; a000c014: e58430a4 str r3, [r4, #164] ; 0xa4 the_thread->Start.budget_callout = budget_callout; a000c018: e59d3030 ldr r3, [sp, #48] ; 0x30 #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; a000c01c: e3a09001 mov r9, #1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; a000c020: e5c480a0 strb r8, [r4, #160] ; 0xa0 the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; a000c024: e58430a8 str r3, [r4, #168] ; 0xa8 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; a000c028: e59d3034 ldr r3, [sp, #52] ; 0x34 the_thread->current_state = STATES_DORMANT; a000c02c: e5849010 str r9, [r4, #16] the_thread->Wait.queue = NULL; a000c030: e5846044 str r6, [r4, #68] ; 0x44 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; a000c034: e58430ac str r3, [r4, #172] ; 0xac the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; the_thread->resource_count = 0; a000c038: e584601c str r6, [r4, #28] the_thread->real_priority = priority; a000c03c: e5847018 str r7, [r4, #24] the_thread->Start.initial_priority = priority; a000c040: e58470b0 str r7, [r4, #176] ; 0xb0 RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return a000c044: e5903014 ldr r3, [r0, #20] a000c048: e1a01004 mov r1, r4 a000c04c: e12fff33 blx r3 sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) a000c050: e2508000 subs r8, r0, #0 a000c054: 0a00000d beq a000c090 <_Thread_Initialize+0x10c> goto failed; _Thread_Set_priority( the_thread, priority ); a000c058: e1a00004 mov r0, r4 a000c05c: e1a01007 mov r1, r7 a000c060: eb0001b5 bl a000c73c <_Thread_Set_priority> _Thread_Stack_Free( the_thread ); return false; } a000c064: e59a301c ldr r3, [sl, #28] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a000c068: e1d420b8 ldrh r2, [r4, #8] /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); a000c06c: e5846084 str r6, [r4, #132] ; 0x84 a000c070: e5846088 str r6, [r4, #136] ; 0x88 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000c074: e7834102 str r4, [r3, r2, lsl #2] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a000c078: e59d3038 ldr r3, [sp, #56] ; 0x38 * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); a000c07c: e1a00004 mov r0, r4 a000c080: e584300c str r3, [r4, #12] a000c084: eb0002e4 bl a000cc1c <_User_extensions_Thread_create> if ( extension_status ) a000c088: e1500006 cmp r0, r6 a000c08c: 1a000028 bne a000c134 <_Thread_Initialize+0x1b0> return true; failed: if ( the_thread->libc_reent ) a000c090: e59400f0 ldr r0, [r4, #240] ; 0xf0 a000c094: e3500000 cmp r0, #0 a000c098: 0a000000 beq a000c0a0 <_Thread_Initialize+0x11c> _Workspace_Free( the_thread->libc_reent ); a000c09c: eb00040e bl a000d0dc <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) a000c0a0: e59400f4 ldr r0, [r4, #244] ; 0xf4 a000c0a4: e3500000 cmp r0, #0 a000c0a8: 0a000000 beq a000c0b0 <_Thread_Initialize+0x12c> _Workspace_Free( the_thread->API_Extensions[i] ); a000c0ac: eb00040a bl a000d0dc <_Workspace_Free> failed: if ( the_thread->libc_reent ) _Workspace_Free( the_thread->libc_reent ); for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) a000c0b0: e59400f8 ldr r0, [r4, #248] ; 0xf8 a000c0b4: e3500000 cmp r0, #0 a000c0b8: 0a000000 beq a000c0c0 <_Thread_Initialize+0x13c> _Workspace_Free( the_thread->API_Extensions[i] ); a000c0bc: eb000406 bl a000d0dc <_Workspace_Free> <== NOT EXECUTED if ( extensions_area ) a000c0c0: e3550000 cmp r5, #0 a000c0c4: 0a000001 beq a000c0d0 <_Thread_Initialize+0x14c> (void) _Workspace_Free( extensions_area ); a000c0c8: e1a00005 mov r0, r5 a000c0cc: eb000402 bl a000d0dc <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) (void) _Workspace_Free( fp_area ); #endif if ( sched ) a000c0d0: e3580000 cmp r8, #0 a000c0d4: 0a000001 beq a000c0e0 <_Thread_Initialize+0x15c> (void) _Workspace_Free( sched ); a000c0d8: e1a00008 mov r0, r8 a000c0dc: eb0003fe bl a000d0dc <_Workspace_Free> _Thread_Stack_Free( the_thread ); a000c0e0: e1a00004 mov r0, r4 a000c0e4: eb0001f5 bl a000c8c0 <_Thread_Stack_Free> return false; a000c0e8: e3a00000 mov r0, #0 a000c0ec: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} * Allocate and Initialize the stack for this thread. */ #if !defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ a000c0f0: e1a00005 mov r0, r5 a000c0f4: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( a000c0f8: e2855001 add r5, r5, #1 a000c0fc: e1a00105 lsl r0, r5, #2 a000c100: eb0003ef bl a000d0c4 <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) a000c104: e2505000 subs r5, r0, #0 a000c108: 0a00000b beq a000c13c <_Thread_Initialize+0x1b8> goto failed; } the_thread->extensions = (void **) extensions_area; a000c10c: e5991000 ldr r1, [r9] a000c110: e58450fc str r5, [r4, #252] ; 0xfc a000c114: e1a03006 mov r3, r6 * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) the_thread->extensions[i] = NULL; a000c118: e1a02006 mov r2, r6 * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) a000c11c: e2833001 add r3, r3, #1 a000c120: e1530001 cmp r3, r1 the_thread->extensions[i] = NULL; a000c124: e7852106 str r2, [r5, r6, lsl #2] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) a000c128: e1a06003 mov r6, r3 a000c12c: 9afffffa bls a000c11c <_Thread_Initialize+0x198> a000c130: eaffffb4 b a000c008 <_Thread_Initialize+0x84> * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); if ( extension_status ) return true; a000c134: e1a00009 mov r0, r9 _Thread_Stack_Free( the_thread ); return false; } a000c138: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} size_t actual_stack_size = 0; void *stack = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) void *fp_area; #endif void *sched = NULL; a000c13c: e1a08005 mov r8, r5 a000c140: eaffffd2 b a000c090 <_Thread_Initialize+0x10c> =============================================================================== a0010904 <_Thread_Reset>: void _Thread_Reset( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { a0010904: e92d4030 push {r4, r5, lr} the_thread->resource_count = 0; the_thread->is_preemptible = the_thread->Start.is_preemptible; the_thread->budget_algorithm = the_thread->Start.budget_algorithm; a0010908: e590c0a4 ldr ip, [r0, #164] ; 0xa4 void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { the_thread->resource_count = 0; the_thread->is_preemptible = the_thread->Start.is_preemptible; a001090c: e5d0e0a0 ldrb lr, [r0, #160] ; 0xa0 the_thread->budget_algorithm = the_thread->Start.budget_algorithm; the_thread->budget_callout = the_thread->Start.budget_callout; a0010910: e59030a8 ldr r3, [r0, #168] ; 0xa8 Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { the_thread->resource_count = 0; a0010914: e3a05000 mov r5, #0 a0010918: e580501c str r5, [r0, #28] the_thread->is_preemptible = the_thread->Start.is_preemptible; a001091c: e5c0e074 strb lr, [r0, #116] ; 0x74 the_thread->budget_algorithm = the_thread->Start.budget_algorithm; a0010920: e580c07c str ip, [r0, #124] ; 0x7c the_thread->budget_callout = the_thread->Start.budget_callout; a0010924: e5803080 str r3, [r0, #128] ; 0x80 the_thread->Start.pointer_argument = pointer_argument; a0010928: e5801098 str r1, [r0, #152] ; 0x98 the_thread->Start.numeric_argument = numeric_argument; a001092c: e580209c str r2, [r0, #156] ; 0x9c void _Thread_Reset( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { a0010930: e1a04000 mov r4, r0 the_thread->budget_callout = the_thread->Start.budget_callout; the_thread->Start.pointer_argument = pointer_argument; the_thread->Start.numeric_argument = numeric_argument; if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { a0010934: ebfff269 bl a000d2e0 <_Thread_queue_Extract_with_proxy> a0010938: e1500005 cmp r0, r5 a001093c: 1a000002 bne a001094c <_Thread_Reset+0x48> if ( _Watchdog_Is_active( &the_thread->Timer ) ) a0010940: e5943050 ldr r3, [r4, #80] ; 0x50 a0010944: e3530002 cmp r3, #2 a0010948: 0a000008 beq a0010970 <_Thread_Reset+0x6c> (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { a001094c: e59410b0 ldr r1, [r4, #176] ; 0xb0 a0010950: e5943014 ldr r3, [r4, #20] a0010954: e1530001 cmp r3, r1 a0010958: 0a000003 beq a001096c <_Thread_Reset+0x68> the_thread->real_priority = the_thread->Start.initial_priority; _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); a001095c: e1a00004 mov r0, r4 if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { the_thread->real_priority = the_thread->Start.initial_priority; a0010960: e5841018 str r1, [r4, #24] _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); } } a0010964: e8bd4030 pop {r4, r5, lr} (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { the_thread->real_priority = the_thread->Start.initial_priority; _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); a0010968: eafff2d6 b a000d4c8 <_Thread_Set_priority> a001096c: e8bd8030 pop {r4, r5, pc} the_thread->Start.numeric_argument = numeric_argument; if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); a0010970: e2840048 add r0, r4, #72 ; 0x48 a0010974: ebfff4db bl a000dce8 <_Watchdog_Remove> <== NOT EXECUTED a0010978: eafffff3 b a001094c <_Thread_Reset+0x48> <== NOT EXECUTED =============================================================================== a000fb40 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { a000fb40: e92d4010 push {r4, lr} static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000fb44: e10f4000 mrs r4, CPSR a000fb48: e3843080 orr r3, r4, #128 ; 0x80 a000fb4c: e129f003 msr CPSR_fc, r3 ISR_Level level; States_Control current_state; _ISR_Disable( level ); current_state = the_thread->current_state; a000fb50: e5903010 ldr r3, [r0, #16] if ( current_state & STATES_SUSPENDED ) { a000fb54: e3130002 tst r3, #2 a000fb58: 0a000003 beq a000fb6c <_Thread_Resume+0x2c> RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); a000fb5c: e3c33002 bic r3, r3, #2 current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { a000fb60: e3530000 cmp r3, #0 _ISR_Disable( level ); current_state = the_thread->current_state; if ( current_state & STATES_SUSPENDED ) { current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); a000fb64: e5803010 str r3, [r0, #16] if ( _States_Is_ready( current_state ) ) { a000fb68: 0a000001 beq a000fb74 <_Thread_Resume+0x34> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000fb6c: e129f004 msr CPSR_fc, r4 _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); } a000fb70: e8bd8010 pop {r4, pc} RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); a000fb74: e59f2014 ldr r2, [pc, #20] ; a000fb90 <_Thread_Resume+0x50> a000fb78: e1a01000 mov r1, r0 a000fb7c: e5923010 ldr r3, [r2, #16] a000fb80: e1a00002 mov r0, r2 a000fb84: e12fff33 blx r3 a000fb88: e129f004 msr CPSR_fc, r4 a000fb8c: e8bd8010 pop {r4, pc} =============================================================================== a000c930 <_Thread_Start>: */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); a000c930: e590c010 ldr ip, [r0, #16] Thread_Start_types the_prototype, void *entry_point, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { a000c934: e92d4010 push {r4, lr} if ( _States_Is_dormant( the_thread->current_state ) ) { a000c938: e21cc001 ands ip, ip, #1 Thread_Start_types the_prototype, void *entry_point, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { a000c93c: e1a04000 mov r4, r0 if ( _States_Is_dormant( the_thread->current_state ) ) { a000c940: 1a000001 bne a000c94c <_Thread_Start+0x1c> _User_extensions_Thread_start( the_thread ); return true; } return false; a000c944: e1a0000c mov r0, ip <== NOT EXECUTED } a000c948: e8bd8010 pop {r4, pc} <== NOT EXECUTED if ( _States_Is_dormant( the_thread->current_state ) ) { the_thread->Start.entry_point = (Thread_Entry) entry_point; the_thread->Start.prototype = the_prototype; the_thread->Start.pointer_argument = pointer_argument; a000c94c: e5803098 str r3, [r0, #152] ; 0x98 the_thread->Start.numeric_argument = numeric_argument; a000c950: e59d3008 ldr r3, [sp, #8] Thread_Entry_numeric_type numeric_argument ) { if ( _States_Is_dormant( the_thread->current_state ) ) { the_thread->Start.entry_point = (Thread_Entry) entry_point; a000c954: e5802090 str r2, [r0, #144] ; 0x90 the_thread->Start.prototype = the_prototype; a000c958: e5801094 str r1, [r0, #148] ; 0x94 the_thread->Start.pointer_argument = pointer_argument; the_thread->Start.numeric_argument = numeric_argument; a000c95c: e580309c str r3, [r0, #156] ; 0x9c _Thread_Load_environment( the_thread ); a000c960: eb000b95 bl a000f7bc <_Thread_Load_environment> _Thread_Ready( the_thread ); a000c964: e1a00004 mov r0, r4 a000c968: eb000c39 bl a000fa54 <_Thread_Ready> _User_extensions_Thread_start( the_thread ); a000c96c: e1a00004 mov r0, r4 a000c970: eb0000d4 bl a000ccc8 <_User_extensions_Thread_start> return true; a000c974: e3a00001 mov r0, #1 a000c978: e8bd8010 pop {r4, pc} =============================================================================== a000ff64 <_Thread_Suspend>: */ void _Thread_Suspend( Thread_Control *the_thread ) { a000ff64: e92d4010 push {r4, lr} a000ff68: e1a01000 mov r1, r0 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000ff6c: e10f4000 mrs r4, CPSR a000ff70: e3843080 orr r3, r4, #128 ; 0x80 a000ff74: e129f003 msr CPSR_fc, r3 ISR_Level level; _ISR_Disable( level ); if ( !_States_Is_ready( the_thread->current_state ) ) { a000ff78: e5903010 ldr r3, [r0, #16] a000ff7c: e3530000 cmp r3, #0 a000ff80: 0a000003 beq a000ff94 <_Thread_Suspend+0x30> RTEMS_INLINE_ROUTINE States_Control _States_Set ( States_Control states_to_set, States_Control current_state ) { return (current_state | states_to_set); a000ff84: e3833002 orr r3, r3, #2 <== NOT EXECUTED the_thread->current_state = a000ff88: e5803010 str r3, [r0, #16] <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000ff8c: e129f004 msr CPSR_fc, r4 <== NOT EXECUTED a000ff90: e8bd8010 pop {r4, pc} <== NOT EXECUTED a000ff94: e59f0014 ldr r0, [pc, #20] ; a000ffb0 <_Thread_Suspend+0x4c> _States_Set( STATES_SUSPENDED, the_thread->current_state ); _ISR_Enable( level ); return; } the_thread->current_state = STATES_SUSPENDED; a000ff98: e3a03002 mov r3, #2 a000ff9c: e5813010 str r3, [r1, #16] a000ffa0: e590300c ldr r3, [r0, #12] a000ffa4: e12fff33 blx r3 a000ffa8: e129f004 msr CPSR_fc, r4 a000ffac: e8bd8010 pop {r4, pc} =============================================================================== a000c97c <_Thread_Tickle_timeslice>: void _Thread_Tickle_timeslice( void ) { Thread_Control *executing; executing = _Thread_Executing; a000c97c: e59f305c ldr r3, [pc, #92] ; a000c9e0 <_Thread_Tickle_timeslice+0x64> * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { a000c980: e92d4010 push {r4, lr} Thread_Control *executing; executing = _Thread_Executing; a000c984: e5934004 ldr r4, [r3, #4] /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) a000c988: e5d43074 ldrb r3, [r4, #116] ; 0x74 a000c98c: e3530000 cmp r3, #0 a000c990: 0a000005 beq a000c9ac <_Thread_Tickle_timeslice+0x30> return; if ( !_States_Is_ready( executing->current_state ) ) a000c994: e5943010 ldr r3, [r4, #16] a000c998: e3530000 cmp r3, #0 a000c99c: 1a000002 bne a000c9ac <_Thread_Tickle_timeslice+0x30> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { a000c9a0: e594307c ldr r3, [r4, #124] ; 0x7c a000c9a4: e3530001 cmp r3, #1 a000c9a8: 0a000000 beq a000c9b0 <_Thread_Tickle_timeslice+0x34> a000c9ac: e8bd8010 pop {r4, pc} case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: #endif if ( (int)(--executing->cpu_time_budget) <= 0 ) { a000c9b0: e5943078 ldr r3, [r4, #120] ; 0x78 <== NOT EXECUTED a000c9b4: e2433001 sub r3, r3, #1 <== NOT EXECUTED a000c9b8: e3530000 cmp r3, #0 <== NOT EXECUTED a000c9bc: e5843078 str r3, [r4, #120] ; 0x78 <== NOT EXECUTED a000c9c0: cafffff9 bgt a000c9ac <_Thread_Tickle_timeslice+0x30> <== NOT EXECUTED * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); a000c9c4: e59f0018 ldr r0, [pc, #24] ; a000c9e4 <_Thread_Tickle_timeslice+0x68><== NOT EXECUTED a000c9c8: e5903008 ldr r3, [r0, #8] <== NOT EXECUTED a000c9cc: e12fff33 blx r3 <== NOT EXECUTED * executing thread's timeslice is reset. Otherwise, the * currently executing thread is placed at the rear of the * FIFO for this priority and a new heir is selected. */ _Scheduler_Yield( ); executing->cpu_time_budget = _Thread_Ticks_per_timeslice; a000c9d0: e59f3010 ldr r3, [pc, #16] ; a000c9e8 <_Thread_Tickle_timeslice+0x6c><== NOT EXECUTED a000c9d4: e5933000 ldr r3, [r3] <== NOT EXECUTED a000c9d8: e5843078 str r3, [r4, #120] ; 0x78 <== NOT EXECUTED a000c9dc: eafffff2 b a000c9ac <_Thread_Tickle_timeslice+0x30> <== NOT EXECUTED =============================================================================== a000b974 <_Thread_blocking_operation_Cancel>: Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { a000b974: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { a000b978: e5913050 ldr r3, [r1, #80] ; 0x50 <== NOT EXECUTED Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { a000b97c: e24dd004 sub sp, sp, #4 <== NOT EXECUTED /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { a000b980: e3530002 cmp r3, #2 <== NOT EXECUTED #endif /* * The thread is not waiting on anything after this completes. */ the_thread->Wait.queue = NULL; a000b984: e3a03000 mov r3, #0 <== NOT EXECUTED a000b988: e5813044 str r3, [r1, #68] ; 0x44 <== NOT EXECUTED /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { a000b98c: 0a000005 beq a000b9a8 <_Thread_blocking_operation_Cancel+0x34><== NOT EXECUTED a000b990: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a000b994: e1a00001 mov r0, r1 <== NOT EXECUTED a000b998: e59f1028 ldr r1, [pc, #40] ; a000b9c8 <_Thread_blocking_operation_Cancel+0x54><== NOT EXECUTED #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } a000b99c: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000b9a0: e49de004 pop {lr} ; (ldr lr, [sp], #4) <== NOT EXECUTED a000b9a4: ea000066 b a000bb44 <_Thread_Clear_state> <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; a000b9a8: e3a03003 mov r3, #3 <== NOT EXECUTED a000b9ac: e5813050 str r3, [r1, #80] ; 0x50 <== NOT EXECUTED a000b9b0: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); a000b9b4: e2810048 add r0, r1, #72 ; 0x48 <== NOT EXECUTED a000b9b8: e58d1000 str r1, [sp] <== NOT EXECUTED a000b9bc: eb000553 bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a000b9c0: e59d1000 ldr r1, [sp] <== NOT EXECUTED a000b9c4: eafffff2 b a000b994 <_Thread_blocking_operation_Cancel+0x20><== NOT EXECUTED =============================================================================== a000f80c <_Thread_queue_Dequeue_fifo>: */ Thread_Control *_Thread_queue_Dequeue_fifo( Thread_queue_Control *the_thread_queue ) { a000f80c: e92d4030 push {r4, r5, lr} static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000f810: e10f2000 mrs r2, CPSR a000f814: e3823080 orr r3, r2, #128 ; 0x80 a000f818: e129f003 msr CPSR_fc, r3 return the_thread; } _ISR_Enable( level ); return NULL; } a000f81c: e1a03000 mov r3, r0 a000f820: e4934004 ldr r4, [r3], #4 { ISR_Level level; Thread_Control *the_thread; _ISR_Disable( level ); if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { a000f824: e1540003 cmp r4, r3 a000f828: 0a000018 beq a000f890 <_Thread_queue_Dequeue_fifo+0x84> the_thread = (Thread_Control *) _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000f82c: e5941050 ldr r1, [r4, #80] ; 0x50 Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; a000f830: e5943000 ldr r3, [r4] Thread_Control *the_thread; _ISR_Disable( level ); if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { the_thread = (Thread_Control *) a000f834: e1a05004 mov r5, r4 _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000f838: e3510002 cmp r1, #2 head->next = new_first; a000f83c: e5803000 str r3, [r0] new_first->previous = head; a000f840: e5830004 str r0, [r3, #4] if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { the_thread = (Thread_Control *) _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); the_thread->Wait.queue = NULL; a000f844: e3a03000 mov r3, #0 a000f848: e5843044 str r3, [r4, #68] ; 0x44 if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000f84c: 0a000005 beq a000f868 <_Thread_queue_Dequeue_fifo+0x5c> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000f850: e129f002 msr CPSR_fc, r2 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a000f854: e59f1040 ldr r1, [pc, #64] ; a000f89c <_Thread_queue_Dequeue_fifo+0x90> a000f858: e1a00004 mov r0, r4 a000f85c: ebfff0b8 bl a000bb44 <_Thread_Clear_state> return the_thread; } _ISR_Enable( level ); return NULL; } a000f860: e1a00005 mov r0, r5 a000f864: e8bd8030 pop {r4, r5, pc} RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; a000f868: e3a03003 mov r3, #3 <== NOT EXECUTED a000f86c: e5843050 str r3, [r4, #80] ; 0x50 <== NOT EXECUTED a000f870: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); a000f874: e2840048 add r0, r4, #72 ; 0x48 <== NOT EXECUTED a000f878: ebfff5a4 bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a000f87c: e1a00004 mov r0, r4 <== NOT EXECUTED a000f880: e59f1014 ldr r1, [pc, #20] ; a000f89c <_Thread_queue_Dequeue_fifo+0x90><== NOT EXECUTED a000f884: ebfff0ae bl a000bb44 <_Thread_Clear_state> <== NOT EXECUTED return the_thread; } _ISR_Enable( level ); return NULL; } a000f888: e1a00005 mov r0, r5 <== NOT EXECUTED a000f88c: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED a000f890: e129f002 msr CPSR_fc, r2 return the_thread; } _ISR_Enable( level ); return NULL; a000f894: e3a05000 mov r5, #0 a000f898: eafffff0 b a000f860 <_Thread_queue_Dequeue_fifo+0x54> =============================================================================== a000c25c <_Thread_queue_Dequeue_priority>: */ Thread_Control *_Thread_queue_Dequeue_priority( Thread_queue_Control *the_thread_queue ) { a000c25c: e92d4070 push {r4, r5, r6, lr} static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000c260: e10f6000 mrs r6, CPSR a000c264: e3863080 orr r3, r6, #128 ; 0x80 a000c268: e129f003 msr CPSR_fc, r3 Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); a000c26c: e3a02000 mov r2, #0 for( index=0 ; a000c270: e1a03002 mov r3, r2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); a000c274: e3a0c00c mov ip, #12 a000c278: e001039c mul r1, ip, r3 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } a000c27c: e7904002 ldr r4, [r0, r2] a000c280: e2811004 add r1, r1, #4 a000c284: e0801001 add r1, r0, r1 _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) { a000c288: e1540001 cmp r4, r1 Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { a000c28c: e2833001 add r3, r3, #1 if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) { a000c290: 1a000006 bne a000c2b0 <_Thread_queue_Dequeue_priority+0x54> Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; a000c294: e3530004 cmp r3, #4 index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { a000c298: e282200c add r2, r2, #12 Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; a000c29c: 1afffff5 bne a000c278 <_Thread_queue_Dequeue_priority+0x1c> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000c2a0: e129f006 msr CPSR_fc, r6 /* * We did not find a thread to unblock. */ _ISR_Enable( level ); return NULL; a000c2a4: e3a05000 mov r5, #0 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } a000c2a8: e1a00005 mov r0, r5 a000c2ac: e8bd8070 pop {r4, r5, r6, pc} a000c2b0: e5943038 ldr r3, [r4, #56] ; 0x38 a000c2b4: e284203c add r2, r4, #60 ; 0x3c _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) { the_thread = (Thread_Control *) _Chain_First( a000c2b8: e1a05004 mov r5, r4 new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; previous_node = the_thread->Object.Node.previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { a000c2bc: e1530002 cmp r3, r2 */ _ISR_Enable( level ); return NULL; dequeue: the_thread->Wait.queue = NULL; a000c2c0: e3a02000 mov r2, #0 a000c2c4: e5842044 str r2, [r4, #68] ; 0x44 new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; previous_node = the_thread->Object.Node.previous; a000c2c8: e5941004 ldr r1, [r4, #4] dequeue: the_thread->Wait.queue = NULL; new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; a000c2cc: e5942000 ldr r2, [r4] previous_node = the_thread->Object.Node.previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { a000c2d0: 0a000020 beq a000c358 <_Thread_queue_Dequeue_priority+0xfc> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } a000c2d4: e5940040 ldr r0, [r4, #64] ; 0x40 <== NOT EXECUTED next_node = the_thread->Object.Node.next; previous_node = the_thread->Object.Node.previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; a000c2d8: e593c000 ldr ip, [r3] <== NOT EXECUTED previous_node->next = new_first_node; next_node->previous = new_first_node; a000c2dc: e5823004 str r3, [r2, #4] <== NOT EXECUTED if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; a000c2e0: e5813000 str r3, [r1] <== NOT EXECUTED next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; a000c2e4: e5831004 str r1, [r3, #4] <== NOT EXECUTED last_node = _Chain_Last( &the_thread->Wait.Block2n ); 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; a000c2e8: e5832000 str r2, [r3] <== NOT EXECUTED new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { a000c2ec: e5941038 ldr r1, [r4, #56] ; 0x38 <== NOT EXECUTED a000c2f0: e5942040 ldr r2, [r4, #64] ; 0x40 <== NOT EXECUTED a000c2f4: e1510002 cmp r1, r2 <== NOT EXECUTED a000c2f8: 0a000005 beq a000c314 <_Thread_queue_Dequeue_priority+0xb8><== NOT EXECUTED /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); a000c2fc: e2831038 add r1, r3, #56 ; 0x38 <== NOT EXECUTED tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); a000c300: e283203c add r2, r3, #60 ; 0x3c <== NOT EXECUTED new_second_node->previous = head; a000c304: e58c1004 str r1, [ip, #4] <== NOT EXECUTED head->next = new_second_node; a000c308: e583c038 str ip, [r3, #56] ; 0x38 <== NOT EXECUTED tail->previous = last_node; a000c30c: e5830040 str r0, [r3, #64] ; 0x40 <== NOT EXECUTED last_node->next = tail; a000c310: e5802000 str r2, [r0] <== NOT EXECUTED } else { previous_node->next = next_node; next_node->previous = previous_node; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000c314: e5943050 ldr r3, [r4, #80] ; 0x50 a000c318: e3530002 cmp r3, #2 a000c31c: 0a000004 beq a000c334 <_Thread_queue_Dequeue_priority+0xd8> a000c320: e129f006 msr CPSR_fc, r6 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a000c324: e59f1038 ldr r1, [pc, #56] ; a000c364 <_Thread_queue_Dequeue_priority+0x108> a000c328: e1a00004 mov r0, r4 a000c32c: ebfffe04 bl a000bb44 <_Thread_Clear_state> a000c330: eaffffdc b a000c2a8 <_Thread_queue_Dequeue_priority+0x4c> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; a000c334: e3a03003 mov r3, #3 <== NOT EXECUTED a000c338: e5843050 str r3, [r4, #80] ; 0x50 <== NOT EXECUTED a000c33c: e129f006 msr CPSR_fc, r6 <== NOT EXECUTED _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); a000c340: e2840048 add r0, r4, #72 ; 0x48 <== NOT EXECUTED a000c344: eb0002f1 bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a000c348: e1a00004 mov r0, r4 <== NOT EXECUTED a000c34c: e59f1010 ldr r1, [pc, #16] ; a000c364 <_Thread_queue_Dequeue_priority+0x108><== NOT EXECUTED a000c350: ebfffdfb bl a000bb44 <_Thread_Clear_state> <== NOT EXECUTED a000c354: eaffffd3 b a000c2a8 <_Thread_queue_Dequeue_priority+0x4c> <== NOT EXECUTED head->next = new_second_node; tail->previous = last_node; last_node->next = tail; } } else { previous_node->next = next_node; a000c358: e5812000 str r2, [r1] next_node->previous = previous_node; a000c35c: e5821004 str r1, [r2, #4] a000c360: eaffffeb b a000c314 <_Thread_queue_Dequeue_priority+0xb8> =============================================================================== a000c414 <_Thread_queue_Enqueue_priority>: Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; a000c414: 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 ) { a000c418: e92d05f0 push {r4, r5, r6, r7, r8, sl} RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); a000c41c: e281403c add r4, r1, #60 ; 0x3c */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); a000c420: e281c038 add ip, r1, #56 ; 0x38 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; a000c424: 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 ) ) a000c428: e3130020 tst r3, #32 head->previous = NULL; a000c42c: e3a04000 mov r4, #0 tail->previous = head; a000c430: e581c040 str ip, [r1, #64] ; 0x40 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; a000c434: e581403c str r4, [r1, #60] ; 0x3c RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); a000c438: e1a0c323 lsr ip, 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; a000c43c: e5905038 ldr r5, [r0, #56] ; 0x38 if ( _Thread_queue_Is_reverse_search( priority ) ) a000c440: 0a00001e beq a000c4c0 <_Thread_queue_Enqueue_priority+0xac> * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } a000c444: e3a0700c mov r7, #12 a000c448: e59fa174 ldr sl, [pc, #372] ; a000c5c4 <_Thread_queue_Enqueue_priority+0x1b0> a000c44c: e027079c mla r7, ip, r7, r0 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; a000c450: e5da4000 ldrb r4, [sl] a000c454: e2844001 add r4, r4, #1 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000c458: e10f8000 mrs r8, CPSR a000c45c: e388c080 orr ip, r8, #128 ; 0x80 a000c460: e129f00c msr CPSR_fc, ip * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } a000c464: e597c008 ldr ip, [r7, #8] restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { a000c468: e15c0007 cmp ip, r7 a000c46c: 1a000009 bne a000c498 <_Thread_queue_Enqueue_priority+0x84> a000c470: ea00000b b a000c4a4 <_Thread_queue_Enqueue_priority+0x90> static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a000c474: e10f6000 mrs r6, CPSR <== NOT EXECUTED a000c478: e129f008 msr CPSR_fc, r8 <== NOT EXECUTED a000c47c: e129f006 msr CPSR_fc, r6 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); a000c480: e59c6010 ldr r6, [ip, #16] <== NOT EXECUTED 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) ) { a000c484: e1150006 tst r5, r6 <== NOT EXECUTED a000c488: 0a000033 beq a000c55c <_Thread_queue_Enqueue_priority+0x148><== NOT EXECUTED _ISR_Enable( level ); goto restart_reverse_search; } search_thread = (Thread_Control *) search_thread->Object.Node.previous; a000c48c: e59cc004 ldr ip, [ip, #4] <== NOT EXECUTED restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { a000c490: e15c0007 cmp ip, r7 <== NOT EXECUTED a000c494: 0a000002 beq a000c4a4 <_Thread_queue_Enqueue_priority+0x90><== NOT EXECUTED search_priority = search_thread->current_priority; a000c498: e59c4014 ldr r4, [ip, #20] if ( priority >= search_priority ) a000c49c: e1530004 cmp r3, r4 a000c4a0: 3afffff3 bcc a000c474 <_Thread_queue_Enqueue_priority+0x60> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != a000c4a4: e5905030 ldr r5, [r0, #48] ; 0x30 a000c4a8: e3550001 cmp r5, #1 a000c4ac: 0a00002e beq a000c56c <_Thread_queue_Enqueue_priority+0x158> * 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; a000c4b0: e5828000 str r8, [r2] <== NOT EXECUTED return the_thread_queue->sync_state; } a000c4b4: e1a00005 mov r0, r5 a000c4b8: e8bd05f0 pop {r4, r5, r6, r7, r8, sl} a000c4bc: e12fff1e bx lr a000c4c0: e3a0400c mov r4, #12 a000c4c4: e00c0c94 mul ip, r4, ip RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); a000c4c8: e28c7004 add r7, ip, #4 a000c4cc: e080a00c add sl, r0, ip a000c4d0: e0807007 add r7, r0, r7 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000c4d4: e10f8000 mrs r8, CPSR a000c4d8: e388c080 orr ip, r8, #128 ; 0x80 a000c4dc: e129f00c msr CPSR_fc, ip a000c4e0: e59ac000 ldr ip, [sl] restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { a000c4e4: e15c0007 cmp ip, r7 a000c4e8: 1a000009 bne a000c514 <_Thread_queue_Enqueue_priority+0x100> a000c4ec: ea000032 b a000c5bc <_Thread_queue_Enqueue_priority+0x1a8> static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a000c4f0: e10f6000 mrs r6, CPSR a000c4f4: e129f008 msr CPSR_fc, r8 a000c4f8: e129f006 msr CPSR_fc, r6 a000c4fc: 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) ) { a000c500: e1150006 tst r5, r6 a000c504: 0a000016 beq a000c564 <_Thread_queue_Enqueue_priority+0x150> _ISR_Enable( level ); goto restart_forward_search; } search_thread = (Thread_Control *)search_thread->Object.Node.next; a000c508: e59cc000 ldr ip, [ip] restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { a000c50c: e15c0007 cmp ip, r7 a000c510: 0a000002 beq a000c520 <_Thread_queue_Enqueue_priority+0x10c> search_priority = search_thread->current_priority; a000c514: e59c4014 ldr r4, [ip, #20] if ( priority <= search_priority ) a000c518: e1530004 cmp r3, r4 a000c51c: 8afffff3 bhi a000c4f0 <_Thread_queue_Enqueue_priority+0xdc> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != a000c520: e5905030 ldr r5, [r0, #48] ; 0x30 a000c524: e3550001 cmp r5, #1 a000c528: 1affffe0 bne a000c4b0 <_Thread_queue_Enqueue_priority+0x9c> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) a000c52c: 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; a000c530: e3a03000 mov r3, #0 a000c534: e5803030 str r3, [r0, #48] ; 0x30 if ( priority == search_priority ) a000c538: 0a000016 beq a000c598 <_Thread_queue_Enqueue_priority+0x184> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; a000c53c: e59c3004 ldr r3, [ip, #4] the_node = (Chain_Node *) the_thread; the_node->next = search_node; a000c540: e581c000 str ip, [r1] the_node->previous = previous_node; a000c544: e5813004 str r3, [r1, #4] previous_node->next = the_node; a000c548: e5831000 str r1, [r3] search_node->previous = the_node; a000c54c: e58c1004 str r1, [ip, #4] the_thread->Wait.queue = the_thread_queue; a000c550: e5810044 str r0, [r1, #68] ; 0x44 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000c554: e129f008 msr CPSR_fc, r8 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a000c558: eaffffd5 b a000c4b4 <_Thread_queue_Enqueue_priority+0xa0> a000c55c: e129f008 msr CPSR_fc, r8 <== NOT EXECUTED a000c560: eaffffba b a000c450 <_Thread_queue_Enqueue_priority+0x3c> <== NOT EXECUTED a000c564: e129f008 msr CPSR_fc, r8 <== NOT EXECUTED a000c568: eaffffd9 b a000c4d4 <_Thread_queue_Enqueue_priority+0xc0> <== NOT EXECUTED THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) a000c56c: 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; a000c570: e3a03000 mov r3, #0 a000c574: e5803030 str r3, [r0, #48] ; 0x30 if ( priority == search_priority ) a000c578: 0a000006 beq a000c598 <_Thread_queue_Enqueue_priority+0x184> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; a000c57c: e59c3000 ldr r3, [ip] the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; a000c580: e8811008 stm r1, {r3, ip} search_node->next = the_node; next_node->previous = the_node; a000c584: 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; a000c588: e58c1000 str r1, [ip] next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; a000c58c: e5810044 str r0, [r1, #68] ; 0x44 a000c590: e129f008 msr CPSR_fc, r8 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a000c594: eaffffc6 b a000c4b4 <_Thread_queue_Enqueue_priority+0xa0> equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; a000c598: e59c3040 ldr r3, [ip, #64] ; 0x40 <== NOT EXECUTED the_thread->Wait.queue = the_thread_queue; _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 ); a000c59c: e28c203c add r2, ip, #60 ; 0x3c <== NOT EXECUTED previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; a000c5a0: e881000c stm r1, {r2, r3} <== NOT EXECUTED the_node->previous = previous_node; previous_node->next = the_node; a000c5a4: e5831000 str r1, [r3] <== NOT EXECUTED search_node->previous = the_node; a000c5a8: e58c1040 str r1, [ip, #64] ; 0x40 <== NOT EXECUTED the_thread->Wait.queue = the_thread_queue; a000c5ac: e5810044 str r0, [r1, #68] ; 0x44 <== NOT EXECUTED a000c5b0: e129f008 msr CPSR_fc, r8 <== NOT EXECUTED _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; a000c5b4: e3a05001 mov r5, #1 <== NOT EXECUTED a000c5b8: eaffffbd b a000c4b4 <_Thread_queue_Enqueue_priority+0xa0> <== NOT EXECUTED if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; a000c5bc: e3e04000 mvn r4, #0 a000c5c0: eaffffd6 b a000c520 <_Thread_queue_Enqueue_priority+0x10c> =============================================================================== a000c368 <_Thread_queue_Enqueue_with_handler>: Thread_queue_Control *, Thread_Control *, ISR_Level * ); the_thread = _Thread_Executing; a000c368: e59f3094 ldr r3, [pc, #148] ; a000c404 <_Thread_queue_Enqueue_with_handler+0x9c> void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { a000c36c: e92d40f0 push {r4, r5, r6, r7, lr} Thread_queue_Control *, Thread_Control *, ISR_Level * ); the_thread = _Thread_Executing; a000c370: e5934004 ldr r4, [r3, #4] void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { a000c374: e1a06001 mov r6, r1 a000c378: e24dd004 sub sp, sp, #4 else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state ); a000c37c: e5901038 ldr r1, [r0, #56] ; 0x38 void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { a000c380: e1a05000 mov r5, r0 else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state ); a000c384: e1a00004 mov r0, r4 void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { a000c388: e1a07002 mov r7, r2 else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state ); a000c38c: eb0000f4 bl a000c764 <_Thread_Set_state> /* * If the thread wants to timeout, then schedule its timer. */ if ( timeout ) { a000c390: e3560000 cmp r6, #0 a000c394: 1a00000f bne a000c3d8 <_Thread_queue_Enqueue_with_handler+0x70> } /* * Now enqueue the thread per the discipline for this thread queue. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) a000c398: e595c034 ldr ip, [r5, #52] ; 0x34 enqueue_p = _Thread_queue_Enqueue_priority; a000c39c: e59f2064 ldr r2, [pc, #100] ; a000c408 <_Thread_queue_Enqueue_with_handler+0xa0> a000c3a0: e59f3064 ldr r3, [pc, #100] ; a000c40c <_Thread_queue_Enqueue_with_handler+0xa4> a000c3a4: e35c0001 cmp ip, #1 a000c3a8: 01a03002 moveq r3, r2 else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ enqueue_p = _Thread_queue_Enqueue_fifo; sync_state = (*enqueue_p)( the_thread_queue, the_thread, &level ); a000c3ac: e1a00005 mov r0, r5 a000c3b0: e1a01004 mov r1, r4 a000c3b4: e1a0200d mov r2, sp a000c3b8: e12fff33 blx r3 if ( sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) a000c3bc: e3500001 cmp r0, #1 a000c3c0: 0a000002 beq a000c3d0 <_Thread_queue_Enqueue_with_handler+0x68> _Thread_blocking_operation_Cancel( sync_state, the_thread, level ); a000c3c4: e1a01004 mov r1, r4 <== NOT EXECUTED a000c3c8: e59d2000 ldr r2, [sp] <== NOT EXECUTED a000c3cc: ebfffd68 bl a000b974 <_Thread_blocking_operation_Cancel> <== NOT EXECUTED } a000c3d0: e28dd004 add sp, sp, #4 a000c3d4: e8bd80f0 pop {r4, r5, r6, r7, pc} /* * If the thread wants to timeout, then schedule its timer. */ if ( timeout ) { _Watchdog_Initialize( a000c3d8: e5942008 ldr r2, [r4, #8] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000c3dc: e3a03000 mov r3, #0 a000c3e0: e5843050 str r3, [r4, #80] ; 0x50 the_watchdog->routine = routine; a000c3e4: e5847064 str r7, [r4, #100] ; 0x64 the_watchdog->id = id; a000c3e8: e5842068 str r2, [r4, #104] ; 0x68 the_watchdog->user_data = user_data; a000c3ec: e584306c str r3, [r4, #108] ; 0x6c Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000c3f0: e5846054 str r6, [r4, #84] ; 0x54 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000c3f4: e59f0014 ldr r0, [pc, #20] ; a000c410 <_Thread_queue_Enqueue_with_handler+0xa8> a000c3f8: e2841048 add r1, r4, #72 ; 0x48 a000c3fc: eb000254 bl a000cd54 <_Watchdog_Insert> a000c400: eaffffe4 b a000c398 <_Thread_queue_Enqueue_with_handler+0x30> =============================================================================== a00110cc <_Thread_queue_Extract_fifo>: void _Thread_queue_Extract_fifo( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread ) { a00110cc: e52de004 push {lr} ; (str lr, [sp, #-4]!) a00110d0: e24dd004 sub sp, sp, #4 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a00110d4: e10f0000 mrs r0, CPSR a00110d8: e3803080 orr r3, r0, #128 ; 0x80 a00110dc: e129f003 msr CPSR_fc, r3 a00110e0: e5912010 ldr r2, [r1, #16] a00110e4: e3a03bef mov r3, #244736 ; 0x3bc00 a00110e8: e2833e2e add r3, r3, #736 ; 0x2e0 a00110ec: e0023003 and r3, r2, r3 ISR_Level level; _ISR_Disable( level ); if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { a00110f0: e3530000 cmp r3, #0 a00110f4: 0a00000d beq a0011130 <_Thread_queue_Extract_fifo+0x64> _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a00110f8: e591c050 ldr ip, [r1, #80] ; 0x50 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; a00110fc: e891000c ldm r1, {r2, r3} a0011100: e35c0002 cmp ip, #2 next->previous = previous; a0011104: e5823004 str r3, [r2, #4] previous->next = next; a0011108: e5832000 str r2, [r3] return; } _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; a001110c: e3a03000 mov r3, #0 a0011110: e5813044 str r3, [r1, #68] ; 0x44 if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a0011114: 0a000008 beq a001113c <_Thread_queue_Extract_fifo+0x70> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0011118: e129f000 msr CPSR_fc, r0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); a001111c: e1a00001 mov r0, r1 a0011120: e59f1034 ldr r1, [pc, #52] ; a001115c <_Thread_queue_Extract_fifo+0x90> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } a0011124: e28dd004 add sp, sp, #4 a0011128: e49de004 pop {lr} ; (ldr lr, [sp], #4) a001112c: eaffea84 b a000bb44 <_Thread_Clear_state> a0011130: e129f000 msr CPSR_fc, r0 a0011134: e28dd004 add sp, sp, #4 a0011138: e8bd8000 pop {pc} a001113c: e3a03003 mov r3, #3 <== NOT EXECUTED a0011140: e5813050 str r3, [r1, #80] ; 0x50 <== NOT EXECUTED a0011144: e129f000 msr CPSR_fc, r0 <== 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 ); a0011148: e2810048 add r0, r1, #72 ; 0x48 <== NOT EXECUTED a001114c: e58d1000 str r1, [sp] <== NOT EXECUTED a0011150: ebffef6e bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a0011154: e59d1000 ldr r1, [sp] <== NOT EXECUTED a0011158: eaffffef b a001111c <_Thread_queue_Extract_fifo+0x50> <== NOT EXECUTED =============================================================================== a000f910 <_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 ) { a000f910: e92d4070 push {r4, r5, r6, lr} a000f914: e20220ff and r2, r2, #255 ; 0xff a000f918: e24dd004 sub sp, sp, #4 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000f91c: e10fc000 mrs ip, CPSR a000f920: e38c3080 orr r3, ip, #128 ; 0x80 a000f924: 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); a000f928: e5910010 ldr r0, [r1, #16] a000f92c: e3a03bef mov r3, #244736 ; 0x3bc00 a000f930: e2833e2e add r3, r3, #736 ; 0x2e0 a000f934: e0003003 and r3, r0, r3 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 ) ) { a000f938: e3530000 cmp r3, #0 a000f93c: 0a000024 beq a000f9d4 <_Thread_queue_Extract_priority_helper+0xc4> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } a000f940: e5913038 ldr r3, [r1, #56] ; 0x38 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); a000f944: e281403c add r4, r1, #60 ; 0x3c /* * The thread was actually waiting on a thread queue so let's remove it. */ next_node = the_node->next; a000f948: e5910000 ldr r0, [r1] previous_node = the_node->previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { a000f94c: e1530004 cmp r3, r4 /* * The thread was actually waiting on a thread queue so let's remove it. */ next_node = the_node->next; previous_node = the_node->previous; a000f950: e5914004 ldr r4, [r1, #4] head->next = new_second_node; tail->previous = last_node; last_node->next = tail; } } else { previous_node->next = next_node; a000f954: 05840000 streq r0, [r4] next_node->previous = previous_node; a000f958: 05804004 streq r4, [r0, #4] */ next_node = the_node->next; previous_node = the_node->previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { a000f95c: 0a00000e beq a000f99c <_Thread_queue_Extract_priority_helper+0x8c> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } a000f960: e5915040 ldr r5, [r1, #64] ; 0x40 <== NOT EXECUTED if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; a000f964: e5936000 ldr r6, [r3] <== NOT EXECUTED previous_node->next = new_first_node; next_node->previous = new_first_node; a000f968: e5803004 str r3, [r0, #4] <== NOT EXECUTED new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; a000f96c: e5843000 str r3, [r4] <== NOT EXECUTED next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; a000f970: e8830011 stm r3, {r0, r4} <== NOT EXECUTED if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { a000f974: e5914038 ldr r4, [r1, #56] ; 0x38 <== NOT EXECUTED a000f978: e5910040 ldr r0, [r1, #64] ; 0x40 <== NOT EXECUTED a000f97c: e1540000 cmp r4, r0 <== NOT EXECUTED a000f980: 0a000005 beq a000f99c <_Thread_queue_Extract_priority_helper+0x8c><== NOT EXECUTED /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); a000f984: e2834038 add r4, r3, #56 ; 0x38 <== NOT EXECUTED tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); a000f988: e283003c add r0, r3, #60 ; 0x3c <== NOT EXECUTED new_second_node->previous = head; a000f98c: e5864004 str r4, [r6, #4] <== NOT EXECUTED head->next = new_second_node; a000f990: e5836038 str r6, [r3, #56] ; 0x38 <== NOT EXECUTED tail->previous = last_node; a000f994: e5835040 str r5, [r3, #64] ; 0x40 <== NOT EXECUTED last_node->next = tail; a000f998: e5850000 str r0, [r5] <== NOT EXECUTED /* * If we are not supposed to touch timers or the thread's state, return. */ if ( requeuing ) { a000f99c: e3520000 cmp r2, #0 a000f9a0: 1a000008 bne a000f9c8 <_Thread_queue_Extract_priority_helper+0xb8> _ISR_Enable( level ); return; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { a000f9a4: e5913050 ldr r3, [r1, #80] ; 0x50 <== NOT EXECUTED a000f9a8: e3530002 cmp r3, #2 <== NOT EXECUTED a000f9ac: 0a00000a beq a000f9dc <_Thread_queue_Extract_priority_helper+0xcc><== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000f9b0: e129f00c msr CPSR_fc, ip <== NOT EXECUTED a000f9b4: e1a00001 mov r0, r1 <== NOT EXECUTED a000f9b8: e59f103c ldr r1, [pc, #60] ; a000f9fc <_Thread_queue_Extract_priority_helper+0xec><== NOT EXECUTED #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } a000f9bc: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000f9c0: e8bd4070 pop {r4, r5, r6, lr} <== NOT EXECUTED a000f9c4: eafff05e b a000bb44 <_Thread_Clear_state> <== NOT EXECUTED a000f9c8: e129f00c msr CPSR_fc, ip a000f9cc: e28dd004 add sp, sp, #4 a000f9d0: e8bd8070 pop {r4, r5, r6, pc} a000f9d4: e129f00c msr CPSR_fc, ip a000f9d8: eafffffb b a000f9cc <_Thread_queue_Extract_priority_helper+0xbc> a000f9dc: e3a03003 mov r3, #3 <== NOT EXECUTED a000f9e0: e5813050 str r3, [r1, #80] ; 0x50 <== NOT EXECUTED a000f9e4: e129f00c msr CPSR_fc, ip <== 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 ); a000f9e8: e2810048 add r0, r1, #72 ; 0x48 <== NOT EXECUTED a000f9ec: e58d1000 str r1, [sp] <== NOT EXECUTED a000f9f0: ebfff546 bl a000cf10 <_Watchdog_Remove> <== NOT EXECUTED a000f9f4: e59d1000 ldr r1, [sp] <== NOT EXECUTED a000f9f8: eaffffed b a000f9b4 <_Thread_queue_Extract_priority_helper+0xa4><== NOT EXECUTED =============================================================================== a00212b4 <_Thread_queue_First_priority>: */ Thread_Control *_Thread_queue_First_priority ( Thread_queue_Control *the_thread_queue ) { a00212b4: e3a03000 mov r3, #0 <== NOT EXECUTED a00212b8: e52d4004 push {r4} ; (str r4, [sp, #-4]!) <== NOT EXECUTED uint32_t index; for( index=0 ; a00212bc: e1a02003 mov r2, r3 <== NOT EXECUTED a00212c0: e3a0400c mov r4, #12 <== NOT EXECUTED a00212c4: e00c0294 mul ip, r4, r2 <== NOT EXECUTED return (Thread_Control *) _Chain_First( &the_thread_queue->Queues.Priority[ index ] ); } return NULL; } a00212c8: e7901003 ldr r1, [r0, r3] <== NOT EXECUTED a00212cc: e28cc004 add ip, ip, #4 <== NOT EXECUTED a00212d0: e080c00c add ip, r0, ip <== NOT EXECUTED uint32_t index; for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) a00212d4: e151000c cmp r1, ip <== NOT EXECUTED { uint32_t index; for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { a00212d8: e2822001 add r2, r2, #1 <== NOT EXECUTED if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) a00212dc: 1a000005 bne a00212f8 <_Thread_queue_First_priority+0x44> <== NOT EXECUTED Thread_queue_Control *the_thread_queue ) { uint32_t index; for( index=0 ; a00212e0: e3520004 cmp r2, #4 <== NOT EXECUTED index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { a00212e4: e283300c add r3, r3, #12 <== NOT EXECUTED Thread_queue_Control *the_thread_queue ) { uint32_t index; for( index=0 ; a00212e8: 1afffff5 bne a00212c4 <_Thread_queue_First_priority+0x10> <== NOT EXECUTED if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) return (Thread_Control *) _Chain_First( &the_thread_queue->Queues.Priority[ index ] ); } return NULL; a00212ec: e3a00000 mov r0, #0 <== NOT EXECUTED } a00212f0: e8bd0010 pop {r4} <== NOT EXECUTED a00212f4: e12fff1e bx lr <== NOT EXECUTED for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) return (Thread_Control *) _Chain_First( a00212f8: e1a00001 mov r0, r1 <== NOT EXECUTED a00212fc: eafffffb b a00212f0 <_Thread_queue_First_priority+0x3c> <== NOT EXECUTED =============================================================================== a000fa00 <_Thread_queue_Process_timeout>: #include void _Thread_queue_Process_timeout( Thread_Control *the_thread ) { a000fa00: e1a03000 mov r3, r0 <== NOT EXECUTED Thread_queue_Control *the_thread_queue = the_thread->Wait.queue; a000fa04: e5900044 ldr r0, [r0, #68] ; 0x44 <== NOT EXECUTED * If it is not satisfied, then it is "nothing happened" and * this is the "timeout" transition. After a request is satisfied, * a timeout is not allowed to occur. */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && a000fa08: e5902030 ldr r2, [r0, #48] ; 0x30 <== NOT EXECUTED a000fa0c: e3520000 cmp r2, #0 <== NOT EXECUTED a000fa10: 0a000003 beq a000fa24 <_Thread_queue_Process_timeout+0x24> <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); a000fa14: e59f1034 ldr r1, [pc, #52] ; a000fa50 <_Thread_queue_Process_timeout+0x50><== NOT EXECUTED a000fa18: e5911004 ldr r1, [r1, #4] <== NOT EXECUTED a000fa1c: e1530001 cmp r3, r1 <== NOT EXECUTED a000fa20: 0a000003 beq a000fa34 <_Thread_queue_Process_timeout+0x34> <== NOT EXECUTED if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; a000fa24: e590203c ldr r2, [r0, #60] ; 0x3c <== NOT EXECUTED _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); a000fa28: e1a01003 mov r1, r3 <== NOT EXECUTED if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; a000fa2c: e5832034 str r2, [r3, #52] ; 0x34 <== NOT EXECUTED _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); a000fa30: eaffffb0 b a000f8f8 <_Thread_queue_Extract> <== NOT EXECUTED * a timeout is not allowed to occur. */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { a000fa34: e3520003 cmp r2, #3 <== NOT EXECUTED a000fa38: 012fff1e bxeq lr <== NOT EXECUTED the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; a000fa3c: e590203c ldr r2, [r0, #60] ; 0x3c <== NOT EXECUTED a000fa40: e5832034 str r2, [r3, #52] ; 0x34 <== NOT EXECUTED the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; a000fa44: e3a03002 mov r3, #2 <== NOT EXECUTED a000fa48: e5803030 str r3, [r0, #48] ; 0x30 <== NOT EXECUTED a000fa4c: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000c700 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { a000c700: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED a000c704: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a000c708: e1a0100d mov r1, sp <== NOT EXECUTED a000c70c: ebfffdf7 bl a000bef0 <_Thread_Get> <== NOT EXECUTED switch ( location ) { a000c710: e59d3000 ldr r3, [sp] <== NOT EXECUTED a000c714: e3530000 cmp r3, #0 <== NOT EXECUTED a000c718: 1a000004 bne a000c730 <_Thread_queue_Timeout+0x30> <== NOT EXECUTED #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); a000c71c: eb000cb7 bl a000fa00 <_Thread_queue_Process_timeout> <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; a000c720: e59f3010 ldr r3, [pc, #16] ; a000c738 <_Thread_queue_Timeout+0x38><== NOT EXECUTED a000c724: e5932000 ldr r2, [r3] <== NOT EXECUTED a000c728: e2422001 sub r2, r2, #1 <== NOT EXECUTED a000c72c: e5832000 str r2, [r3] <== NOT EXECUTED _Thread_Unnest_dispatch(); break; } } a000c730: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000c734: e8bd8000 pop {pc} <== NOT EXECUTED =============================================================================== a001a350 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { a001a350: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} a001a354: e24dd028 sub sp, sp, #40 ; 0x28 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; a001a358: e28d101c add r1, sp, #28 a001a35c: e2812004 add r2, r1, #4 a001a360: e28d7010 add r7, sp, #16 head->previous = NULL; tail->previous = head; a001a364: e58d1024 str r1, [sp, #36] ; 0x24 a001a368: e59f91d0 ldr r9, [pc, #464] ; a001a540 <_Timer_server_Body+0x1f0> a001a36c: e2801008 add r1, r0, #8 a001a370: e59fb1cc ldr fp, [pc, #460] ; a001a544 <_Timer_server_Body+0x1f4> { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; a001a374: e3a03000 mov r3, #0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; a001a378: e287a004 add sl, r7, #4 a001a37c: e58d1008 str r1, [sp, #8] a001a380: e2801040 add r1, r0, #64 ; 0x40 a001a384: e1a04000 mov r4, r0 a001a388: e58d201c str r2, [sp, #28] head->previous = NULL; a001a38c: e58d3020 str r3, [sp, #32] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; a001a390: e58da010 str sl, [sp, #16] head->previous = NULL; a001a394: e58d3014 str r3, [sp, #20] tail->previous = head; a001a398: e58d7018 str r7, [sp, #24] a001a39c: e2806030 add r6, r0, #48 ; 0x30 a001a3a0: e2808068 add r8, r0, #104 ; 0x68 a001a3a4: e58d100c str r1, [sp, #12] */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_tail( const Chain_Control *the_chain ) { return &the_chain->Tail.Node; a001a3a8: e58d2004 str r2, [sp, #4] Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; a001a3ac: e58da000 str sl, [sp] a001a3b0: e59da004 ldr sl, [sp, #4] a001a3b4: e28d201c add r2, sp, #28 a001a3b8: e5842078 str r2, [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; a001a3bc: e5993000 ldr r3, [r9] /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; a001a3c0: e594103c ldr r1, [r4, #60] ; 0x3c watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); a001a3c4: e1a02007 mov r2, r7 a001a3c8: e1a00006 mov r0, r6 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; a001a3cc: e584303c str r3, [r4, #60] ; 0x3c _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); a001a3d0: e0611003 rsb r1, r1, r3 a001a3d4: eb00114c bl a001e90c <_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(); a001a3d8: e59b5000 ldr r5, [fp] Watchdog_Interval last_snapshot = watchdogs->last_snapshot; a001a3dc: 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 ) { a001a3e0: e1550002 cmp r5, r2 a001a3e4: 8a00003c bhi a001a4dc <_Timer_server_Body+0x18c> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { a001a3e8: 3a000032 bcc a001a4b8 <_Timer_server_Body+0x168> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; a001a3ec: 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 ); a001a3f0: e5940078 ldr r0, [r4, #120] ; 0x78 a001a3f4: eb0002be bl a001aef4 <_Chain_Get> if ( timer == NULL ) { a001a3f8: e2501000 subs r1, r0, #0 a001a3fc: 0a00000b beq a001a430 <_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 ) { a001a400: e5913038 ldr r3, [r1, #56] ; 0x38 <== NOT EXECUTED a001a404: e3530001 cmp r3, #1 <== NOT EXECUTED a001a408: 0a00002f beq a001a4cc <_Timer_server_Body+0x17c> <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { a001a40c: e3530003 cmp r3, #3 <== NOT EXECUTED a001a410: 1afffff6 bne a001a3f0 <_Timer_server_Body+0xa0> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); a001a414: e2811010 add r1, r1, #16 <== NOT EXECUTED a001a418: e1a00008 mov r0, r8 <== NOT EXECUTED a001a41c: eb001165 bl a001e9b8 <_Watchdog_Insert> <== NOT EXECUTED } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); a001a420: e5940078 ldr r0, [r4, #120] ; 0x78 <== NOT EXECUTED a001a424: eb0002b2 bl a001aef4 <_Chain_Get> <== NOT EXECUTED if ( timer == NULL ) { a001a428: e2501000 subs r1, r0, #0 <== NOT EXECUTED a001a42c: 1afffff3 bne a001a400 <_Timer_server_Body+0xb0> <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001a430: e10f3000 mrs r3, CPSR a001a434: e3832080 orr r2, r3, #128 ; 0x80 a001a438: e129f002 msr CPSR_fc, r2 * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; a001a43c: e5942078 ldr r2, [r4, #120] ; 0x78 if ( _Chain_Is_empty( insert_chain ) ) { a001a440: e59d201c ldr r2, [sp, #28] a001a444: e152000a cmp r2, sl ts->insert_chain = NULL; a001a448: 05841078 streq r1, [r4, #120] ; 0x78 */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; if ( _Chain_Is_empty( insert_chain ) ) { a001a44c: 13a01001 movne r1, #1 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001a450: e129f003 msr CPSR_fc, r3 * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; while ( do_loop ) { a001a454: e3510000 cmp r1, #0 a001a458: 1affffd7 bne a001a3bc <_Timer_server_Body+0x6c> a001a45c: e59da000 ldr sl, [sp] _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 ) ) { a001a460: e59d3010 ldr r3, [sp, #16] a001a464: e153000a cmp r3, sl a001a468: 1a00000a bne a001a498 <_Timer_server_Body+0x148> a001a46c: ea00001f b a001a4f0 <_Timer_server_Body+0x1a0> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; a001a470: e5923000 ldr r3, [r2] head->next = new_first; new_first->previous = head; a001a474: e5837004 str r7, [r3, #4] { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; a001a478: e58d3010 str r3, [sp, #16] * 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; a001a47c: e3a03000 mov r3, #0 a001a480: e5823008 str r3, [r2, #8] a001a484: 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 ); a001a488: e592301c ldr r3, [r2, #28] a001a48c: e5920020 ldr r0, [r2, #32] a001a490: e5921024 ldr r1, [r2, #36] ; 0x24 a001a494: e12fff33 blx r3 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001a498: e10f1000 mrs r1, CPSR a001a49c: e3813080 orr r3, r1, #128 ; 0x80 a001a4a0: e129f003 msr CPSR_fc, r3 initialized = false; } #endif return status; } a001a4a4: e59d2010 ldr r2, [sp, #16] */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) a001a4a8: e152000a cmp r2, sl a001a4ac: 1affffef bne a001a470 <_Timer_server_Body+0x120> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001a4b0: e129f001 msr CPSR_fc, r1 a001a4b4: eaffffbc b a001a3ac <_Timer_server_Body+0x5c> /* * 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 ); a001a4b8: e1a00008 mov r0, r8 <== NOT EXECUTED a001a4bc: e3a01001 mov r1, #1 <== NOT EXECUTED a001a4c0: e0652002 rsb r2, r5, r2 <== NOT EXECUTED a001a4c4: eb0010df bl a001e848 <_Watchdog_Adjust> <== NOT EXECUTED a001a4c8: eaffffc7 b a001a3ec <_Timer_server_Body+0x9c> <== NOT EXECUTED Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); a001a4cc: e1a00006 mov r0, r6 <== NOT EXECUTED a001a4d0: e2811010 add r1, r1, #16 <== NOT EXECUTED a001a4d4: eb001137 bl a001e9b8 <_Watchdog_Insert> <== NOT EXECUTED a001a4d8: eaffffc4 b a001a3f0 <_Timer_server_Body+0xa0> <== NOT EXECUTED /* * 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 ); a001a4dc: e0621005 rsb r1, r2, r5 a001a4e0: e1a00008 mov r0, r8 a001a4e4: e1a02007 mov r2, r7 a001a4e8: eb001107 bl a001e90c <_Watchdog_Adjust_to_chain> a001a4ec: eaffffbe b a001a3ec <_Timer_server_Body+0x9c> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; a001a4f0: e5c4107c strb r1, [r4, #124] ; 0x7c a001a4f4: e59f104c ldr r1, [pc, #76] ; a001a548 <_Timer_server_Body+0x1f8> a001a4f8: e5913000 ldr r3, [r1] a001a4fc: e2833001 add r3, r3, #1 a001a500: e5813000 str r3, [r1] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); a001a504: e3a01008 mov r1, #8 a001a508: e5940000 ldr r0, [r4] a001a50c: eb000f0e bl a001e14c <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); a001a510: e1a00004 mov r0, r4 a001a514: ebffff61 bl a001a2a0 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); a001a518: e1a00004 mov r0, r4 a001a51c: ebffff75 bl a001a2f8 <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); a001a520: eb000cb1 bl a001d7ec <_Thread_Enable_dispatch> ts->active = true; a001a524: e3a02001 mov r2, #1 a001a528: e5c4207c strb r2, [r4, #124] ; 0x7c static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); a001a52c: e59d0008 ldr r0, [sp, #8] a001a530: eb00118f bl a001eb74 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); a001a534: e59d000c ldr r0, [sp, #12] a001a538: eb00118d bl a001eb74 <_Watchdog_Remove> a001a53c: eaffff9a b a001a3ac <_Timer_server_Body+0x5c> =============================================================================== a001a54c <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { if ( ts->insert_chain == NULL ) { a001a54c: e5902078 ldr r2, [r0, #120] ; 0x78 static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { a001a550: e92d4030 push {r4, r5, lr} if ( ts->insert_chain == NULL ) { a001a554: e3520000 cmp r2, #0 static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { a001a558: e1a04000 mov r4, r0 a001a55c: e1a03001 mov r3, r1 if ( ts->insert_chain == NULL ) { a001a560: 0a000002 beq a001a570 <_Timer_server_Schedule_operation_method+0x24> * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); a001a564: e5900078 ldr r0, [r0, #120] ; 0x78 <== NOT EXECUTED } } a001a568: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); a001a56c: ea00024d b a001aea8 <_Chain_Append> <== NOT EXECUTED a001a570: e59f1104 ldr r1, [pc, #260] ; a001a67c <_Timer_server_Schedule_operation_method+0x130> a001a574: e5910000 ldr r0, [r1] a001a578: e2800001 add r0, r0, #1 a001a57c: e5810000 str r0, [r1] * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { a001a580: e5931038 ldr r1, [r3, #56] ; 0x38 a001a584: e3510001 cmp r1, #1 a001a588: 0a000021 beq a001a614 <_Timer_server_Schedule_operation_method+0xc8> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); if ( !ts->active ) { _Timer_server_Reset_interval_system_watchdog( ts ); } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { a001a58c: e3510003 cmp r1, #3 a001a590: 0a000001 beq a001a59c <_Timer_server_Schedule_operation_method+0x50> * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); } } a001a594: e8bd4030 pop {r4, r5, lr} if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); a001a598: ea000c93 b a001d7ec <_Thread_Enable_dispatch> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001a59c: e10fe000 mrs lr, CPSR a001a5a0: e38e1080 orr r1, lr, #128 ; 0x80 a001a5a4: e129f001 msr CPSR_fc, r1 initialized = false; } #endif return status; } a001a5a8: e5941068 ldr r1, [r4, #104] ; 0x68 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); a001a5ac: e284006c add r0, r4, #108 ; 0x6c * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; a001a5b0: e594c074 ldr ip, [r4, #116] ; 0x74 if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { a001a5b4: e1510000 cmp r1, r0 /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); a001a5b8: e59f00c0 ldr r0, [pc, #192] ; a001a680 <_Timer_server_Schedule_operation_method+0x134> a001a5bc: e5900000 ldr r0, [r0] last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { a001a5c0: 0a000008 beq a001a5e8 <_Timer_server_Schedule_operation_method+0x9c> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; a001a5c4: e5915010 ldr r5, [r1, #16] <== NOT EXECUTED if ( snapshot > last_snapshot ) { a001a5c8: e150000c cmp r0, ip <== NOT EXECUTED } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; a001a5cc: 9085200c addls r2, r5, ip <== NOT EXECUTED delta_interval += delta; a001a5d0: 90602002 rsbls r2, r0, r2 <== NOT EXECUTED snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { a001a5d4: 9a000002 bls a001a5e4 <_Timer_server_Schedule_operation_method+0x98><== NOT EXECUTED /* * We advanced in time. */ delta = snapshot - last_snapshot; a001a5d8: e06cc000 rsb ip, ip, r0 <== NOT EXECUTED if (delta_interval > delta) { a001a5dc: e155000c cmp r5, ip <== NOT EXECUTED delta_interval -= delta; a001a5e0: 806c2005 rsbhi r2, ip, r5 <== NOT EXECUTED * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; a001a5e4: e5812010 str r2, [r1, #16] <== NOT EXECUTED } ts->TOD_watchdogs.last_snapshot = snapshot; a001a5e8: e5840074 str r0, [r4, #116] ; 0x74 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001a5ec: e129f00e msr CPSR_fc, lr _ISR_Enable( level ); _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); a001a5f0: e2831010 add r1, r3, #16 a001a5f4: e2840068 add r0, r4, #104 ; 0x68 a001a5f8: eb0010ee bl a001e9b8 <_Watchdog_Insert> if ( !ts->active ) { a001a5fc: e5d4307c ldrb r3, [r4, #124] ; 0x7c a001a600: e3530000 cmp r3, #0 a001a604: 1affffe2 bne a001a594 <_Timer_server_Schedule_operation_method+0x48> _Timer_server_Reset_tod_system_watchdog( ts ); a001a608: e1a00004 mov r0, r4 a001a60c: ebffff39 bl a001a2f8 <_Timer_server_Reset_tod_system_watchdog> a001a610: eaffffdf b a001a594 <_Timer_server_Schedule_operation_method+0x48> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001a614: e10f5000 mrs r5, CPSR a001a618: e3851080 orr r1, r5, #128 ; 0x80 a001a61c: e129f001 msr CPSR_fc, r1 initialized = false; } #endif return status; } a001a620: e5941030 ldr r1, [r4, #48] ; 0x30 a001a624: e2840034 add r0, r4, #52 ; 0x34 * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; last_snapshot = ts->Interval_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { a001a628: e1510000 cmp r1, r0 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; a001a62c: e59f0050 ldr r0, [pc, #80] ; a001a684 <_Timer_server_Schedule_operation_method+0x138> a001a630: e5900000 ldr r0, [r0] last_snapshot = ts->Interval_watchdogs.last_snapshot; a001a634: e594c03c ldr ip, [r4, #60] ; 0x3c if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { a001a638: 0a000004 beq a001a650 <_Timer_server_Schedule_operation_method+0x104> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; a001a63c: e591e010 ldr lr, [r1, #16] first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; a001a640: e06cc000 rsb ip, ip, r0 delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { a001a644: e15c000e cmp ip, lr delta_interval -= delta; a001a648: 306c200e rsbcc r2, ip, lr } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; a001a64c: e5812010 str r2, [r1, #16] } ts->Interval_watchdogs.last_snapshot = snapshot; a001a650: e584003c str r0, [r4, #60] ; 0x3c static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001a654: e129f005 msr CPSR_fc, r5 _ISR_Enable( level ); _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); a001a658: e2831010 add r1, r3, #16 a001a65c: e2840030 add r0, r4, #48 ; 0x30 a001a660: eb0010d4 bl a001e9b8 <_Watchdog_Insert> if ( !ts->active ) { a001a664: e5d4307c ldrb r3, [r4, #124] ; 0x7c a001a668: e3530000 cmp r3, #0 a001a66c: 1affffc8 bne a001a594 <_Timer_server_Schedule_operation_method+0x48> _Timer_server_Reset_interval_system_watchdog( ts ); a001a670: e1a00004 mov r0, r4 a001a674: ebffff09 bl a001a2a0 <_Timer_server_Reset_interval_system_watchdog> a001a678: eaffffc5 b a001a594 <_Timer_server_Schedule_operation_method+0x48> =============================================================================== a000c9ec <_Timespec_Add_to>: uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { a000c9ec: e1a03000 mov r3, r0 uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; a000c9f0: e5902004 ldr r2, [r0, #4] uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { a000c9f4: e52d4004 push {r4} ; (str r4, [sp, #-4]!) uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; a000c9f8: e8910011 ldm r1, {r0, r4} /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000c9fc: e59fc040 ldr ip, [pc, #64] ; a000ca44 <_Timespec_Add_to+0x58> ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; a000ca00: e5931000 ldr r1, [r3] time->tv_nsec += add->tv_nsec; a000ca04: e0844002 add r4, r4, r2 /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000ca08: e154000c cmp r4, ip ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; a000ca0c: e0811000 add r1, r1, r0 time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000ca10: e1a02004 mov r2, r4 ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; a000ca14: e8830012 stm r3, {r1, r4} time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000ca18: 9a000007 bls a000ca3c <_Timespec_Add_to+0x50> time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; a000ca1c: e2822331 add r2, r2, #-1006632960 ; 0xc4000000 <== NOT EXECUTED a000ca20: e2822865 add r2, r2, #6619136 ; 0x650000 <== NOT EXECUTED a000ca24: e2822c36 add r2, r2, #13824 ; 0x3600 <== NOT EXECUTED /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000ca28: e152000c cmp r2, ip <== NOT EXECUTED * * This routines adds two timespecs. The second argument is added * to the first. */ uint32_t _Timespec_Add_to( a000ca2c: e2811001 add r1, r1, #1 <== NOT EXECUTED /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; time->tv_sec++; seconds++; a000ca30: e2800001 add r0, r0, #1 <== NOT EXECUTED /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { a000ca34: 8afffff8 bhi a000ca1c <_Timespec_Add_to+0x30> <== NOT EXECUTED a000ca38: e8830006 stm r3, {r1, r2} <== NOT EXECUTED time->tv_sec++; seconds++; } return seconds; } a000ca3c: e8bd0010 pop {r4} a000ca40: e12fff1e bx lr =============================================================================== a000e694 <_Timespec_Divide>: const struct timespec *lhs, const struct timespec *rhs, uint32_t *ival_percentage, uint32_t *fval_percentage ) { a000e694: e92d4bf0 push {r4, r5, r6, r7, r8, r9, fp, lr} * in a 64-bit integer. */ left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; right += rhs->tv_nsec; a000e698: e5916004 ldr r6, [r1, #4] * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; a000e69c: e591c000 ldr ip, [r1] a000e6a0: e59f1084 ldr r1, [pc, #132] ; a000e72c <_Timespec_Divide+0x98> right += rhs->tv_nsec; a000e6a4: e1a07fc6 asr r7, r6, #31 const struct timespec *lhs, const struct timespec *rhs, uint32_t *ival_percentage, uint32_t *fval_percentage ) { a000e6a8: e1a05002 mov r5, r2 * in a 64-bit integer. */ left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; right += rhs->tv_nsec; a000e6ac: e0e76c91 smlal r6, r7, r1, ip const struct timespec *lhs, const struct timespec *rhs, uint32_t *ival_percentage, uint32_t *fval_percentage ) { a000e6b0: e1a04003 mov r4, r3 left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; right += rhs->tv_nsec; if ( right == 0 ) { a000e6b4: e1962007 orrs r2, r6, r7 /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; a000e6b8: e8900808 ldm r0, {r3, fp} left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; right += rhs->tv_nsec; if ( right == 0 ) { a000e6bc: 0a000017 beq a000e720 <_Timespec_Divide+0x8c> /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ left = lhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; left += lhs->tv_nsec; a000e6c0: e1a0cfcb asr ip, fp, #31 <== NOT EXECUTED a000e6c4: e0ecb391 smlal fp, ip, r1, r3 <== NOT EXECUTED * Put it back in the timespec result. * * TODO: Rounding on the last digit of the fval. */ answer = (left * 100000) / right; a000e6c8: e3a01b61 mov r1, #99328 ; 0x18400 <== NOT EXECUTED a000e6cc: e2811e2a add r1, r1, #672 ; 0x2a0 <== NOT EXECUTED a000e6d0: e089819b umull r8, r9, fp, r1 <== NOT EXECUTED a000e6d4: e1a02006 mov r2, r6 <== NOT EXECUTED a000e6d8: e0299c91 mla r9, r1, ip, r9 <== NOT EXECUTED a000e6dc: e1a03007 mov r3, r7 <== NOT EXECUTED a000e6e0: e1a00008 mov r0, r8 <== NOT EXECUTED a000e6e4: e1a01009 mov r1, r9 <== NOT EXECUTED a000e6e8: eb003d73 bl a001dcbc <__udivdi3> <== NOT EXECUTED *ival_percentage = answer / 1000; a000e6ec: e3a02ffa mov r2, #1000 ; 0x3e8 <== NOT EXECUTED a000e6f0: e3a03000 mov r3, #0 <== NOT EXECUTED * Put it back in the timespec result. * * TODO: Rounding on the last digit of the fval. */ answer = (left * 100000) / right; a000e6f4: e1a06000 mov r6, r0 <== NOT EXECUTED a000e6f8: e1a07001 mov r7, r1 <== NOT EXECUTED *ival_percentage = answer / 1000; a000e6fc: eb003d6e bl a001dcbc <__udivdi3> <== NOT EXECUTED *fval_percentage = answer % 1000; a000e700: e1a01007 mov r1, r7 <== NOT EXECUTED * TODO: Rounding on the last digit of the fval. */ answer = (left * 100000) / right; *ival_percentage = answer / 1000; a000e704: e5850000 str r0, [r5] <== NOT EXECUTED *fval_percentage = answer % 1000; a000e708: e3a02ffa mov r2, #1000 ; 0x3e8 <== NOT EXECUTED a000e70c: e3a03000 mov r3, #0 <== NOT EXECUTED a000e710: e1a00006 mov r0, r6 <== NOT EXECUTED a000e714: eb003e7a bl a001e104 <__umoddi3> <== NOT EXECUTED a000e718: e5840000 str r0, [r4] <== NOT EXECUTED a000e71c: e8bd8bf0 pop {r4, r5, r6, r7, r8, r9, fp, pc} <== NOT EXECUTED left += lhs->tv_nsec; right = rhs->tv_sec * (uint64_t)TOD_NANOSECONDS_PER_SECOND; right += rhs->tv_nsec; if ( right == 0 ) { *ival_percentage = 0; a000e720: e5852000 str r2, [r5] *fval_percentage = 0; a000e724: e5842000 str r2, [r4] return; a000e728: e8bd8bf0 pop {r4, r5, r6, r7, r8, r9, fp, pc} =============================================================================== a000e6c4 <_Timespec_Divide_by_integer>: /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ t = time->tv_sec; a000e6c4: e590c000 ldr ip, [r0] <== NOT EXECUTED t *= TOD_NANOSECONDS_PER_SECOND; a000e6c8: e59f3068 ldr r3, [pc, #104] ; a000e738 <_Timespec_Divide_by_integer+0x74><== NOT EXECUTED void _Timespec_Divide_by_integer( const struct timespec *time, uint32_t iterations, struct timespec *result ) { a000e6cc: e92d41f0 push {r4, r5, r6, r7, r8, lr} <== NOT EXECUTED /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ t = time->tv_sec; t *= TOD_NANOSECONDS_PER_SECOND; a000e6d0: e086539c umull r5, r6, ip, r3 <== NOT EXECUTED /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ t = time->tv_sec; a000e6d4: e1a0700c mov r7, ip <== NOT EXECUTED a000e6d8: e1a08fc7 asr r8, r7, #31 <== NOT EXECUTED t *= TOD_NANOSECONDS_PER_SECOND; t += time->tv_nsec; a000e6dc: e5900004 ldr r0, [r0, #4] <== NOT EXECUTED /* * For math simplicity just convert the timespec to nanoseconds * in a 64-bit integer. */ t = time->tv_sec; t *= TOD_NANOSECONDS_PER_SECOND; a000e6e0: e0266893 mla r6, r3, r8, r6 <== NOT EXECUTED /* * Divide to get nanoseconds per iteration */ t /= iterations; a000e6e4: e0957000 adds r7, r5, r0 <== NOT EXECUTED a000e6e8: e0a68fc0 adc r8, r6, r0, asr #31 <== NOT EXECUTED void _Timespec_Divide_by_integer( const struct timespec *time, uint32_t iterations, struct timespec *result ) { a000e6ec: e1a04002 mov r4, r2 <== NOT EXECUTED /* * Divide to get nanoseconds per iteration */ t /= iterations; a000e6f0: e3a03000 mov r3, #0 <== NOT EXECUTED a000e6f4: e1a02001 mov r2, r1 <== NOT EXECUTED a000e6f8: e1a00007 mov r0, r7 <== NOT EXECUTED a000e6fc: e1a01008 mov r1, r8 <== NOT EXECUTED a000e700: eb003bab bl a001d5b4 <__udivdi3> <== NOT EXECUTED /* * Put it back in the timespec result */ result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND; a000e704: e59f202c ldr r2, [pc, #44] ; a000e738 <_Timespec_Divide_by_integer+0x74><== NOT EXECUTED a000e708: e3a03000 mov r3, #0 <== NOT EXECUTED /* * Divide to get nanoseconds per iteration */ t /= iterations; a000e70c: e1a05000 mov r5, r0 <== NOT EXECUTED a000e710: e1a06001 mov r6, r1 <== NOT EXECUTED /* * Put it back in the timespec result */ result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND; a000e714: eb003ba6 bl a001d5b4 <__udivdi3> <== NOT EXECUTED result->tv_nsec = t % TOD_NANOSECONDS_PER_SECOND; a000e718: e59f2018 ldr r2, [pc, #24] ; a000e738 <_Timespec_Divide_by_integer+0x74><== NOT EXECUTED /* * Put it back in the timespec result */ result->tv_sec = t / TOD_NANOSECONDS_PER_SECOND; a000e71c: e5840000 str r0, [r4] <== NOT EXECUTED result->tv_nsec = t % TOD_NANOSECONDS_PER_SECOND; a000e720: e3a03000 mov r3, #0 <== NOT EXECUTED a000e724: e1a01006 mov r1, r6 <== NOT EXECUTED a000e728: e1a00005 mov r0, r5 <== NOT EXECUTED a000e72c: eb003cb2 bl a001d9fc <__umoddi3> <== NOT EXECUTED a000e730: e5840004 str r0, [r4, #4] <== NOT EXECUTED } a000e734: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED =============================================================================== a000da60 <_Timespec_From_ticks>: struct timespec *time ) { uint32_t usecs; usecs = ticks * rtems_configuration_get_microseconds_per_tick(); a000da60: e59f2034 ldr r2, [pc, #52] ; a000da9c <_Timespec_From_ticks+0x3c><== NOT EXECUTED time->tv_sec = usecs / TOD_MICROSECONDS_PER_SECOND; time->tv_nsec = (usecs % TOD_MICROSECONDS_PER_SECOND) * a000da64: e3a0393d mov r3, #999424 ; 0xf4000 <== NOT EXECUTED a000da68: e2833d09 add r3, r3, #576 ; 0x240 <== NOT EXECUTED struct timespec *time ) { uint32_t usecs; usecs = ticks * rtems_configuration_get_microseconds_per_tick(); a000da6c: e592200c ldr r2, [r2, #12] <== NOT EXECUTED a000da70: e0020290 mul r2, r0, r2 <== NOT EXECUTED time->tv_sec = usecs / TOD_MICROSECONDS_PER_SECOND; a000da74: e59f0024 ldr r0, [pc, #36] ; a000daa0 <_Timespec_From_ticks+0x40><== NOT EXECUTED a000da78: e080c092 umull ip, r0, r2, r0 <== NOT EXECUTED a000da7c: e1a00920 lsr r0, r0, #18 <== NOT EXECUTED time->tv_nsec = (usecs % TOD_MICROSECONDS_PER_SECOND) * a000da80: e0030390 mul r3, r0, r3 <== NOT EXECUTED { uint32_t usecs; usecs = ticks * rtems_configuration_get_microseconds_per_tick(); time->tv_sec = usecs / TOD_MICROSECONDS_PER_SECOND; a000da84: e5810000 str r0, [r1] <== NOT EXECUTED time->tv_nsec = (usecs % TOD_MICROSECONDS_PER_SECOND) * a000da88: e0632002 rsb r2, r3, r2 <== NOT EXECUTED a000da8c: e3a03ffa mov r3, #1000 ; 0x3e8 <== NOT EXECUTED a000da90: e0020293 mul r2, r3, r2 <== NOT EXECUTED a000da94: e5812004 str r2, [r1, #4] <== NOT EXECUTED TOD_NANOSECONDS_PER_MICROSECOND; } a000da98: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000e73c <_Timespec_Greater_than>: bool _Timespec_Greater_than( const struct timespec *lhs, const struct timespec *rhs ) { if ( lhs->tv_sec > rhs->tv_sec ) a000e73c: e5902000 ldr r2, [r0] a000e740: e5913000 ldr r3, [r1] a000e744: e1520003 cmp r2, r3 return true; a000e748: c3a00001 movgt r0, #1 bool _Timespec_Greater_than( const struct timespec *lhs, const struct timespec *rhs ) { if ( lhs->tv_sec > rhs->tv_sec ) a000e74c: c12fff1e bxgt lr return true; if ( lhs->tv_sec < rhs->tv_sec ) a000e750: ba000005 blt a000e76c <_Timespec_Greater_than+0x30> #include #include #include bool _Timespec_Greater_than( a000e754: e5900004 ldr r0, [r0, #4] a000e758: e5913004 ldr r3, [r1, #4] a000e75c: e1500003 cmp r0, r3 a000e760: d3a00000 movle r0, #0 a000e764: c3a00001 movgt r0, #1 a000e768: e12fff1e bx lr { if ( lhs->tv_sec > rhs->tv_sec ) return true; if ( lhs->tv_sec < rhs->tv_sec ) return false; a000e76c: e3a00000 mov r0, #0 /* ASSERT: lhs->tv_sec == rhs->tv_sec */ if ( lhs->tv_nsec > rhs->tv_nsec ) return true; return false; } a000e770: e12fff1e bx lr =============================================================================== a000daa4 <_Timespec_Is_valid>: bool _Timespec_Is_valid( const struct timespec *time ) { if ( !time ) a000daa4: e3500000 cmp r0, #0 <== NOT EXECUTED a000daa8: 012fff1e bxeq lr <== NOT EXECUTED return false; if ( time->tv_sec < 0 ) a000daac: e5903000 ldr r3, [r0] <== NOT EXECUTED a000dab0: e3530000 cmp r3, #0 <== NOT EXECUTED return false; a000dab4: b3a00000 movlt r0, #0 <== NOT EXECUTED ) { if ( !time ) return false; if ( time->tv_sec < 0 ) a000dab8: b12fff1e bxlt lr <== NOT EXECUTED return false; if ( time->tv_nsec < 0 ) a000dabc: e5903004 ldr r3, [r0, #4] <== NOT EXECUTED a000dac0: e3530000 cmp r3, #0 <== NOT EXECUTED a000dac4: ba000004 blt a000dadc <_Timespec_Is_valid+0x38> <== NOT EXECUTED #include #include #include bool _Timespec_Is_valid( a000dac8: e59f0014 ldr r0, [pc, #20] ; a000dae4 <_Timespec_Is_valid+0x40><== NOT EXECUTED a000dacc: e1530000 cmp r3, r0 <== NOT EXECUTED a000dad0: 83a00000 movhi r0, #0 <== NOT EXECUTED a000dad4: 93a00001 movls r0, #1 <== NOT EXECUTED a000dad8: e12fff1e bx lr <== NOT EXECUTED if ( time->tv_sec < 0 ) return false; if ( time->tv_nsec < 0 ) return false; a000dadc: e3a00000 mov r0, #0 <== NOT EXECUTED if ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) return false; return true; } a000dae0: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000e774 <_Timespec_Less_than>: bool _Timespec_Less_than( const struct timespec *lhs, const struct timespec *rhs ) { if ( lhs->tv_sec < rhs->tv_sec ) a000e774: e5902000 ldr r2, [r0] a000e778: e5913000 ldr r3, [r1] a000e77c: e1520003 cmp r2, r3 return true; a000e780: b3a00001 movlt r0, #1 bool _Timespec_Less_than( const struct timespec *lhs, const struct timespec *rhs ) { if ( lhs->tv_sec < rhs->tv_sec ) a000e784: b12fff1e bxlt lr return true; if ( lhs->tv_sec > rhs->tv_sec ) a000e788: ca000005 bgt a000e7a4 <_Timespec_Less_than+0x30> #include #include #include bool _Timespec_Less_than( a000e78c: e5900004 ldr r0, [r0, #4] a000e790: e5913004 ldr r3, [r1, #4] a000e794: e1500003 cmp r0, r3 a000e798: a3a00000 movge r0, #0 a000e79c: b3a00001 movlt r0, #1 a000e7a0: e12fff1e bx lr { if ( lhs->tv_sec < rhs->tv_sec ) return true; if ( lhs->tv_sec > rhs->tv_sec ) return false; a000e7a4: e3a00000 mov r0, #0 /* ASSERT: lhs->tv_sec == rhs->tv_sec */ if ( lhs->tv_nsec < rhs->tv_nsec ) return true; return false; } a000e7a8: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000ca48 <_Timespec_Subtract>: const struct timespec *end, struct timespec *result ) { if (end->tv_nsec < start->tv_nsec) { a000ca48: e591c004 ldr ip, [r1, #4] a000ca4c: e5903004 ldr r3, [r0, #4] void _Timespec_Subtract( const struct timespec *start, const struct timespec *end, struct timespec *result ) { a000ca50: e52d4004 push {r4} ; (str r4, [sp, #-4]!) if (end->tv_nsec < start->tv_nsec) { a000ca54: e15c0003 cmp ip, r3 a000ca58: ba000007 blt a000ca7c <_Timespec_Subtract+0x34> result->tv_sec = end->tv_sec - start->tv_sec - 1; result->tv_nsec = (TOD_NANOSECONDS_PER_SECOND - start->tv_nsec) + end->tv_nsec; } else { result->tv_sec = end->tv_sec - start->tv_sec; a000ca5c: e5914000 ldr r4, [r1] a000ca60: e5901000 ldr r1, [r0] result->tv_nsec = end->tv_nsec - start->tv_nsec; a000ca64: e063300c rsb r3, r3, ip a000ca68: e5823004 str r3, [r2, #4] if (end->tv_nsec < start->tv_nsec) { result->tv_sec = end->tv_sec - start->tv_sec - 1; result->tv_nsec = (TOD_NANOSECONDS_PER_SECOND - start->tv_nsec) + end->tv_nsec; } else { result->tv_sec = end->tv_sec - start->tv_sec; a000ca6c: e0613004 rsb r3, r1, r4 a000ca70: e5823000 str r3, [r2] result->tv_nsec = end->tv_nsec - start->tv_nsec; } } a000ca74: e8bd0010 pop {r4} a000ca78: e12fff1e bx lr struct timespec *result ) { if (end->tv_nsec < start->tv_nsec) { result->tv_sec = end->tv_sec - start->tv_sec - 1; a000ca7c: e5911000 ldr r1, [r1] <== NOT EXECUTED a000ca80: e5900000 ldr r0, [r0] <== NOT EXECUTED result->tv_nsec = (TOD_NANOSECONDS_PER_SECOND - start->tv_nsec) + end->tv_nsec; a000ca84: e28cc5ee add ip, ip, #998244352 ; 0x3b800000 <== NOT EXECUTED a000ca88: e28cc96b add ip, ip, #1753088 ; 0x1ac000 <== NOT EXECUTED struct timespec *result ) { if (end->tv_nsec < start->tv_nsec) { result->tv_sec = end->tv_sec - start->tv_sec - 1; a000ca8c: e2411001 sub r1, r1, #1 <== NOT EXECUTED result->tv_nsec = (TOD_NANOSECONDS_PER_SECOND - start->tv_nsec) + end->tv_nsec; a000ca90: e28ccc0a add ip, ip, #2560 ; 0xa00 <== NOT EXECUTED struct timespec *result ) { if (end->tv_nsec < start->tv_nsec) { result->tv_sec = end->tv_sec - start->tv_sec - 1; a000ca94: e0601001 rsb r1, r0, r1 <== NOT EXECUTED result->tv_nsec = (TOD_NANOSECONDS_PER_SECOND - start->tv_nsec) + end->tv_nsec; a000ca98: e063300c rsb r3, r3, ip <== NOT EXECUTED struct timespec *result ) { if (end->tv_nsec < start->tv_nsec) { result->tv_sec = end->tv_sec - start->tv_sec - 1; a000ca9c: e882000a stm r2, {r1, r3} <== NOT EXECUTED a000caa0: eafffff3 b a000ca74 <_Timespec_Subtract+0x2c> <== NOT EXECUTED =============================================================================== a000db44 <_Timespec_To_ticks>: */ uint32_t _Timespec_To_ticks( const struct timespec *time ) { a000db44: e92d4030 push {r4, r5, lr} <== NOT EXECUTED uint32_t ticks; if ( (time->tv_sec == 0) && (time->tv_nsec == 0) ) a000db48: e5904000 ldr r4, [r0] <== NOT EXECUTED */ uint32_t _Timespec_To_ticks( const struct timespec *time ) { a000db4c: e1a05000 mov r5, r0 <== NOT EXECUTED uint32_t ticks; if ( (time->tv_sec == 0) && (time->tv_nsec == 0) ) a000db50: e3540000 cmp r4, #0 <== NOT EXECUTED a000db54: 1a000002 bne a000db64 <_Timespec_To_ticks+0x20> <== NOT EXECUTED a000db58: e5900004 ldr r0, [r0, #4] <== NOT EXECUTED a000db5c: e3500000 cmp r0, #0 <== NOT EXECUTED a000db60: 0a000009 beq a000db8c <_Timespec_To_ticks+0x48> <== NOT EXECUTED return 0; ticks = time->tv_sec * TOD_TICKS_PER_SECOND; a000db64: eb000a34 bl a001043c <== NOT EXECUTED ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick(); a000db68: e59f3020 ldr r3, [pc, #32] ; a000db90 <_Timespec_To_ticks+0x4c><== NOT EXECUTED a000db6c: e3a01ffa mov r1, #1000 ; 0x3e8 <== NOT EXECUTED uint32_t ticks; if ( (time->tv_sec == 0) && (time->tv_nsec == 0) ) return 0; ticks = time->tv_sec * TOD_TICKS_PER_SECOND; a000db70: e0040490 mul r4, r0, r4 <== NOT EXECUTED ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick(); a000db74: e593300c ldr r3, [r3, #12] <== NOT EXECUTED a000db78: e5950004 ldr r0, [r5, #4] <== NOT EXECUTED a000db7c: e0010193 mul r1, r3, r1 <== NOT EXECUTED a000db80: eb003cc3 bl a001ce94 <__aeabi_uidiv> <== NOT EXECUTED if (ticks) a000db84: e0940000 adds r0, r4, r0 <== NOT EXECUTED return ticks; return 1; a000db88: 03a00001 moveq r0, #1 <== NOT EXECUTED } a000db8c: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a000cbcc <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { a000cbcc: e92d41f0 push {r4, r5, r6, r7, r8, lr} the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } a000cbd0: e59f5040 ldr r5, [pc, #64] ; a000cc18 <_User_extensions_Fatal+0x4c> void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { a000cbd4: e1a08000 mov r8, r0 a000cbd8: e1a07002 mov r7, r2 the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } a000cbdc: e5954008 ldr r4, [r5, #8] void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { a000cbe0: e20160ff and r6, r1, #255 ; 0xff Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); a000cbe4: e1540005 cmp r4, r5 a000cbe8: 0a000009 beq a000cc14 <_User_extensions_Fatal+0x48> !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) a000cbec: e5943030 ldr r3, [r4, #48] ; 0x30 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); a000cbf0: e1a00008 mov r0, r8 a000cbf4: e1a01006 mov r1, r6 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) a000cbf8: e3530000 cmp r3, #0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); a000cbfc: e1a02007 mov r2, r7 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) a000cc00: 0a000000 beq a000cc08 <_User_extensions_Fatal+0x3c> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); a000cc04: e12fff33 blx r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { a000cc08: e5944004 ldr r4, [r4, #4] ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); a000cc0c: e1540005 cmp r4, r5 a000cc10: 1afffff5 bne a000cbec <_User_extensions_Fatal+0x20> a000cc14: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED =============================================================================== a000e3d8 <_User_extensions_Remove_set>: #include void _User_extensions_Remove_set ( User_extensions_Control *the_extension ) { a000e3d8: e92d4010 push {r4, lr} a000e3dc: e1a04000 mov r4, r0 _Chain_Extract( &the_extension->Node ); a000e3e0: ebfff60a bl a000bc10 <_Chain_Extract> /* * If a switch handler is present, remove it. */ if ( the_extension->Callouts.thread_switch != NULL ) a000e3e4: e5943024 ldr r3, [r4, #36] ; 0x24 a000e3e8: e3530000 cmp r3, #0 a000e3ec: 0a000002 beq a000e3fc <_User_extensions_Remove_set+0x24> _Chain_Extract( &the_extension->Switch.Node ); a000e3f0: e2840008 add r0, r4, #8 } a000e3f4: e8bd4010 pop {r4, lr} /* * If a switch handler is present, remove it. */ if ( the_extension->Callouts.thread_switch != NULL ) _Chain_Extract( &the_extension->Switch.Node ); a000e3f8: eafff604 b a000bc10 <_Chain_Extract> a000e3fc: e8bd8010 pop {r4, pc} =============================================================================== a000cc1c <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { a000cc1c: e92d40f0 push {r4, r5, r6, r7, lr} return false; } } return true; } a000cc20: e59f504c ldr r5, [pc, #76] ; a000cc74 <_User_extensions_Thread_create+0x58> #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { a000cc24: e1a06000 mov r6, r0 return false; } } return true; } a000cc28: e4954004 ldr r4, [r5], #4 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); a000cc2c: e1540005 cmp r4, r5 a000cc30: 0a00000d beq a000cc6c <_User_extensions_Thread_create+0x50> 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)( a000cc34: e59f703c ldr r7, [pc, #60] ; a000cc78 <_User_extensions_Thread_create+0x5c> !_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 ) { a000cc38: e5943014 ldr r3, [r4, #20] status = (*the_extension->Callouts.thread_create)( a000cc3c: 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 ) { a000cc40: e3530000 cmp r3, #0 a000cc44: 0a000003 beq a000cc58 <_User_extensions_Thread_create+0x3c> status = (*the_extension->Callouts.thread_create)( a000cc48: e5970004 ldr r0, [r7, #4] a000cc4c: e12fff33 blx r3 _Thread_Executing, the_thread ); if ( !status ) a000cc50: e3500000 cmp r0, #0 a000cc54: 0a000005 beq a000cc70 <_User_extensions_Thread_create+0x54> User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { a000cc58: e5944000 ldr r4, [r4] { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); a000cc5c: e1540005 cmp r4, r5 a000cc60: 1afffff4 bne a000cc38 <_User_extensions_Thread_create+0x1c> if ( !status ) return false; } } return true; a000cc64: e3a00001 mov r0, #1 a000cc68: e8bd80f0 pop {r4, r5, r6, r7, pc} a000cc6c: e3a00001 mov r0, #1 <== NOT EXECUTED } a000cc70: e8bd80f0 pop {r4, r5, r6, r7, pc} =============================================================================== a000cb8c <_User_extensions_Thread_exitted>: } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { a000cb8c: e92d4070 push {r4, r5, r6, lr} the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } a000cb90: e59f5030 ldr r5, [pc, #48] ; a000cbc8 <_User_extensions_Thread_exitted+0x3c> } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { a000cb94: e1a06000 mov r6, r0 the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } a000cb98: e5954008 ldr r4, [r5, #8] ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); a000cb9c: e1540005 cmp r4, r5 a000cba0: 0a000007 beq a000cbc4 <_User_extensions_Thread_exitted+0x38> !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) a000cba4: e594302c ldr r3, [r4, #44] ; 0x2c (*the_extension->Callouts.thread_exitted)( executing ); a000cba8: e1a00006 mov r0, r6 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) a000cbac: e3530000 cmp r3, #0 a000cbb0: 0a000000 beq a000cbb8 <_User_extensions_Thread_exitted+0x2c> (*the_extension->Callouts.thread_exitted)( executing ); a000cbb4: e12fff33 blx r3 <== NOT EXECUTED Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { a000cbb8: e5944004 ldr r4, [r4, #4] ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); a000cbbc: e1540005 cmp r4, r5 a000cbc0: 1afffff7 bne a000cba4 <_User_extensions_Thread_exitted+0x18> a000cbc4: e8bd8070 pop {r4, r5, r6, pc} =============================================================================== a000ea7c <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { a000ea7c: e92d41f0 push {r4, r5, r6, r7, r8, lr} a000ea80: e1a04000 mov r4, r0 a000ea84: e1a05002 mov r5, r2 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000ea88: e10f0000 mrs r0, CPSR a000ea8c: e3803080 orr r3, r0, #128 ; 0x80 a000ea90: e129f003 msr CPSR_fc, r3 } } _ISR_Enable( level ); } a000ea94: e1a07004 mov r7, r4 a000ea98: e4973004 ldr r3, [r7], #4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { a000ea9c: e1530007 cmp r3, r7 a000eaa0: 0a00001a beq a000eb10 <_Watchdog_Adjust+0x94> switch ( direction ) { a000eaa4: e3510000 cmp r1, #0 a000eaa8: 1a00001a bne a000eb18 <_Watchdog_Adjust+0x9c> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { a000eaac: e3520000 cmp r2, #0 a000eab0: 0a000016 beq a000eb10 <_Watchdog_Adjust+0x94> if ( units < _Watchdog_First( header )->delta_interval ) { a000eab4: e5936010 ldr r6, [r3, #16] a000eab8: e1520006 cmp r2, r6 a000eabc: 21a01000 movcs r1, r0 _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; a000eac0: 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 ) { a000eac4: 2a000005 bcs a000eae0 <_Watchdog_Adjust+0x64> a000eac8: ea000019 b a000eb34 <_Watchdog_Adjust+0xb8> <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { a000eacc: e0555006 subs r5, r5, r6 <== NOT EXECUTED a000ead0: 0a00000e beq a000eb10 <_Watchdog_Adjust+0x94> <== NOT EXECUTED if ( units < _Watchdog_First( header )->delta_interval ) { a000ead4: e5936010 ldr r6, [r3, #16] <== NOT EXECUTED a000ead8: e1560005 cmp r6, r5 <== NOT EXECUTED a000eadc: 8a000014 bhi a000eb34 <_Watchdog_Adjust+0xb8> <== NOT EXECUTED _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; a000eae0: e5838010 str r8, [r3, #16] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000eae4: e129f001 msr CPSR_fc, r1 _ISR_Enable( level ); _Watchdog_Tickle( header ); a000eae8: e1a00004 mov r0, r4 a000eaec: eb0000ad bl a000eda8 <_Watchdog_Tickle> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000eaf0: e10f0000 mrs r0, CPSR a000eaf4: e3803080 orr r3, r0, #128 ; 0x80 a000eaf8: e129f003 msr CPSR_fc, r3 } } _ISR_Enable( level ); } a000eafc: e5942000 ldr r2, [r4] a000eb00: e1a01000 mov r1, r0 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) a000eb04: e1570002 cmp r7, r2 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); a000eb08: e1a03002 mov r3, r2 a000eb0c: 1affffee bne a000eacc <_Watchdog_Adjust+0x50> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000eb10: e129f000 msr CPSR_fc, r0 } } _ISR_Enable( level ); } a000eb14: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { a000eb18: e3510001 cmp r1, #1 <== NOT EXECUTED a000eb1c: 1afffffb bne a000eb10 <_Watchdog_Adjust+0x94> <== NOT EXECUTED case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; a000eb20: e5932010 ldr r2, [r3, #16] <== NOT EXECUTED a000eb24: e0825005 add r5, r2, r5 <== NOT EXECUTED a000eb28: e5835010 str r5, [r3, #16] <== NOT EXECUTED a000eb2c: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED } } _ISR_Enable( level ); } a000eb30: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED _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; a000eb34: e0655006 rsb r5, r5, r6 <== NOT EXECUTED a000eb38: e5835010 str r5, [r3, #16] <== NOT EXECUTED break; a000eb3c: eafffff3 b a000eb10 <_Watchdog_Adjust+0x94> <== NOT EXECUTED =============================================================================== a001e90c <_Watchdog_Adjust_to_chain>: { Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { a001e90c: e3510000 cmp r1, #0 Chain_Control *header, Watchdog_Interval units_arg, Chain_Control *to_fire ) { a001e910: e92d05f0 push {r4, r5, r6, r7, r8, sl} Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { a001e914: 0a000022 beq a001e9a4 <_Watchdog_Adjust_to_chain+0x98> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001e918: e10f7000 mrs r7, CPSR a001e91c: e3873080 orr r3, r7, #128 ; 0x80 a001e920: e129f003 msr CPSR_fc, r3 return; } _ISR_Disable( level ); a001e924: e1a06000 mov r6, r0 a001e928: e4963004 ldr r3, [r6], #4 /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; first->delta_interval = 0; a001e92c: e3a0a000 mov sl, #0 a001e930: e2828004 add r8, r2, #4 while ( 1 ) { if ( units <= 0 ) { break; } if ( _Chain_Is_empty( header ) ) { a001e934: e1530006 cmp r3, r6 a001e938: 0a000018 beq a001e9a0 <_Watchdog_Adjust_to_chain+0x94> /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { a001e93c: e593c010 ldr ip, [r3, #16] a001e940: e15c0001 cmp ip, r1 a001e944: 8a000018 bhi a001e9ac <_Watchdog_Adjust_to_chain+0xa0> /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; a001e948: e06c1001 rsb r1, ip, r1 first->delta_interval = 0; a001e94c: e583a010 str sl, [r3, #16] ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; a001e950: e5935000 ldr r5, [r3] previous = the_node->previous; a001e954: e5934004 ldr r4, [r3, #4] next->previous = previous; a001e958: e5854004 str r4, [r5, #4] Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; a001e95c: e592c008 ldr ip, [r2, #8] Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; previous->next = next; a001e960: e5845000 str r5, [r4] ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; a001e964: e5838000 str r8, [r3] tail->previous = the_node; old_last->next = the_node; a001e968: e58c3000 str r3, [ip] { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; a001e96c: e5823008 str r3, [r2, #8] old_last->next = the_node; the_node->previous = old_last; a001e970: e583c004 str ip, [r3, #4] static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a001e974: e10f3000 mrs r3, CPSR a001e978: e129f007 msr CPSR_fc, r7 a001e97c: e129f003 msr CPSR_fc, r3 break; } } _ISR_Enable( level ); } a001e980: e5903000 ldr r3, [r0] _Chain_Extract_unprotected( &first->Node ); _Chain_Append_unprotected( to_fire, &first->Node ); _ISR_Flash( level ); if ( _Chain_Is_empty( header ) ) a001e984: e1560003 cmp r6, r3 a001e988: 0a000002 beq a001e998 <_Watchdog_Adjust_to_chain+0x8c> break; first = _Watchdog_First( header ); if ( first->delta_interval != 0 ) a001e98c: e593c010 ldr ip, [r3, #16] <== NOT EXECUTED a001e990: e35c0000 cmp ip, #0 <== NOT EXECUTED a001e994: 0affffed beq a001e950 <_Watchdog_Adjust_to_chain+0x44> <== NOT EXECUTED } _ISR_Disable( level ); while ( 1 ) { if ( units <= 0 ) { a001e998: e3510000 cmp r1, #0 a001e99c: 1affffe4 bne a001e934 <_Watchdog_Adjust_to_chain+0x28> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001e9a0: e129f007 msr CPSR_fc, r7 break; } } _ISR_Enable( level ); } a001e9a4: e8bd05f0 pop {r4, r5, r6, r7, r8, sl} a001e9a8: e12fff1e bx lr /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { first->delta_interval -= units; a001e9ac: e061100c rsb r1, r1, ip <== NOT EXECUTED a001e9b0: e5831010 str r1, [r3, #16] <== NOT EXECUTED break; a001e9b4: eafffff9 b a001e9a0 <_Watchdog_Adjust_to_chain+0x94> <== NOT EXECUTED =============================================================================== a000cd54 <_Watchdog_Insert>: Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; a000cd54: e59f3140 ldr r3, [pc, #320] ; a000ce9c <_Watchdog_Insert+0x148> void _Watchdog_Insert( Chain_Control *header, Watchdog_Control *the_watchdog ) { a000cd58: e92d01f0 push {r4, r5, r6, r7, r8} Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; a000cd5c: e5936000 ldr r6, [r3] static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000cd60: e10f5000 mrs r5, CPSR a000cd64: e3853080 orr r3, r5, #128 ; 0x80 a000cd68: e129f003 msr CPSR_fc, r3 /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_watchdog->state != WATCHDOG_INACTIVE ) { a000cd6c: e5913008 ldr r3, [r1, #8] a000cd70: e3530000 cmp r3, #0 a000cd74: 1a000041 bne a000ce80 <_Watchdog_Insert+0x12c> _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; a000cd78: e59f8120 ldr r8, [pc, #288] ; a000cea0 <_Watchdog_Insert+0x14c> if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; a000cd7c: e3a02001 mov r2, #1 a000cd80: e59f711c ldr r7, [pc, #284] ; a000cea4 <_Watchdog_Insert+0x150> _Watchdog_Sync_count++; a000cd84: e5983000 ldr r3, [r8] if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; a000cd88: e5812008 str r2, [r1, #8] _Watchdog_Sync_count++; a000cd8c: e0833002 add r3, r3, r2 a000cd90: e5883000 str r3, [r8] restart: delta_interval = the_watchdog->initial; a000cd94: e591300c ldr r3, [r1, #12] RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); a000cd98: e5902000 ldr r2, [r0] for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) a000cd9c: e3530000 cmp r3, #0 a000cda0: 0a000023 beq a000ce34 <_Watchdog_Insert+0xe0> a000cda4: e592c000 ldr ip, [r2] a000cda8: e35c0000 cmp ip, #0 a000cdac: 0a000020 beq a000ce34 <_Watchdog_Insert+0xe0> break; if ( delta_interval < after->delta_interval ) { a000cdb0: e592c010 ldr ip, [r2, #16] a000cdb4: e153000c cmp r3, ip a000cdb8: 3a000032 bcc a000ce88 <_Watchdog_Insert+0x134> static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a000cdbc: e10f4000 mrs r4, CPSR a000cdc0: e129f005 msr CPSR_fc, r5 a000cdc4: e129f004 msr CPSR_fc, r4 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { a000cdc8: e5914008 ldr r4, [r1, #8] a000cdcc: e3540001 cmp r4, #1 a000cdd0: 1a000023 bne a000ce64 <_Watchdog_Insert+0x110> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { a000cdd4: e5974000 ldr r4, [r7] a000cdd8: e1560004 cmp r6, r4 if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; a000cddc: 206c3003 rsbcs r3, ip, r3 if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { a000cde0: 2a000010 bcs a000ce28 <_Watchdog_Insert+0xd4> a000cde4: ea00002a b a000ce94 <_Watchdog_Insert+0x140> <== NOT EXECUTED for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) a000cde8: e592c000 ldr ip, [r2] a000cdec: e35c0000 cmp ip, #0 a000cdf0: 0a00000f beq a000ce34 <_Watchdog_Insert+0xe0> break; if ( delta_interval < after->delta_interval ) { a000cdf4: e592c010 ldr ip, [r2, #16] a000cdf8: e15c0003 cmp ip, r3 a000cdfc: 8a000021 bhi a000ce88 <_Watchdog_Insert+0x134> a000ce00: e10f4000 mrs r4, CPSR a000ce04: e129f005 msr CPSR_fc, r5 a000ce08: e129f004 msr CPSR_fc, r4 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { a000ce0c: e5914008 ldr r4, [r1, #8] if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; a000ce10: e06c3003 rsb r3, ip, r3 _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { a000ce14: e3540001 cmp r4, #1 a000ce18: 1a000011 bne a000ce64 <_Watchdog_Insert+0x110> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { a000ce1c: e597c000 ldr ip, [r7] a000ce20: e156000c cmp r6, ip a000ce24: 3a00001a bcc a000ce94 <_Watchdog_Insert+0x140> for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) a000ce28: e3530000 cmp r3, #0 exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } a000ce2c: e5922000 ldr r2, [r2] for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) a000ce30: 1affffec bne a000cde8 <_Watchdog_Insert+0x94> _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); a000ce34: e5922004 ldr r2, [r2, #4] the_watchdog->start_time = _Watchdog_Ticks_since_boot; a000ce38: e59fc068 ldr ip, [pc, #104] ; a000cea8 <_Watchdog_Insert+0x154> RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; a000ce3c: e3a04002 mov r4, #2 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; a000ce40: e5920000 ldr r0, [r2] a000ce44: e59cc000 ldr ip, [ip] a000ce48: e5814008 str r4, [r1, #8] } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; a000ce4c: e5813010 str r3, [r1, #16] Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; a000ce50: e5812004 str r2, [r1, #4] before_node = after_node->next; after_node->next = the_node; a000ce54: e5821000 str r1, [r2] the_node->next = before_node; before_node->previous = the_node; a000ce58: e5801004 str r1, [r0, #4] Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; a000ce5c: e5810000 str r0, [r1] _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; a000ce60: e581c014 str ip, [r1, #20] exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; a000ce64: e5876000 str r6, [r7] _Watchdog_Sync_count--; a000ce68: e5983000 ldr r3, [r8] a000ce6c: e2433001 sub r3, r3, #1 a000ce70: e5883000 str r3, [r8] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000ce74: e129f005 msr CPSR_fc, r5 _ISR_Enable( level ); } a000ce78: e8bd01f0 pop {r4, r5, r6, r7, r8} a000ce7c: e12fff1e bx lr a000ce80: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED a000ce84: eafffffb b a000ce78 <_Watchdog_Insert+0x124> <== NOT EXECUTED if ( delta_interval == 0 || !_Watchdog_Next( after ) ) break; if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; a000ce88: e063c00c rsb ip, r3, ip a000ce8c: e582c010 str ip, [r2, #16] break; a000ce90: eaffffe7 b a000ce34 <_Watchdog_Insert+0xe0> if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { _Watchdog_Sync_level = insert_isr_nest_level; a000ce94: e5876000 str r6, [r7] <== NOT EXECUTED goto restart; a000ce98: eaffffbd b a000cd94 <_Watchdog_Insert+0x40> <== NOT EXECUTED =============================================================================== a000e57c <_Watchdog_Report>: void _Watchdog_Report( const char *name, Watchdog_Control *watch ) { a000e57c: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED printk( a000e580: e591e00c ldr lr, [r1, #12] <== NOT EXECUTED void _Watchdog_Report( const char *name, Watchdog_Control *watch ) { a000e584: e24dd014 sub sp, sp, #20 <== NOT EXECUTED printk( a000e588: e5913010 ldr r3, [r1, #16] <== NOT EXECUTED a000e58c: e58de000 str lr, [sp] <== NOT EXECUTED a000e590: e58d1004 str r1, [sp, #4] <== NOT EXECUTED a000e594: e591e01c ldr lr, [r1, #28] <== NOT EXECUTED a000e598: e250c000 subs ip, r0, #0 <== NOT EXECUTED a000e59c: 059fc02c ldreq ip, [pc, #44] ; a000e5d0 <_Watchdog_Report+0x54><== NOT EXECUTED a000e5a0: e58de008 str lr, [sp, #8] <== NOT EXECUTED a000e5a4: e591e020 ldr lr, [r1, #32] <== NOT EXECUTED a000e5a8: 01a0200c moveq r2, ip <== NOT EXECUTED a000e5ac: 159f2020 ldrne r2, [pc, #32] ; a000e5d4 <_Watchdog_Report+0x58><== NOT EXECUTED a000e5b0: e58de00c str lr, [sp, #12] <== NOT EXECUTED a000e5b4: e5911024 ldr r1, [r1, #36] ; 0x24 <== NOT EXECUTED a000e5b8: e59f0018 ldr r0, [pc, #24] ; a000e5d8 <_Watchdog_Report+0x5c><== NOT EXECUTED a000e5bc: e58d1010 str r1, [sp, #16] <== NOT EXECUTED a000e5c0: e1a0100c mov r1, ip <== NOT EXECUTED a000e5c4: ebffe684 bl a0007fdc <== NOT EXECUTED watch, watch->routine, watch->id, watch->user_data ); } a000e5c8: e28dd014 add sp, sp, #20 <== NOT EXECUTED a000e5cc: e8bd8000 pop {pc} <== NOT EXECUTED =============================================================================== a000e504 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { a000e504: e92d40f0 push {r4, r5, r6, r7, lr} a000e508: e1a05000 mov r5, r0 a000e50c: e1a04001 mov r4, r1 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000e510: e10f6000 mrs r6, CPSR a000e514: e3863080 orr r3, r6, #128 ; 0x80 a000e518: e129f003 msr CPSR_fc, r3 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); a000e51c: e59f004c ldr r0, [pc, #76] ; a000e570 <_Watchdog_Report_chain+0x6c> a000e520: e1a02004 mov r2, r4 a000e524: e1a01005 mov r1, r5 a000e528: ebffe6ab bl a0007fdc printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } a000e52c: e4947004 ldr r7, [r4], #4 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { a000e530: e1570004 cmp r7, r4 a000e534: 0a00000a beq a000e564 <_Watchdog_Report_chain+0x60> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); a000e538: e1a01007 mov r1, r7 <== NOT EXECUTED a000e53c: e3a00000 mov r0, #0 <== NOT EXECUTED a000e540: eb00000d bl a000e57c <_Watchdog_Report> <== NOT EXECUTED _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; node != _Chain_Tail(header) ; node = node->next ) a000e544: e5977000 ldr r7, [r7] <== NOT EXECUTED Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; a000e548: e1570004 cmp r7, r4 <== NOT EXECUTED a000e54c: 1afffff9 bne a000e538 <_Watchdog_Report_chain+0x34> <== NOT EXECUTED { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); a000e550: e59f001c ldr r0, [pc, #28] ; a000e574 <_Watchdog_Report_chain+0x70><== NOT EXECUTED a000e554: e1a01005 mov r1, r5 <== NOT EXECUTED a000e558: ebffe69f bl a0007fdc <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000e55c: e129f006 msr CPSR_fc, r6 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } a000e560: e8bd80f0 pop {r4, r5, r6, r7, pc} _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); a000e564: e59f000c ldr r0, [pc, #12] ; a000e578 <_Watchdog_Report_chain+0x74> a000e568: ebffe69b bl a0007fdc a000e56c: eafffffa b a000e55c <_Watchdog_Report_chain+0x58> =============================================================================== a000cfbc <_Watchdog_Tickle>: */ void _Watchdog_Tickle( Chain_Control *header ) { a000cfbc: e92d40f0 push {r4, r5, r6, r7, lr} a000cfc0: e1a05000 mov r5, r0 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000cfc4: e10f7000 mrs r7, CPSR a000cfc8: e3873080 orr r3, r7, #128 ; 0x80 a000cfcc: e129f003 msr CPSR_fc, r3 } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } a000cfd0: e1a04000 mov r4, r0 a000cfd4: e4943004 ldr r3, [r4], #4 * volatile data - till, 2003/7 */ _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) a000cfd8: e1530004 cmp r3, r4 a000cfdc: 0a000007 beq a000d000 <_Watchdog_Tickle+0x44> * to be inserted has already had its delta_interval adjusted to 0, and * so is added to the head of the chain with a delta_interval of 0. * * Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc) */ if (the_watchdog->delta_interval != 0) { a000cfe0: e5931010 ldr r1, [r3, #16] RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); a000cfe4: e1a06003 mov r6, r3 a000cfe8: e3510000 cmp r1, #0 a000cfec: 0a000015 beq a000d048 <_Watchdog_Tickle+0x8c> the_watchdog->delta_interval--; a000cff0: e2411001 sub r1, r1, #1 if ( the_watchdog->delta_interval != 0 ) a000cff4: e3510000 cmp r1, #0 * so is added to the head of the chain with a delta_interval of 0. * * Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc) */ if (the_watchdog->delta_interval != 0) { the_watchdog->delta_interval--; a000cff8: e5831010 str r1, [r3, #16] if ( the_watchdog->delta_interval != 0 ) a000cffc: 0a000011 beq a000d048 <_Watchdog_Tickle+0x8c> * See the comment in watchdoginsert.c and watchdogadjust.c * about why it's safe not to declare header a pointer to * volatile data - till, 2003/7 */ _ISR_Disable( level ); a000d000: e1a02007 mov r2, r7 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000d004: e129f002 msr CPSR_fc, r2 } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } a000d008: e8bd80f0 pop {r4, r5, r6, r7, pc} _ISR_Enable( level ); switch( watchdog_state ) { case WATCHDOG_ACTIVE: (*the_watchdog->routine)( a000d00c: e596301c ldr r3, [r6, #28] a000d010: e5960020 ldr r0, [r6, #32] a000d014: e5961024 ldr r1, [r6, #36] ; 0x24 a000d018: e12fff33 blx r3 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000d01c: e10f2000 mrs r2, CPSR a000d020: e3823080 orr r3, r2, #128 ; 0x80 a000d024: e129f003 msr CPSR_fc, r3 } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } a000d028: e5953000 ldr r3, [r5] a000d02c: e1a07002 mov r7, r2 _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); a000d030: e1530004 cmp r3, r4 a000d034: e1a06003 mov r6, r3 a000d038: 0afffff1 beq a000d004 <_Watchdog_Tickle+0x48> } _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && a000d03c: e5933010 ldr r3, [r3, #16] <== NOT EXECUTED a000d040: e3530000 cmp r3, #0 <== NOT EXECUTED a000d044: 1affffee bne a000d004 <_Watchdog_Tickle+0x48> <== NOT EXECUTED if ( the_watchdog->delta_interval != 0 ) goto leave; } do { watchdog_state = _Watchdog_Remove( the_watchdog ); a000d048: e1a00006 mov r0, r6 a000d04c: ebffffaf bl a000cf10 <_Watchdog_Remove> static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000d050: e129f007 msr CPSR_fc, r7 _ISR_Enable( level ); switch( watchdog_state ) { a000d054: e3500002 cmp r0, #2 a000d058: 1affffef bne a000d01c <_Watchdog_Tickle+0x60> a000d05c: eaffffea b a000d00c <_Watchdog_Tickle+0x50> =============================================================================== a000b780 : uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | a000b780: e1a00c00 lsl r0, r0, #24 <== NOT EXECUTED a000b784: e1800d81 orr r0, r0, r1, lsl #27 <== NOT EXECUTED (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | a000b788: e1800003 orr r0, r0, r3 <== NOT EXECUTED uint32_t node, uint32_t index ) { return _Objects_Build_id( api, class, node, index ); } a000b78c: e1800802 orr r0, r0, r2, lsl #16 <== NOT EXECUTED a000b790: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b794 : char C1, char C2, char C3, char C4 ) { a000b794: e1a01801 lsl r1, r1, #16 <== NOT EXECUTED a000b798: e1a02402 lsl r2, r2, #8 <== NOT EXECUTED return _Objects_Build_name( C1, C2, C3, C4 ); a000b79c: e20118ff and r1, r1, #16711680 ; 0xff0000 <== NOT EXECUTED a000b7a0: e1811c00 orr r1, r1, r0, lsl #24 <== NOT EXECUTED a000b7a4: e2022cff and r2, r2, #65280 ; 0xff00 <== NOT EXECUTED char C1, char C2, char C3, char C4 ) { a000b7a8: e20330ff and r3, r3, #255 ; 0xff <== NOT EXECUTED return _Objects_Build_name( C1, C2, C3, C4 ); a000b7ac: e1811002 orr r1, r1, r2 <== NOT EXECUTED } a000b7b0: e1810003 orr r0, r1, r3 <== NOT EXECUTED a000b7b4: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000a848 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { a000a848: e92d4030 push {r4, r5, lr} <== NOT EXECUTED a000a84c: e1a04002 mov r4, r2 <== NOT EXECUTED a000a850: e1a05003 mov r5, r3 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); a000a854: eb000136 bl a000ad34 <_Chain_Append_with_empty_check> <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { a000a858: e3500000 cmp r0, #0 <== NOT EXECUTED a000a85c: 1a000000 bne a000a864 <== NOT EXECUTED sc = rtems_event_send( task, events ); } return sc; } a000a860: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); a000a864: e1a00004 mov r0, r4 <== NOT EXECUTED a000a868: e1a01005 mov r1, r5 <== NOT EXECUTED } return sc; } a000a86c: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); a000a870: eafffd86 b a0009e90 <== NOT EXECUTED =============================================================================== a000a874 : rtems_chain_control *chain, rtems_id task, rtems_event_set events, rtems_chain_node **node ) { a000a874: e92d4030 push {r4, r5, lr} <== NOT EXECUTED a000a878: e1a04001 mov r4, r1 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool rtems_chain_get_with_empty_check( rtems_chain_control *chain, rtems_chain_node **node ) { return _Chain_Get_with_empty_check( chain, node ); a000a87c: e1a01003 mov r1, r3 <== NOT EXECUTED a000a880: e1a05002 mov r5, r2 <== NOT EXECUTED a000a884: eb00014d bl a000adc0 <_Chain_Get_with_empty_check> <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { a000a888: e3500000 cmp r0, #0 <== NOT EXECUTED a000a88c: 1a000000 bne a000a894 <== NOT EXECUTED sc = rtems_event_send( task, events ); } return sc; } a000a890: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { sc = rtems_event_send( task, events ); a000a894: e1a00004 mov r0, r4 <== NOT EXECUTED a000a898: e1a01005 mov r1, r5 <== NOT EXECUTED } return sc; } a000a89c: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { sc = rtems_event_send( task, events ); a000a8a0: eafffd7a b a0009e90 <== NOT EXECUTED =============================================================================== a000a8a4 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { a000a8a4: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} <== NOT EXECUTED a000a8a8: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a000a8ac: e1a07000 mov r7, r0 <== NOT EXECUTED a000a8b0: e1a06001 mov r6, r1 <== NOT EXECUTED a000a8b4: e1a05002 mov r5, r2 <== NOT EXECUTED a000a8b8: e1a0a003 mov sl, r3 <== NOT EXECUTED while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( a000a8bc: e1a0800d mov r8, sp <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); a000a8c0: e1a00007 mov r0, r7 <== NOT EXECUTED a000a8c4: eb000152 bl a000ae14 <_Chain_Get> <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL a000a8c8: e2504000 subs r4, r0, #0 <== NOT EXECUTED ) { rtems_event_set out; sc = rtems_event_receive( a000a8cc: e1a02005 mov r2, r5 <== NOT EXECUTED a000a8d0: e1a0300d mov r3, sp <== NOT EXECUTED a000a8d4: e1a01004 mov r1, r4 <== NOT EXECUTED a000a8d8: e1a00006 mov r0, r6 <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL a000a8dc: 1a000005 bne a000a8f8 <== NOT EXECUTED ) { rtems_event_set out; sc = rtems_event_receive( a000a8e0: ebfffd0d bl a0009d1c <== NOT EXECUTED ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( a000a8e4: e3500000 cmp r0, #0 <== NOT EXECUTED a000a8e8: 0afffff4 beq a000a8c0 <== NOT EXECUTED timeout, &out ); } *node_ptr = node; a000a8ec: e58a4000 str r4, [sl] <== NOT EXECUTED return sc; } a000a8f0: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000a8f4: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL a000a8f8: e3a00000 mov r0, #0 <== NOT EXECUTED a000a8fc: eafffffa b a000a8ec <== NOT EXECUTED =============================================================================== a000a900 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { a000a900: e92d4030 push {r4, r5, lr} <== NOT EXECUTED a000a904: e1a04002 mov r4, r2 <== NOT EXECUTED a000a908: e1a05003 mov r5, r3 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); a000a90c: eb000157 bl a000ae70 <_Chain_Prepend_with_empty_check> <== NOT EXECUTED rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { a000a910: e3500000 cmp r0, #0 <== NOT EXECUTED a000a914: 1a000000 bne a000a91c <== NOT EXECUTED sc = rtems_event_send( task, events ); } return sc; } a000a918: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); a000a91c: e1a00004 mov r0, r4 <== NOT EXECUTED a000a920: e1a01005 mov r1, r5 <== NOT EXECUTED } return sc; } a000a924: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); a000a928: eafffd58 b a0009e90 <== NOT EXECUTED =============================================================================== a0016d98 : rtems_status_code rtems_clock_get( rtems_clock_get_options option, void *time_buffer ) { a0016d98: e92d4010 push {r4, lr} if ( !time_buffer ) a0016d9c: e2514000 subs r4, r1, #0 a0016da0: 0a000012 beq a0016df0 return RTEMS_INVALID_ADDRESS; if ( option == RTEMS_CLOCK_GET_TOD ) a0016da4: e3500000 cmp r0, #0 a0016da8: 0a00000d beq a0016de4 return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH ) a0016dac: e3500001 cmp r0, #1 a0016db0: 0a000011 beq a0016dfc return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); if ( option == RTEMS_CLOCK_GET_TICKS_SINCE_BOOT ) { a0016db4: e3500002 cmp r0, #2 a0016db8: 0a000012 beq a0016e08 *interval = rtems_clock_get_ticks_since_boot(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TICKS_PER_SECOND ) { a0016dbc: e3500003 cmp r0, #3 a0016dc0: 0a000014 beq a0016e18 *interval = rtems_clock_get_ticks_per_second(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) a0016dc4: e3500004 cmp r0, #4 <== NOT EXECUTED return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; a0016dc8: 13a0300a movne r3, #10 <== NOT EXECUTED *interval = rtems_clock_get_ticks_per_second(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) a0016dcc: 0a000001 beq a0016dd8 <== NOT EXECUTED return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } a0016dd0: e1a00003 mov r0, r3 a0016dd4: e8bd8010 pop {r4, pc} *interval = rtems_clock_get_ticks_per_second(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); a0016dd8: e1a00004 mov r0, r4 return RTEMS_INVALID_NUMBER; } a0016ddc: e8bd4010 pop {r4, lr} <== NOT EXECUTED *interval = rtems_clock_get_ticks_per_second(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); a0016de0: ea000060 b a0016f68 <== NOT EXECUTED { if ( !time_buffer ) return RTEMS_INVALID_ADDRESS; if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); a0016de4: e1a00004 mov r0, r4 if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } a0016de8: e8bd4010 pop {r4, lr} { if ( !time_buffer ) return RTEMS_INVALID_ADDRESS; if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); a0016dec: ea000027 b a0016e90 rtems_clock_get_options option, void *time_buffer ) { if ( !time_buffer ) return RTEMS_INVALID_ADDRESS; a0016df0: e3a03009 mov r3, #9 if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } a0016df4: e1a00003 mov r0, r3 <== NOT EXECUTED a0016df8: e8bd8010 pop {r4, pc} <== NOT EXECUTED if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH ) return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); a0016dfc: e1a00004 mov r0, r4 if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } a0016e00: e8bd4010 pop {r4, lr} if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH ) return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); a0016e04: ea000007 b a0016e28 if ( option == RTEMS_CLOCK_GET_TICKS_SINCE_BOOT ) { rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_since_boot(); a0016e08: eb00001c bl a0016e80 return RTEMS_SUCCESSFUL; a0016e0c: e3a03000 mov r3, #0 return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); if ( option == RTEMS_CLOCK_GET_TICKS_SINCE_BOOT ) { rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_since_boot(); a0016e10: e5840000 str r0, [r4] return RTEMS_SUCCESSFUL; a0016e14: eaffffed b a0016dd0 } if ( option == RTEMS_CLOCK_GET_TICKS_PER_SECOND ) { rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_per_second(); a0016e18: eb000010 bl a0016e60 return RTEMS_SUCCESSFUL; a0016e1c: e3a03000 mov r3, #0 } if ( option == RTEMS_CLOCK_GET_TICKS_PER_SECOND ) { rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_per_second(); a0016e20: e5840000 str r0, [r4] return RTEMS_SUCCESSFUL; a0016e24: eaffffe9 b a0016dd0 =============================================================================== a0016f68 : #include rtems_status_code rtems_clock_get_tod_timeval( struct timeval *time ) { a0016f68: e92d4030 push {r4, r5, lr} <== NOT EXECUTED if ( !time ) a0016f6c: e2504000 subs r4, r0, #0 <== NOT EXECUTED #include rtems_status_code rtems_clock_get_tod_timeval( struct timeval *time ) { a0016f70: e24dd008 sub sp, sp, #8 <== NOT EXECUTED if ( !time ) return RTEMS_INVALID_ADDRESS; a0016f74: 03a00009 moveq r0, #9 <== NOT EXECUTED rtems_status_code rtems_clock_get_tod_timeval( struct timeval *time ) { if ( !time ) a0016f78: 0a000012 beq a0016fc8 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; if ( !_TOD_Is_set ) a0016f7c: e59f304c ldr r3, [pc, #76] ; a0016fd0 <== NOT EXECUTED a0016f80: e5d33000 ldrb r3, [r3] <== NOT EXECUTED a0016f84: e3530000 cmp r3, #0 <== NOT EXECUTED return RTEMS_NOT_DEFINED; a0016f88: 03a0000b moveq r0, #11 <== NOT EXECUTED ) { if ( !time ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Is_set ) a0016f8c: 0a00000d beq a0016fc8 <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a0016f90: e10f5000 mrs r5, CPSR <== NOT EXECUTED a0016f94: e3853080 orr r3, r5, #128 ; 0x80 <== NOT EXECUTED a0016f98: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED ISR_Level level; struct timespec now; suseconds_t useconds; _ISR_Disable(level); _TOD_Get( &now ); a0016f9c: e1a0000d mov r0, sp <== NOT EXECUTED a0016fa0: eb0011c5 bl a001b6bc <_TOD_Get> <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0016fa4: e129f005 msr CPSR_fc, r5 <== NOT EXECUTED _ISR_Enable(level); useconds = (suseconds_t)now.tv_nsec; useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; a0016fa8: e59f2024 ldr r2, [pc, #36] ; a0016fd4 <== NOT EXECUTED _ISR_Disable(level); _TOD_Get( &now ); _ISR_Enable(level); useconds = (suseconds_t)now.tv_nsec; a0016fac: e59d3004 ldr r3, [sp, #4] <== NOT EXECUTED return RTEMS_NOT_DEFINED; _TOD_Get_timeval( time ); return RTEMS_SUCCESSFUL; a0016fb0: e3a00000 mov r0, #0 <== NOT EXECUTED useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; a0016fb4: e0c21293 smull r1, r2, r3, r2 <== NOT EXECUTED a0016fb8: e1a03fc3 asr r3, r3, #31 <== NOT EXECUTED a0016fbc: e0633342 rsb r3, r3, r2, asr #6 <== NOT EXECUTED time->tv_sec = now.tv_sec; a0016fc0: e59d2000 ldr r2, [sp] <== NOT EXECUTED time->tv_usec = useconds; a0016fc4: e884000c stm r4, {r2, r3} <== NOT EXECUTED } a0016fc8: e28dd008 add sp, sp, #8 <== NOT EXECUTED a0016fcc: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a000968c : */ rtems_status_code rtems_clock_get_uptime( struct timespec *uptime ) { if ( !uptime ) a000968c: e3500000 cmp r0, #0 <== NOT EXECUTED * error code - if unsuccessful */ rtems_status_code rtems_clock_get_uptime( struct timespec *uptime ) { a0009690: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED if ( !uptime ) a0009694: 0a000002 beq a00096a4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _TOD_Get_uptime_as_timespec( uptime ); a0009698: eb000589 bl a000acc4 <_TOD_Get_uptime_as_timespec> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000969c: e3a00000 mov r0, #0 <== NOT EXECUTED a00096a0: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED rtems_status_code rtems_clock_get_uptime( struct timespec *uptime ) { if ( !uptime ) return RTEMS_INVALID_ADDRESS; a00096a4: e3a00009 mov r0, #9 <== NOT EXECUTED _TOD_Get_uptime_as_timespec( uptime ); return RTEMS_SUCCESSFUL; } a00096a8: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a0009464 : * * NOTE: This routine only works for leap-years through 2099. */ rtems_status_code rtems_clock_tick( void ) { a0009464: e52de004 push {lr} ; (str lr, [sp, #-4]!) _TOD_Tickle_ticks(); a0009468: eb000528 bl a000a910 <_TOD_Tickle_ticks> */ RTEMS_INLINE_ROUTINE void _Watchdog_Tickle_ticks( void ) { _Watchdog_Tickle( &_Watchdog_Ticks_chain ); a000946c: e59f0038 ldr r0, [pc, #56] ; a00094ac a0009470: eb000ed1 bl a000cfbc <_Watchdog_Tickle> _Watchdog_Tickle_ticks(); _Thread_Tickle_timeslice(); a0009474: eb000d40 bl a000c97c <_Thread_Tickle_timeslice> * otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_context_switch_necessary( void ) { return ( _Thread_Dispatch_necessary ); a0009478: e59f3030 ldr r3, [pc, #48] ; a00094b0 a000947c: e5d33010 ldrb r3, [r3, #16] if ( _Thread_Is_context_switch_necessary() && a0009480: e3530000 cmp r3, #0 a0009484: 0a000003 beq a0009498 * otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_dispatching_enabled( void ) { return ( _Thread_Dispatch_disable_level == 0 ); a0009488: e59f3024 ldr r3, [pc, #36] ; a00094b4 <== NOT EXECUTED a000948c: e5933000 ldr r3, [r3] <== NOT EXECUTED a0009490: e3530000 cmp r3, #0 <== NOT EXECUTED a0009494: 0a000001 beq a00094a0 <== NOT EXECUTED _Thread_Is_dispatching_enabled() ) _Thread_Dispatch(); return RTEMS_SUCCESSFUL; } a0009498: e3a00000 mov r0, #0 a000949c: e49df004 pop {pc} ; (ldr pc, [sp], #4) _Thread_Tickle_timeslice(); if ( _Thread_Is_context_switch_necessary() && _Thread_Is_dispatching_enabled() ) _Thread_Dispatch(); a00094a0: eb000a33 bl a000bd74 <_Thread_Dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; } a00094a4: e3a00000 mov r0, #0 <== NOT EXECUTED a00094a8: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a00094b8 : rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { a00094b8: e92d4070 push {r4, r5, r6, lr} RTEMS_API_Control *api; if ( !event_out ) a00094bc: e2536000 subs r6, r3, #0 a00094c0: 0a000010 beq a0009508 return RTEMS_INVALID_ADDRESS; api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; a00094c4: e59f4044 ldr r4, [pc, #68] ; a0009510 if ( _Event_sets_Is_empty( event_in ) ) { a00094c8: e3500000 cmp r0, #0 RTEMS_API_Control *api; if ( !event_out ) return RTEMS_INVALID_ADDRESS; api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; a00094cc: e5945004 ldr r5, [r4, #4] a00094d0: e59550f4 ldr r5, [r5, #244] ; 0xf4 if ( _Event_sets_Is_empty( event_in ) ) { a00094d4: 1a000002 bne a00094e4 *event_out = api->pending_events; a00094d8: e5953000 ldr r3, [r5] a00094dc: e5863000 str r3, [r6] return RTEMS_SUCCESSFUL; a00094e0: e8bd8070 pop {r4, r5, r6, pc} rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a00094e4: e59fc028 ldr ip, [pc, #40] ; a0009514 a00094e8: e59ce000 ldr lr, [ip] a00094ec: e28ee001 add lr, lr, #1 a00094f0: e58ce000 str lr, [ip] } _Thread_Disable_dispatch(); _Event_Seize( event_in, option_set, ticks, event_out ); a00094f4: eb000007 bl a0009518 <_Event_Seize> _Thread_Enable_dispatch(); a00094f8: eb000a73 bl a000becc <_Thread_Enable_dispatch> return( _Thread_Executing->Wait.return_code ); a00094fc: e5943004 ldr r3, [r4, #4] a0009500: e5930034 ldr r0, [r3, #52] ; 0x34 a0009504: e8bd8070 pop {r4, r5, r6, pc} ) { RTEMS_API_Control *api; if ( !event_out ) return RTEMS_INVALID_ADDRESS; a0009508: e3a00009 mov r0, #9 <== NOT EXECUTED _Thread_Disable_dispatch(); _Event_Seize( event_in, option_set, ticks, event_out ); _Thread_Enable_dispatch(); return( _Thread_Executing->Wait.return_code ); } a000950c: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED =============================================================================== a000ba38 : rtems_status_code rtems_extension_create( rtems_name name, const rtems_extensions_table *extension_table, rtems_id *id ) { a000ba38: e92d41f0 push {r4, r5, r6, r7, r8, lr} Extension_Control *the_extension; if ( !id ) a000ba3c: e2526000 subs r6, r2, #0 rtems_status_code rtems_extension_create( rtems_name name, const rtems_extensions_table *extension_table, rtems_id *id ) { a000ba40: e1a04000 mov r4, r0 a000ba44: e1a08001 mov r8, r1 Extension_Control *the_extension; if ( !id ) a000ba48: 0a000020 beq a000bad0 return RTEMS_INVALID_ADDRESS; if ( !rtems_is_name_valid( name ) ) a000ba4c: e3500000 cmp r0, #0 a000ba50: 1a000001 bne a000ba5c return RTEMS_INVALID_NAME; a000ba54: e3a00003 mov r0, #3 ); *id = the_extension->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a000ba58: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000ba5c: e59f3074 ldr r3, [pc, #116] ; a000bad8 a000ba60: e5932000 ldr r2, [r3] a000ba64: e2822001 add r2, r2, #1 a000ba68: e5832000 str r2, [r3] #ifndef __EXTENSION_MANAGER_inl #define __EXTENSION_MANAGER_inl RTEMS_INLINE_ROUTINE Extension_Control *_Extension_Allocate( void ) { return (Extension_Control *) _Objects_Allocate( &_Extension_Information ); a000ba6c: e59f7068 ldr r7, [pc, #104] ; a000badc a000ba70: e1a00007 mov r0, r7 a000ba74: eb0003ac bl a000c92c <_Objects_Allocate> _Thread_Disable_dispatch(); /* to prevent deletion */ the_extension = _Extension_Allocate(); if ( !the_extension ) { a000ba78: e2505000 subs r5, r0, #0 a000ba7c: 0a000010 beq a000bac4 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; a000ba80: e285c024 add ip, r5, #36 ; 0x24 a000ba84: e1a0e008 mov lr, r8 a000ba88: e8be000f ldm lr!, {r0, r1, r2, r3} a000ba8c: e8ac000f stmia ip!, {r0, r1, r2, r3} a000ba90: e89e000f ldm lr, {r0, r1, r2, r3} a000ba94: e88c000f stm ip, {r0, r1, r2, r3} _User_extensions_Add_set( extension ); a000ba98: e2850010 add r0, r5, #16 a000ba9c: eb000b3a bl a000e78c <_User_extensions_Add_set> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a000baa0: e5953008 ldr r3, [r5, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000baa4: e597201c ldr r2, [r7, #28] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a000baa8: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000baac: e7825721 str r5, [r2, r1, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a000bab0: e585400c str r4, [r5, #12] &_Extension_Information, &the_extension->Object, (Objects_Name) name ); *id = the_extension->Object.id; a000bab4: e5863000 str r3, [r6] _Thread_Enable_dispatch(); a000bab8: eb0007ed bl a000da74 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000babc: e3a00000 mov r0, #0 a000bac0: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} _Thread_Disable_dispatch(); /* to prevent deletion */ the_extension = _Extension_Allocate(); if ( !the_extension ) { _Thread_Enable_dispatch(); a000bac4: eb0007ea bl a000da74 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_TOO_MANY; a000bac8: e3a00005 mov r0, #5 <== NOT EXECUTED a000bacc: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED ) { Extension_Control *the_extension; if ( !id ) return RTEMS_INVALID_ADDRESS; a000bad0: e3a00009 mov r0, #9 a000bad4: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} =============================================================================== a000c5a8 : rtems_status_code rtems_extension_ident( rtems_name name, rtems_id *id ) { a000c5a8: e1a02000 mov r2, r0 <== NOT EXECUTED a000c5ac: e1a03001 mov r3, r1 <== NOT EXECUTED a000c5b0: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED Objects_Name_or_id_lookup_errors status; status = _Objects_Name_to_id_u32( a000c5b4: e1a01002 mov r1, r2 <== NOT EXECUTED a000c5b8: e59f0010 ldr r0, [pc, #16] ; a000c5d0 <== NOT EXECUTED a000c5bc: e3e02102 mvn r2, #-2147483648 ; 0x80000000 <== NOT EXECUTED a000c5c0: eb0004cf bl a000d904 <_Objects_Name_to_id_u32> <== NOT EXECUTED name, OBJECTS_SEARCH_LOCAL_NODE, id ); return _Status_Object_name_errors_to_status[ status ]; a000c5c4: e59f3008 ldr r3, [pc, #8] ; a000c5d4 <== NOT EXECUTED } a000c5c8: e7930100 ldr r0, [r3, r0, lsl #2] <== NOT EXECUTED a000c5cc: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a000a960 : static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000a960: e10f0000 mrs r0, CPSR <== NOT EXECUTED a000a964: e3803080 orr r3, r0, #128 ; 0x80 <== NOT EXECUTED a000a968: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED rtems_interrupt_level previous_level; _ISR_Disable( previous_level ); return previous_level; } a000a96c: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000a970 : static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000a970: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED void rtems_interrupt_enable( rtems_interrupt_level previous_level ) { _ISR_Enable( previous_level ); } a000a974: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000a978 : static inline void arm_interrupt_flash( uint32_t level ) { uint32_t arm_switch_reg; asm volatile ( a000a978: e10f3000 mrs r3, CPSR <== NOT EXECUTED a000a97c: e129f000 msr CPSR_fc, r0 <== NOT EXECUTED a000a980: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED void rtems_interrupt_flash( rtems_interrupt_level previous_level ) { _ISR_Flash( previous_level ); } a000a984: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000a988 : #undef rtems_interrupt_is_in_progress bool rtems_interrupt_is_in_progress( void ) { return _ISR_Is_in_progress(); a000a988: e59f300c ldr r3, [pc, #12] ; a000a99c <== NOT EXECUTED a000a98c: e5930000 ldr r0, [r3] <== NOT EXECUTED } a000a990: e2500000 subs r0, r0, #0 <== NOT EXECUTED a000a994: 13a00001 movne r0, #1 <== NOT EXECUTED a000a998: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000a33c : rtems_attribute rtems_interrupt_level_attribute( uint32_t level ) { return RTEMS_INTERRUPT_LEVEL(level); } a000a33c: e2000080 and r0, r0, #128 ; 0x80 <== NOT EXECUTED a000a340: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a0010ea0 : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010ea0: e59fc044 ldr ip, [pc, #68] ; a0010eec rtems_status_code rtems_io_close( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010ea4: e92d4010 push {r4, lr} rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010ea8: e59cc000 ldr ip, [ip] rtems_status_code rtems_io_close( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010eac: e1a03000 mov r3, r0 rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010eb0: e15c0000 cmp ip, r0 a0010eb4: 9a000008 bls a0010edc return RTEMS_INVALID_NUMBER; callout = _IO_Driver_address_table[major].close_entry; a0010eb8: e59fc030 ldr ip, [pc, #48] ; a0010ef0 a0010ebc: e3a04018 mov r4, #24 a0010ec0: e59cc000 ldr ip, [ip] a0010ec4: e023c394 mla r3, r4, r3, ip a0010ec8: e5933008 ldr r3, [r3, #8] return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010ecc: e3530000 cmp r3, #0 a0010ed0: 0a000003 beq a0010ee4 a0010ed4: e12fff33 blx r3 a0010ed8: e8bd8010 pop {r4, pc} ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) return RTEMS_INVALID_NUMBER; a0010edc: e3a0000a mov r0, #10 <== NOT EXECUTED a0010ee0: e8bd8010 pop {r4, pc} <== NOT EXECUTED callout = _IO_Driver_address_table[major].close_entry; return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010ee4: e1a00003 mov r0, r3 } a0010ee8: e8bd8010 pop {r4, pc} =============================================================================== a0010ef4 : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010ef4: e59fc044 ldr ip, [pc, #68] ; a0010f40 rtems_status_code rtems_io_control( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010ef8: e92d4010 push {r4, lr} rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010efc: e59cc000 ldr ip, [ip] rtems_status_code rtems_io_control( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010f00: e1a03000 mov r3, r0 rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010f04: e15c0000 cmp ip, r0 a0010f08: 9a000008 bls a0010f30 return RTEMS_INVALID_NUMBER; callout = _IO_Driver_address_table[major].control_entry; a0010f0c: e59fc030 ldr ip, [pc, #48] ; a0010f44 a0010f10: e3a04018 mov r4, #24 a0010f14: e59cc000 ldr ip, [ip] a0010f18: e023c394 mla r3, r4, r3, ip a0010f1c: e5933014 ldr r3, [r3, #20] return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010f20: e3530000 cmp r3, #0 a0010f24: 0a000003 beq a0010f38 a0010f28: e12fff33 blx r3 a0010f2c: e8bd8010 pop {r4, pc} ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) return RTEMS_INVALID_NUMBER; a0010f30: e3a0000a mov r0, #10 <== NOT EXECUTED a0010f34: e8bd8010 pop {r4, pc} <== NOT EXECUTED callout = _IO_Driver_address_table[major].control_entry; return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010f38: e1a00003 mov r0, r3 <== NOT EXECUTED } a0010f3c: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a0010f48 : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010f48: e59fc044 ldr ip, [pc, #68] ; a0010f94 rtems_status_code rtems_io_open( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010f4c: e92d4010 push {r4, lr} rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010f50: e59cc000 ldr ip, [ip] rtems_status_code rtems_io_open( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010f54: e1a03000 mov r3, r0 rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010f58: e15c0000 cmp ip, r0 a0010f5c: 9a000008 bls a0010f84 return RTEMS_INVALID_NUMBER; callout = _IO_Driver_address_table[major].open_entry; a0010f60: e59fc030 ldr ip, [pc, #48] ; a0010f98 a0010f64: e3a04018 mov r4, #24 a0010f68: e59cc000 ldr ip, [ip] a0010f6c: e023c394 mla r3, r4, r3, ip a0010f70: e5933004 ldr r3, [r3, #4] return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010f74: e3530000 cmp r3, #0 a0010f78: 0a000003 beq a0010f8c a0010f7c: e12fff33 blx r3 a0010f80: e8bd8010 pop {r4, pc} ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) return RTEMS_INVALID_NUMBER; a0010f84: e3a0000a mov r0, #10 <== NOT EXECUTED a0010f88: e8bd8010 pop {r4, pc} <== NOT EXECUTED callout = _IO_Driver_address_table[major].open_entry; return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010f8c: e1a00003 mov r0, r3 } a0010f90: e8bd8010 pop {r4, pc} =============================================================================== a0010f9c : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010f9c: e59fc044 ldr ip, [pc, #68] ; a0010fe8 rtems_status_code rtems_io_read( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010fa0: e92d4010 push {r4, lr} rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010fa4: e59cc000 ldr ip, [ip] rtems_status_code rtems_io_read( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010fa8: e1a03000 mov r3, r0 rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010fac: e15c0000 cmp ip, r0 a0010fb0: 9a000008 bls a0010fd8 return RTEMS_INVALID_NUMBER; callout = _IO_Driver_address_table[major].read_entry; a0010fb4: e59fc030 ldr ip, [pc, #48] ; a0010fec a0010fb8: e3a04018 mov r4, #24 a0010fbc: e59cc000 ldr ip, [ip] a0010fc0: e023c394 mla r3, r4, r3, ip a0010fc4: e593300c ldr r3, [r3, #12] return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010fc8: e3530000 cmp r3, #0 a0010fcc: 0a000003 beq a0010fe0 a0010fd0: e12fff33 blx r3 a0010fd4: e8bd8010 pop {r4, pc} ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) return RTEMS_INVALID_NUMBER; a0010fd8: e3a0000a mov r0, #10 <== NOT EXECUTED a0010fdc: e8bd8010 pop {r4, pc} <== NOT EXECUTED callout = _IO_Driver_address_table[major].read_entry; return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0010fe0: e1a00003 mov r0, r3 } a0010fe4: e8bd8010 pop {r4, pc} =============================================================================== a000b3ac : 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 ) { a000b3ac: e92d4030 push {r4, r5, lr} a000b3b0: e1a04000 mov r4, r0 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) a000b3b4: e59f014c ldr r0, [pc, #332] ; a000b508 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; a000b3b8: e59f314c ldr r3, [pc, #332] ; a000b50c if ( rtems_interrupt_is_in_progress() ) a000b3bc: e5900000 ldr r0, [r0] a000b3c0: e3500000 cmp r0, #0 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; a000b3c4: e5930000 ldr r0, [r3] if ( rtems_interrupt_is_in_progress() ) a000b3c8: 1a000033 bne a000b49c return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) a000b3cc: e3520000 cmp r2, #0 a000b3d0: 0a000041 beq a000b4dc return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) a000b3d4: e3510000 cmp r1, #0 if ( registered_major == NULL ) return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; a000b3d8: e5820000 str r0, [r2] if ( driver_table == NULL ) a000b3dc: 0a00003e beq a000b4dc static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; a000b3e0: e591c000 ldr ip, [r1] a000b3e4: e35c0000 cmp ip, #0 a000b3e8: 0a000038 beq a000b4d0 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) a000b3ec: e1500004 cmp r0, r4 a000b3f0: 9a000027 bls a000b494 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000b3f4: e59f0114 ldr r0, [pc, #276] ; a000b510 a000b3f8: e590c000 ldr ip, [r0] a000b3fc: e28cc001 add ip, ip, #1 a000b400: e580c000 str ip, [r0] return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { a000b404: e3540000 cmp r4, #0 a000b408: 1a000025 bne a000b4a4 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; a000b40c: e593c000 ldr ip, [r3] rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { a000b410: e35c0000 cmp ip, #0 a000b414: 0a000032 beq a000b4e4 a000b418: e59fe0f4 ldr lr, [pc, #244] ; a000b514 a000b41c: e59e3000 ldr r3, [lr] a000b420: ea000003 b a000b434 a000b424: e2844001 add r4, r4, #1 a000b428: e15c0004 cmp ip, r4 a000b42c: e2833018 add r3, r3, #24 a000b430: 9a000005 bls a000b44c static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; a000b434: e5930000 ldr r0, [r3] a000b438: e3500000 cmp r0, #0 a000b43c: 1afffff8 bne a000b424 a000b440: e5930004 ldr r0, [r3, #4] a000b444: e3500000 cmp r0, #0 a000b448: 1afffff5 bne a000b424 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) a000b44c: e15c0004 cmp ip, r4 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; a000b450: e5824000 str r4, [r2] if ( m != n ) a000b454: 0a000023 beq a000b4e8 a000b458: e3a0c018 mov ip, #24 a000b45c: e00c0c94 mul ip, r4, ip } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; a000b460: e59e5000 ldr r5, [lr] a000b464: e1a0e001 mov lr, r1 a000b468: e8be000f ldm lr!, {r0, r1, r2, r3} a000b46c: e085c00c add ip, r5, ip a000b470: e8ac000f stmia ip!, {r0, r1, r2, r3} a000b474: e89e0003 ldm lr, {r0, r1} a000b478: e88c0003 stm ip, {r0, r1} _Thread_Enable_dispatch(); a000b47c: eb00074a bl a000d1ac <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); a000b480: e3a01000 mov r1, #0 a000b484: e1a00004 mov r0, r4 a000b488: e1a02001 mov r2, r1 } a000b48c: e8bd4030 pop {r4, r5, lr} _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); a000b490: ea001edd b a001300c if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) return RTEMS_INVALID_NUMBER; a000b494: e3a0000a mov r0, #10 <== NOT EXECUTED _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } a000b498: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; a000b49c: e3a00012 mov r0, #18 <== NOT EXECUTED a000b4a0: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; a000b4a4: e59fe068 ldr lr, [pc, #104] ; a000b514 <== NOT EXECUTED a000b4a8: e3a0c018 mov ip, #24 <== NOT EXECUTED a000b4ac: e00c0c94 mul ip, r4, ip <== NOT EXECUTED a000b4b0: e59e3000 ldr r3, [lr] <== NOT EXECUTED static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; a000b4b4: e793000c ldr r0, [r3, ip] <== NOT EXECUTED _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; a000b4b8: e083300c add r3, r3, ip <== NOT EXECUTED static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; a000b4bc: e3500000 cmp r0, #0 <== NOT EXECUTED a000b4c0: 0a00000b beq a000b4f4 <== NOT EXECUTED 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(); a000b4c4: eb000738 bl a000d1ac <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_RESOURCE_IN_USE; a000b4c8: e3a0000c mov r0, #12 <== NOT EXECUTED a000b4cc: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; a000b4d0: e591c004 ldr ip, [r1, #4] a000b4d4: e35c0000 cmp ip, #0 a000b4d8: 1affffc3 bne a000b3ec if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; a000b4dc: e3a00009 mov r0, #9 <== NOT EXECUTED a000b4e0: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; a000b4e4: 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(); a000b4e8: eb00072f bl a000d1ac <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; a000b4ec: 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; a000b4f0: 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; a000b4f4: e5933004 ldr r3, [r3, #4] <== NOT EXECUTED a000b4f8: e3530000 cmp r3, #0 <== NOT EXECUTED a000b4fc: 1afffff0 bne a000b4c4 <== NOT EXECUTED if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; a000b500: e5824000 str r4, [r2] <== NOT EXECUTED a000b504: eaffffd5 b a000b460 <== NOT EXECUTED =============================================================================== a000b518 : rtems_status_code rtems_io_unregister_driver( rtems_device_major_number major ) { if ( rtems_interrupt_is_in_progress() ) a000b518: e59f3064 ldr r3, [pc, #100] ; a000b584 */ rtems_status_code rtems_io_unregister_driver( rtems_device_major_number major ) { a000b51c: e92d4010 push {r4, lr} if ( rtems_interrupt_is_in_progress() ) a000b520: e5934000 ldr r4, [r3] a000b524: e3540000 cmp r4, #0 a000b528: 1a000013 bne a000b57c return RTEMS_CALLED_FROM_ISR; if ( major < _IO_Number_of_drivers ) { a000b52c: e59f3054 ldr r3, [pc, #84] ; a000b588 a000b530: e5933000 ldr r3, [r3] a000b534: e1530000 cmp r3, r0 a000b538: 8a000001 bhi a000b544 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } return RTEMS_UNSATISFIED; a000b53c: e3a0000d mov r0, #13 <== NOT EXECUTED } a000b540: e8bd8010 pop {r4, pc} <== NOT EXECUTED a000b544: e59f3040 ldr r3, [pc, #64] ; a000b58c a000b548: e5932000 ldr r2, [r3] a000b54c: e2822001 add r2, r2, #1 a000b550: e5832000 str r2, [r3] if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; if ( major < _IO_Number_of_drivers ) { _Thread_Disable_dispatch(); memset( a000b554: e59f2034 ldr r2, [pc, #52] ; a000b590 &_IO_Driver_address_table[major], a000b558: e3a03018 mov r3, #24 if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; if ( major < _IO_Number_of_drivers ) { _Thread_Disable_dispatch(); memset( a000b55c: e1a01004 mov r1, r4 a000b560: e592c000 ldr ip, [r2] a000b564: e1a02003 mov r2, r3 a000b568: e020c093 mla r0, r3, r0, ip a000b56c: eb00298e bl a0015bac &_IO_Driver_address_table[major], 0, sizeof( rtems_driver_address_table ) ); _Thread_Enable_dispatch(); a000b570: eb00070d bl a000d1ac <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000b574: e1a00004 mov r0, r4 a000b578: e8bd8010 pop {r4, pc} rtems_status_code rtems_io_unregister_driver( rtems_device_major_number major ) { if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; a000b57c: e3a00012 mov r0, #18 <== NOT EXECUTED a000b580: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a0010ff0 : void *argument ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010ff0: e59fc044 ldr ip, [pc, #68] ; a001103c rtems_status_code rtems_io_write( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010ff4: e92d4010 push {r4, lr} rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0010ff8: e59cc000 ldr ip, [ip] rtems_status_code rtems_io_write( rtems_device_major_number major, rtems_device_minor_number minor, void *argument ) { a0010ffc: e1a03000 mov r3, r0 rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) a0011000: e15c0000 cmp ip, r0 a0011004: 9a000008 bls a001102c return RTEMS_INVALID_NUMBER; callout = _IO_Driver_address_table[major].write_entry; a0011008: e59fc030 ldr ip, [pc, #48] ; a0011040 a001100c: e3a04018 mov r4, #24 a0011010: e59cc000 ldr ip, [ip] a0011014: e023c394 mla r3, r4, r3, ip a0011018: e5933010 ldr r3, [r3, #16] return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a001101c: e3530000 cmp r3, #0 a0011020: 0a000003 beq a0011034 a0011024: e12fff33 blx r3 a0011028: e8bd8010 pop {r4, pc} ) { rtems_device_driver_entry callout; if ( major >= _IO_Number_of_drivers ) return RTEMS_INVALID_NUMBER; a001102c: e3a0000a mov r0, #10 <== NOT EXECUTED a0011030: e8bd8010 pop {r4, pc} <== NOT EXECUTED callout = _IO_Driver_address_table[major].write_entry; return callout ? callout(major, minor, argument) : RTEMS_SUCCESSFUL; a0011034: e1a00003 mov r0, r3 <== NOT EXECUTED } a0011038: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a0017808 : rtems_id id, const void *buffer, size_t size, uint32_t *count ) { a0017808: e92d40f0 push {r4, r5, r6, r7, lr} register Message_queue_Control *the_message_queue; Objects_Locations location; CORE_message_queue_Status core_status; if ( !buffer ) a001780c: e2516000 subs r6, r1, #0 rtems_id id, const void *buffer, size_t size, uint32_t *count ) { a0017810: e24dd00c sub sp, sp, #12 a0017814: e1a04000 mov r4, r0 a0017818: e1a05002 mov r5, r2 a001781c: e1a07003 mov r7, r3 register Message_queue_Control *the_message_queue; Objects_Locations location; CORE_message_queue_Status core_status; if ( !buffer ) a0017820: 0a000016 beq a0017880 return RTEMS_INVALID_ADDRESS; if ( !count ) a0017824: e3530000 cmp r3, #0 a0017828: 0a000014 beq a0017880 Objects_Id id, Objects_Locations *location ) { return (Message_queue_Control *) _Objects_Get( &_Message_queue_Information, id, location ); a001782c: e59f0054 ldr r0, [pc, #84] ; a0017888 a0017830: e1a01004 mov r1, r4 a0017834: e28d2008 add r2, sp, #8 a0017838: eb0014ed bl a001cbf4 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a001783c: e59d3008 ldr r3, [sp, #8] a0017840: e3530000 cmp r3, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0017844: 13a00004 movne r0, #4 if ( !count ) return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a0017848: 1a00000a bne a0017878 case OBJECTS_LOCAL: core_status = _CORE_message_queue_Broadcast( a001784c: e58d3000 str r3, [sp] a0017850: e1a01006 mov r1, r6 a0017854: e1a03004 mov r3, r4 a0017858: e1a02005 mov r2, r5 a001785c: e2800014 add r0, r0, #20 a0017860: e58d7004 str r7, [sp, #4] a0017864: eb000dc8 bl a001af8c <_CORE_message_queue_Broadcast> a0017868: e1a04000 mov r4, r0 NULL, #endif count ); _Thread_Enable_dispatch(); a001786c: eb0017de bl a001d7ec <_Thread_Enable_dispatch> return a0017870: e1a00004 mov r0, r4 a0017874: eb0000d5 bl a0017bd0 <_Message_queue_Translate_core_message_queue_return_code> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0017878: e28dd00c add sp, sp, #12 a001787c: e8bd80f0 pop {r4, r5, r6, r7, pc} if ( !buffer ) return RTEMS_INVALID_ADDRESS; if ( !count ) return RTEMS_INVALID_ADDRESS; a0017880: e3a00009 mov r0, #9 <== NOT EXECUTED a0017884: eafffffb b a0017878 <== NOT EXECUTED =============================================================================== a0011ff4 : uint32_t count, size_t max_message_size, rtems_attribute attribute_set, rtems_id *id ) { a0011ff4: e92d41f0 push {r4, r5, r6, r7, r8, lr} CORE_message_queue_Attributes the_msgq_attributes; #if defined(RTEMS_MULTIPROCESSING) bool is_global; #endif if ( !rtems_is_name_valid( name ) ) a0011ff8: e2507000 subs r7, r0, #0 uint32_t count, size_t max_message_size, rtems_attribute attribute_set, rtems_id *id ) { a0011ffc: e24dd008 sub sp, sp, #8 a0012000: e1a04001 mov r4, r1 a0012004: e1a06002 mov r6, r2 a0012008: e59d5020 ldr r5, [sp, #32] #if defined(RTEMS_MULTIPROCESSING) bool is_global; #endif if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a001200c: 03a00003 moveq r0, #3 CORE_message_queue_Attributes the_msgq_attributes; #if defined(RTEMS_MULTIPROCESSING) bool is_global; #endif if ( !rtems_is_name_valid( name ) ) a0012010: 0a000008 beq a0012038 return RTEMS_INVALID_NAME; if ( !id ) a0012014: e3550000 cmp r5, #0 return RTEMS_INVALID_ADDRESS; a0012018: 03a00009 moveq r0, #9 #endif if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) a001201c: 0a000005 beq a0012038 if ( (is_global = _Attributes_Is_global( attribute_set ) ) && !_System_state_Is_multiprocessing ) return RTEMS_MP_NOT_CONFIGURED; #endif if ( count == 0 ) a0012020: e3510000 cmp r1, #0 return RTEMS_INVALID_NUMBER; a0012024: 03a0000a moveq r0, #10 if ( (is_global = _Attributes_Is_global( attribute_set ) ) && !_System_state_Is_multiprocessing ) return RTEMS_MP_NOT_CONFIGURED; #endif if ( count == 0 ) a0012028: 0a000002 beq a0012038 return RTEMS_INVALID_NUMBER; if ( max_message_size == 0 ) a001202c: e3520000 cmp r2, #0 return RTEMS_INVALID_SIZE; a0012030: 03a00008 moveq r0, #8 #endif if ( count == 0 ) return RTEMS_INVALID_NUMBER; if ( max_message_size == 0 ) a0012034: 1a000001 bne a0012040 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a0012038: e28dd008 add sp, sp, #8 a001203c: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a0012040: e59f2098 ldr r2, [pc, #152] ; a00120e0 a0012044: e5921000 ldr r1, [r2] a0012048: e2811001 add r1, r1, #1 a001204c: e5821000 str r1, [r2] #endif #endif _Thread_Disable_dispatch(); /* protects object pointer */ the_message_queue = _Message_queue_Allocate(); a0012050: e58d3000 str r3, [sp] a0012054: eb0016f8 bl a0017c3c <_Message_queue_Allocate> if ( !the_message_queue ) { a0012058: e2508000 subs r8, r0, #0 a001205c: e59d3000 ldr r3, [sp] a0012060: 0a00001b beq a00120d4 } #endif the_message_queue->attribute_set = attribute_set; if (_Attributes_Is_priority( attribute_set ) ) a0012064: e2132004 ands r2, r3, #4 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_message_queue->attribute_set = attribute_set; a0012068: e5883010 str r3, [r8, #16] if (_Attributes_Is_priority( attribute_set ) ) the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_PRIORITY; a001206c: 13a03001 movne r3, #1 a0012070: 158d3004 strne r3, [sp, #4] else the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_FIFO; a0012074: 058d2004 streq r2, [sp, #4] if ( ! _CORE_message_queue_Initialize( a0012078: e2880014 add r0, r8, #20 a001207c: e28d1004 add r1, sp, #4 a0012080: e1a02004 mov r2, r4 a0012084: e1a03006 mov r3, r6 a0012088: eb000477 bl a001326c <_CORE_message_queue_Initialize> a001208c: e3500000 cmp r0, #0 a0012090: 1a000005 bne a00120ac */ RTEMS_INLINE_ROUTINE void _Message_queue_Free ( Message_queue_Control *the_message_queue ) { _Objects_Free( &_Message_queue_Information, &the_message_queue->Object ); a0012094: e59f0048 ldr r0, [pc, #72] ; a00120e4 <== NOT EXECUTED a0012098: e1a01008 mov r1, r8 <== NOT EXECUTED a001209c: eb000837 bl a0014180 <_Objects_Free> <== NOT EXECUTED _Objects_MP_Close( &_Message_queue_Information, the_message_queue->Object.id); #endif _Message_queue_Free( the_message_queue ); _Thread_Enable_dispatch(); a00120a0: eb000bb5 bl a0014f7c <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_UNSATISFIED; a00120a4: e3a0000d mov r0, #13 <== NOT EXECUTED a00120a8: eaffffe2 b a0012038 <== NOT EXECUTED #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00120ac: e59f2030 ldr r2, [pc, #48] ; a00120e4 Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a00120b0: e5983008 ldr r3, [r8, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00120b4: e592201c ldr r2, [r2, #28] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a00120b8: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00120bc: e7828721 str r8, [r2, r1, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a00120c0: e588700c str r7, [r8, #12] &_Message_queue_Information, &the_message_queue->Object, (Objects_Name) name ); *id = the_message_queue->Object.id; a00120c4: e5853000 str r3, [r5] name, 0 ); #endif _Thread_Enable_dispatch(); a00120c8: eb000bab bl a0014f7c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a00120cc: e3a00000 mov r0, #0 a00120d0: eaffffd8 b a0012038 _Thread_Disable_dispatch(); /* protects object pointer */ the_message_queue = _Message_queue_Allocate(); if ( !the_message_queue ) { _Thread_Enable_dispatch(); a00120d4: eb000ba8 bl a0014f7c <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_TOO_MANY; a00120d8: e3a00005 mov r0, #5 <== NOT EXECUTED a00120dc: eaffffd5 b a0012038 <== NOT EXECUTED =============================================================================== a0017a3c : rtems_status_code rtems_message_queue_get_number_pending( rtems_id id, uint32_t *count ) { a0017a3c: e92d4030 push {r4, r5, lr} <== NOT EXECUTED register Message_queue_Control *the_message_queue; Objects_Locations location; if ( !count ) a0017a40: e2514000 subs r4, r1, #0 <== NOT EXECUTED rtems_status_code rtems_message_queue_get_number_pending( rtems_id id, uint32_t *count ) { a0017a44: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a0017a48: e1a01000 mov r1, r0 <== NOT EXECUTED register Message_queue_Control *the_message_queue; Objects_Locations location; if ( !count ) return RTEMS_INVALID_ADDRESS; a0017a4c: 03a00009 moveq r0, #9 <== NOT EXECUTED ) { register Message_queue_Control *the_message_queue; Objects_Locations location; if ( !count ) a0017a50: 0a00000a beq a0017a80 <== NOT EXECUTED a0017a54: e59f002c ldr r0, [pc, #44] ; a0017a88 <== NOT EXECUTED a0017a58: e1a0200d mov r2, sp <== NOT EXECUTED a0017a5c: eb001464 bl a001cbf4 <_Objects_Get> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a0017a60: e59d5000 ldr r5, [sp] <== NOT EXECUTED a0017a64: e3550000 cmp r5, #0 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0017a68: 13a00004 movne r0, #4 <== NOT EXECUTED if ( !count ) return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a0017a6c: 1a000003 bne a0017a80 <== NOT EXECUTED case OBJECTS_LOCAL: *count = the_message_queue->message_queue.number_of_pending_messages; a0017a70: e590305c ldr r3, [r0, #92] ; 0x5c <== NOT EXECUTED a0017a74: e5843000 str r3, [r4] <== NOT EXECUTED _Thread_Enable_dispatch(); a0017a78: eb00175b bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a0017a7c: e1a00005 mov r0, r5 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0017a80: e28dd004 add sp, sp, #4 <== NOT EXECUTED a0017a84: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a001211c : void *buffer, size_t *size, rtems_option option_set, rtems_interval timeout ) { a001211c: e92d4070 push {r4, r5, r6, lr} register Message_queue_Control *the_message_queue; Objects_Locations location; bool wait; if ( !buffer ) a0012120: e2515000 subs r5, r1, #0 void *buffer, size_t *size, rtems_option option_set, rtems_interval timeout ) { a0012124: e24dd00c sub sp, sp, #12 a0012128: e1a01000 mov r1, r0 a001212c: e1a04002 mov r4, r2 a0012130: e1a06003 mov r6, r3 register Message_queue_Control *the_message_queue; Objects_Locations location; bool wait; if ( !buffer ) a0012134: 0a000019 beq a00121a0 return RTEMS_INVALID_ADDRESS; if ( !size ) a0012138: e3520000 cmp r2, #0 a001213c: 0a000017 beq a00121a0 Objects_Id id, Objects_Locations *location ) { return (Message_queue_Control *) _Objects_Get( &_Message_queue_Information, id, location ); a0012140: e59f0060 ldr r0, [pc, #96] ; a00121a8 a0012144: e28d2008 add r2, sp, #8 a0012148: eb000865 bl a00142e4 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a001214c: e59d3008 ldr r3, [sp, #8] a0012150: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0012154: 13a00004 movne r0, #4 if ( !size ) return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { a0012158: 1a00000e bne a0012198 if ( _Options_Is_no_wait( option_set ) ) wait = false; else wait = true; _CORE_message_queue_Seize( a001215c: e59d301c ldr r3, [sp, #28] */ RTEMS_INLINE_ROUTINE bool _Options_Is_no_wait ( rtems_option option_set ) { return (option_set & RTEMS_NO_WAIT) ? true : false; a0012160: e2066001 and r6, r6, #1 a0012164: e5901008 ldr r1, [r0, #8] a0012168: e1a02005 mov r2, r5 a001216c: e2800014 add r0, r0, #20 a0012170: e58d3004 str r3, [sp, #4] a0012174: e2266001 eor r6, r6, #1 a0012178: e1a03004 mov r3, r4 a001217c: e58d6000 str r6, [sp] a0012180: eb00046a bl a0013330 <_CORE_message_queue_Seize> buffer, size, wait, timeout ); _Thread_Enable_dispatch(); a0012184: eb000b7c bl a0014f7c <_Thread_Enable_dispatch> return _Message_queue_Translate_core_message_queue_return_code( _Thread_Executing->Wait.return_code a0012188: e59f301c ldr r3, [pc, #28] ; a00121ac a001218c: e5933004 ldr r3, [r3, #4] size, wait, timeout ); _Thread_Enable_dispatch(); return _Message_queue_Translate_core_message_queue_return_code( a0012190: e5930034 ldr r0, [r3, #52] ; 0x34 a0012194: eb000024 bl a001222c <_Message_queue_Translate_core_message_queue_return_code> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0012198: e28dd00c add sp, sp, #12 a001219c: e8bd8070 pop {r4, r5, r6, pc} if ( !buffer ) return RTEMS_INVALID_ADDRESS; if ( !size ) return RTEMS_INVALID_ADDRESS; a00121a0: e3a00009 mov r0, #9 <== NOT EXECUTED a00121a4: eafffffb b a0012198 <== NOT EXECUTED =============================================================================== a000b7b8 : int rtems_object_api_maximum_class( int api ) { return _Objects_API_maximum_class(api); a000b7b8: ea000639 b a000d0a4 <_Objects_API_maximum_class> <== NOT EXECUTED =============================================================================== a000b7bc : */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) a000b7bc: e2400001 sub r0, r0, #1 <== NOT EXECUTED uint32_t api ) { if ( _Objects_Is_api_valid( api ) ) return 1; return -1; a000b7c0: e3500003 cmp r0, #3 <== NOT EXECUTED } a000b7c4: 33a00001 movcc r0, #1 <== NOT EXECUTED a000b7c8: 23e00000 mvncs r0, #0 <== NOT EXECUTED a000b7cc: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b7d0 : ) { const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) a000b7d0: e3500001 cmp r0, #1 <== NOT EXECUTED const char *rtems_object_get_api_class_name( int the_api, int the_class ) { a000b7d4: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) a000b7d8: 0a000004 beq a000b7f0 <== NOT EXECUTED api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) a000b7dc: e3500002 cmp r0, #2 <== NOT EXECUTED api_assoc = rtems_object_api_classic_assoc; a000b7e0: 059f0024 ldreq r0, [pc, #36] ; a000b80c <== NOT EXECUTED 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; else if ( the_api == OBJECTS_CLASSIC_API ) a000b7e4: 0a000002 beq a000b7f4 <== NOT EXECUTED #ifdef RTEMS_POSIX_API else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; a000b7e8: e59f0020 ldr r0, [pc, #32] ; a000b810 <== NOT EXECUTED a000b7ec: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED { 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; a000b7f0: e59f001c ldr r0, [pc, #28] ; a000b814 <== NOT EXECUTED 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 ); a000b7f4: eb0013ca bl a0010724 <== NOT EXECUTED if ( class_assoc ) a000b7f8: e3500000 cmp r0, #0 <== NOT EXECUTED return class_assoc->name; a000b7fc: 15900000 ldrne r0, [r0] <== NOT EXECUTED 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 ) a000b800: 149df004 popne {pc} ; (ldrne pc, [sp], #4) <== NOT EXECUTED return class_assoc->name; return "BAD CLASS"; a000b804: e59f000c ldr r0, [pc, #12] ; a000b818 <== NOT EXECUTED } a000b808: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a000b81c : }; const char *rtems_object_get_api_name( int api ) { a000b81c: e1a01000 mov r1, r0 <== NOT EXECUTED a000b820: e52de004 push {lr} ; (str lr, [sp, #-4]!) <== NOT EXECUTED const rtems_assoc_t *api_assoc; api_assoc = rtems_assoc_ptr_by_local( rtems_objects_api_assoc, api ); a000b824: e59f0010 ldr r0, [pc, #16] ; a000b83c <== NOT EXECUTED a000b828: eb0013bd bl a0010724 <== NOT EXECUTED if ( api_assoc ) a000b82c: e3500000 cmp r0, #0 <== NOT EXECUTED return api_assoc->name; a000b830: 15900000 ldrne r0, [r0] <== NOT EXECUTED return "BAD CLASS"; a000b834: 059f0004 ldreq r0, [pc, #4] ; a000b840 <== NOT EXECUTED } a000b838: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a000b87c : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { a000b87c: e92d4030 push {r4, r5, lr} <== NOT EXECUTED int i; /* * Validate parameters and look up information structure. */ if ( !info ) a000b880: e2524000 subs r4, r2, #0 <== NOT EXECUTED a000b884: 0a00001c beq a000b8fc <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); a000b888: e1a01801 lsl r1, r1, #16 <== NOT EXECUTED a000b88c: e1a01821 lsr r1, r1, #16 <== NOT EXECUTED a000b890: eb0006e4 bl a000d428 <_Objects_Get_information> <== NOT EXECUTED if ( !obj_info ) a000b894: e3500000 cmp r0, #0 <== NOT EXECUTED a000b898: 0a000019 beq a000b904 <== NOT EXECUTED * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; a000b89c: e1d0c1b0 ldrh ip, [r0, #16] <== NOT EXECUTED return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; a000b8a0: e5901008 ldr r1, [r0, #8] <== NOT EXECUTED info->maximum_id = obj_info->maximum_id; a000b8a4: e590200c ldr r2, [r0, #12] <== NOT EXECUTED info->auto_extend = obj_info->auto_extend; a000b8a8: e5d03012 ldrb r3, [r0, #18] <== NOT EXECUTED info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) a000b8ac: e35c0000 cmp ip, #0 <== NOT EXECUTED return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; a000b8b0: e8840006 stm r4, {r1, r2} <== NOT EXECUTED info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; a000b8b4: e5c4300c strb r3, [r4, #12] <== NOT EXECUTED info->maximum = obj_info->maximum; a000b8b8: e584c008 str ip, [r4, #8] <== NOT EXECUTED for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) a000b8bc: 01a0500c moveq r5, ip <== NOT EXECUTED a000b8c0: 0a00000a beq a000b8f0 <== NOT EXECUTED a000b8c4: e590001c ldr r0, [r0, #28] <== NOT EXECUTED a000b8c8: e3a02001 mov r2, #1 <== NOT EXECUTED a000b8cc: e1a03002 mov r3, r2 <== NOT EXECUTED a000b8d0: e3a05000 mov r5, #0 <== NOT EXECUTED if ( !obj_info->local_table[i] ) a000b8d4: e7901102 ldr r1, [r0, r2, lsl #2] <== NOT EXECUTED info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) a000b8d8: e2833001 add r3, r3, #1 <== NOT EXECUTED a000b8dc: e1a02003 mov r2, r3 <== NOT EXECUTED if ( !obj_info->local_table[i] ) a000b8e0: e3510000 cmp r1, #0 <== NOT EXECUTED unallocated++; a000b8e4: 02855001 addeq r5, r5, #1 <== NOT EXECUTED info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) a000b8e8: e15c0003 cmp ip, r3 <== NOT EXECUTED a000b8ec: 2afffff8 bcs a000b8d4 <== NOT EXECUTED if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; a000b8f0: e5845010 str r5, [r4, #16] <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000b8f4: e3a00000 mov r0, #0 <== NOT EXECUTED a000b8f8: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED /* * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; a000b8fc: e3a00009 mov r0, #9 <== NOT EXECUTED a000b900: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED obj_info = _Objects_Get_information( the_api, the_class ); if ( !obj_info ) return RTEMS_INVALID_NUMBER; a000b904: e3a0000a mov r0, #10 <== NOT EXECUTED unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; } a000b908: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a000af74 : Objects_Id id, size_t length, char *name ) { return _Objects_Get_name_as_string( id, length, name ); a000af74: ea0007a1 b a000ce00 <_Objects_Get_name_as_string> <== NOT EXECUTED =============================================================================== a000b910 : #undef rtems_object_id_api_maximum int rtems_object_id_api_maximum(void) { return OBJECTS_APIS_LAST; } a000b910: e3a00003 mov r0, #3 <== NOT EXECUTED a000b914: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b918 : #undef rtems_object_id_api_minimum int rtems_object_id_api_minimum(void) { return OBJECTS_INTERNAL_API; } a000b918: e3a00001 mov r0, #1 <== NOT EXECUTED a000b91c: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b920 : */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); a000b920: e1a00c20 lsr r0, r0, #24 <== NOT EXECUTED int rtems_object_id_get_api( rtems_id id ) { return _Objects_Get_API( id ); } a000b924: e2000007 and r0, r0, #7 <== NOT EXECUTED a000b928: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b92c : int rtems_object_id_get_class( rtems_id id ) { return _Objects_Get_class( id ); } a000b92c: e1a00da0 lsr r0, r0, #27 <== NOT EXECUTED a000b930: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b934 : #undef rtems_object_id_get_index int rtems_object_id_get_index( rtems_id id ) { return _Objects_Get_index( id ); a000b934: e1a00800 lsl r0, r0, #16 <== NOT EXECUTED } a000b938: e1a00820 lsr r0, r0, #16 <== NOT EXECUTED a000b93c: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b940 : * be a single processor system. */ #if defined(RTEMS_USE_16_BIT_OBJECT) return 1; #else return (id >> OBJECTS_NODE_START_BIT) & OBJECTS_NODE_VALID_BITS; a000b940: e1a00820 lsr r0, r0, #16 <== NOT EXECUTED int rtems_object_id_get_node( rtems_id id ) { return _Objects_Get_node( id ); } a000b944: e20000ff and r0, r0, #255 ; 0xff <== NOT EXECUTED a000b948: e12fff1e bx lr <== NOT EXECUTED =============================================================================== a000b94c : */ rtems_status_code rtems_object_set_name( rtems_id id, const char *name ) { a000b94c: e92d4070 push {r4, r5, r6, lr} <== NOT EXECUTED Objects_Information *information; Objects_Locations location; Objects_Control *the_object; Objects_Id tmpId; if ( !name ) a000b950: e2515000 subs r5, r1, #0 <== NOT EXECUTED */ rtems_status_code rtems_object_set_name( rtems_id id, const char *name ) { a000b954: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Objects_Locations location; Objects_Control *the_object; Objects_Id tmpId; if ( !name ) return RTEMS_INVALID_ADDRESS; a000b958: 03a00009 moveq r0, #9 <== NOT EXECUTED Objects_Information *information; Objects_Locations location; Objects_Control *the_object; Objects_Id tmpId; if ( !name ) a000b95c: 0a000010 beq a000b9a4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; a000b960: e3500000 cmp r0, #0 <== NOT EXECUTED a000b964: 059f3058 ldreq r3, [pc, #88] ; a000b9c4 <== NOT EXECUTED a000b968: 11a04000 movne r4, r0 <== NOT EXECUTED a000b96c: 05933004 ldreq r3, [r3, #4] <== NOT EXECUTED a000b970: 05934008 ldreq r4, [r3, #8] <== NOT EXECUTED information = _Objects_Get_information_id( tmpId ); a000b974: e1a00004 mov r0, r4 <== NOT EXECUTED a000b978: eb0006a5 bl a000d414 <_Objects_Get_information_id> <== NOT EXECUTED if ( !information ) a000b97c: e2506000 subs r6, r0, #0 <== NOT EXECUTED a000b980: 0a000006 beq a000b9a0 <== NOT EXECUTED return RTEMS_INVALID_ID; the_object = _Objects_Get( information, tmpId, &location ); a000b984: e1a01004 mov r1, r4 <== NOT EXECUTED a000b988: e1a0200d mov r2, sp <== NOT EXECUTED a000b98c: eb00071c bl a000d604 <_Objects_Get> <== NOT EXECUTED switch ( location ) { a000b990: e59d4000 ldr r4, [sp] <== NOT EXECUTED information = _Objects_Get_information_id( tmpId ); if ( !information ) return RTEMS_INVALID_ID; the_object = _Objects_Get( information, tmpId, &location ); a000b994: e1a01000 mov r1, r0 <== NOT EXECUTED switch ( location ) { a000b998: e3540000 cmp r4, #0 <== NOT EXECUTED a000b99c: 0a000002 beq a000b9ac <== NOT EXECUTED #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000b9a0: e3a00004 mov r0, #4 <== NOT EXECUTED } a000b9a4: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000b9a8: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED the_object = _Objects_Get( information, tmpId, &location ); switch ( location ) { case OBJECTS_LOCAL: _Objects_Set_name( information, the_object, name ); a000b9ac: e1a02005 mov r2, r5 <== NOT EXECUTED a000b9b0: e1a00006 mov r0, r6 <== NOT EXECUTED a000b9b4: eb00078e bl a000d7f4 <_Objects_Set_name> <== NOT EXECUTED _Thread_Enable_dispatch(); a000b9b8: eb000a2f bl a000e27c <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000b9bc: e1a00004 mov r0, r4 <== NOT EXECUTED a000b9c0: eafffff7 b a000b9a4 <== NOT EXECUTED =============================================================================== a0017c5c : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { a0017c5c: e92d47f0 push {r4, r5, r6, r7, r8, r9, sl, lr} register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) a0017c60: e2506000 subs r6, r0, #0 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { a0017c64: e24dd008 sub sp, sp, #8 a0017c68: e1a04001 mov r4, r1 a0017c6c: e59d502c ldr r5, [sp, #44] ; 0x2c register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a0017c70: 03a00003 moveq r0, #3 rtems_id *id ) { register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) a0017c74: 0a000031 beq a0017d40 return RTEMS_INVALID_NAME; if ( !starting_address ) a0017c78: e3510000 cmp r1, #0 a0017c7c: 0a000033 beq a0017d50 return RTEMS_INVALID_ADDRESS; if ( !id ) a0017c80: e3550000 cmp r5, #0 a0017c84: 0a000031 beq a0017d50 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || a0017c88: e3520000 cmp r2, #0 a0017c8c: 13530000 cmpne r3, #0 a0017c90: 0a00002c beq a0017d48 a0017c94: e1520003 cmp r2, r3 a0017c98: 3a00002a bcc a0017d48 a0017c9c: e3130007 tst r3, #7 a0017ca0: 1a000028 bne a0017d48 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) a0017ca4: e2118007 ands r8, r1, #7 a0017ca8: 1a000028 bne a0017d50 a0017cac: e59f10b0 ldr r1, [pc, #176] ; a0017d64 a0017cb0: e5910000 ldr r0, [r1] a0017cb4: e2800001 add r0, r0, #1 a0017cb8: e5810000 str r0, [r1] * This function allocates a partition control block from * the inactive chain of free partition control blocks. */ RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Allocate ( void ) { return (Partition_Control *) _Objects_Allocate( &_Partition_Information ); a0017cbc: e59fa0a4 ldr sl, [pc, #164] ; a0017d68 a0017cc0: e58d2004 str r2, [sp, #4] a0017cc4: e58d3000 str r3, [sp] a0017cc8: e1a0000a mov r0, sl a0017ccc: eb001283 bl a001c6e0 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { a0017cd0: e2507000 subs r7, r0, #0 a0017cd4: e59d2004 ldr r2, [sp, #4] a0017cd8: e59d3000 ldr r3, [sp] a0017cdc: 0a00001d beq a0017d58 #endif the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; a0017ce0: e59d1028 ldr r1, [sp, #40] ; 0x28 return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; a0017ce4: e5872014 str r2, [r7, #20] the_partition->buffer_size = buffer_size; a0017ce8: e5873018 str r3, [r7, #24] the_partition->attribute_set = attribute_set; a0017cec: e587101c str r1, [r7, #28] _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; a0017cf0: e5874010 str r4, [r7, #16] the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, a0017cf4: e1a01003 mov r1, r3 the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; a0017cf8: e5878020 str r8, [r7, #32] _Chain_Initialize( &the_partition->Memory, starting_address, a0017cfc: e1a00002 mov r0, r2 a0017d00: e58d3000 str r3, [sp] a0017d04: eb0060bb bl a002fff8 <__aeabi_uidiv> a0017d08: e2879024 add r9, r7, #36 ; 0x24 a0017d0c: e1a02000 mov r2, r0 a0017d10: e1a01004 mov r1, r4 a0017d14: e1a00009 mov r0, r9 a0017d18: e59d3000 ldr r3, [sp] a0017d1c: eb000c81 bl a001af28 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a0017d20: e5973008 ldr r3, [r7, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0017d24: e59a201c ldr r2, [sl, #28] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a0017d28: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0017d2c: e7827721 str r7, [r2, r1, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a0017d30: e587600c str r6, [r7, #12] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; a0017d34: e5853000 str r3, [r5] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); a0017d38: eb0016ab bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0017d3c: e1a00008 mov r0, r8 } a0017d40: e28dd008 add sp, sp, #8 a0017d44: e8bd87f0 pop {r4, r5, r6, r7, r8, r9, sl, pc} if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; a0017d48: e3a00008 mov r0, #8 <== NOT EXECUTED a0017d4c: eafffffb b a0017d40 <== NOT EXECUTED if ( !_Addresses_Is_aligned( starting_address ) ) return RTEMS_INVALID_ADDRESS; a0017d50: e3a00009 mov r0, #9 <== NOT EXECUTED a0017d54: eafffff9 b a0017d40 <== NOT EXECUTED _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); a0017d58: eb0016a3 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_TOO_MANY; a0017d5c: e3a00005 mov r0, #5 <== NOT EXECUTED a0017d60: eafffff6 b a0017d40 <== NOT EXECUTED =============================================================================== a0017d6c : */ rtems_status_code rtems_partition_delete( rtems_id id ) { a0017d6c: e92d4030 push {r4, r5, lr} a0017d70: e24dd004 sub sp, sp, #4 a0017d74: e1a01000 mov r1, r0 Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) _Objects_Get( &_Partition_Information, id, location ); a0017d78: e1a0200d mov r2, sp a0017d7c: e59f0054 ldr r0, [pc, #84] ; a0017dd8 a0017d80: eb00139b bl a001cbf4 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { a0017d84: e59d3000 ldr r3, [sp] a0017d88: e1a04000 mov r4, r0 a0017d8c: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0017d90: 13a00004 movne r0, #4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { a0017d94: 1a000004 bne a0017dac case OBJECTS_LOCAL: if ( the_partition->number_of_used_blocks == 0 ) { a0017d98: e5945020 ldr r5, [r4, #32] a0017d9c: e3550000 cmp r5, #0 a0017da0: 0a000003 beq a0017db4 #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a0017da4: eb001690 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_RESOURCE_IN_USE; a0017da8: e3a0000c mov r0, #12 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0017dac: e28dd004 add sp, sp, #4 a0017db0: e8bd8030 pop {r4, r5, pc} the_partition = _Partition_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_partition->number_of_used_blocks == 0 ) { _Objects_Close( &_Partition_Information, &the_partition->Object ); a0017db4: e1a01004 mov r1, r4 a0017db8: e59f0018 ldr r0, [pc, #24] ; a0017dd8 a0017dbc: eb00126c bl a001c774 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Partition_Free ( Partition_Control *the_partition ) { _Objects_Free( &_Partition_Information, &the_partition->Object ); a0017dc0: e59f0010 ldr r0, [pc, #16] ; a0017dd8 a0017dc4: e1a01004 mov r1, r4 a0017dc8: eb001320 bl a001ca50 <_Objects_Free> 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); a0017dcc: eb001686 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0017dd0: e1a00005 mov r0, r5 a0017dd4: eafffff4 b a0017dac =============================================================================== a0017e88 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { a0017e88: e92d4070 push {r4, r5, r6, lr} a0017e8c: e1a03000 mov r3, r0 a0017e90: e24dd004 sub sp, sp, #4 a0017e94: e1a04001 mov r4, r1 Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) _Objects_Get( &_Partition_Information, id, location ); a0017e98: e59f008c ldr r0, [pc, #140] ; a0017f2c a0017e9c: e1a01003 mov r1, r3 a0017ea0: e1a0200d mov r2, sp a0017ea4: eb001352 bl a001cbf4 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { a0017ea8: e59d3000 ldr r3, [sp] a0017eac: e1a05000 mov r5, r0 a0017eb0: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0017eb4: 13a00004 movne r0, #4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { a0017eb8: 1a000016 bne a0017f18 ) { void *starting; void *ending; starting = the_partition->starting_address; a0017ebc: e5950010 ldr r0, [r5, #16] a0017ec0: e5953014 ldr r3, [r5, #20] a0017ec4: e0803003 add r3, r0, r3 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); a0017ec8: e1540003 cmp r4, r3 a0017ecc: 83a03000 movhi r3, #0 a0017ed0: 93a03001 movls r3, #1 a0017ed4: e1540000 cmp r4, r0 a0017ed8: 33a03000 movcc r3, #0 ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && a0017edc: e3530000 cmp r3, #0 a0017ee0: 0a00000e beq a0017f20 offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); a0017ee4: e0600004 rsb r0, r0, r4 a0017ee8: e5951018 ldr r1, [r5, #24] a0017eec: eb006087 bl a0030110 <__umodsi3> starting = the_partition->starting_address; ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && a0017ef0: e2506000 subs r6, r0, #0 a0017ef4: 1a000009 bne a0017f20 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); a0017ef8: e2850024 add r0, r5, #36 ; 0x24 a0017efc: e1a01004 mov r1, r4 a0017f00: eb000be8 bl a001aea8 <_Chain_Append> case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; a0017f04: e5953020 ldr r3, [r5, #32] a0017f08: e2433001 sub r3, r3, #1 a0017f0c: e5853020 str r3, [r5, #32] _Thread_Enable_dispatch(); a0017f10: eb001635 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0017f14: e1a00006 mov r0, r6 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0017f18: e28dd004 add sp, sp, #4 a0017f1c: e8bd8070 pop {r4, r5, r6, pc} _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a0017f20: eb001631 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; a0017f24: e3a00009 mov r0, #9 <== NOT EXECUTED a0017f28: eafffffa b a0017f18 <== NOT EXECUTED =============================================================================== a001724c : void *internal_start, void *external_start, uint32_t length, rtems_id *id ) { a001724c: e92d40f0 push {r4, r5, r6, r7, lr} register Dual_ported_memory_Control *the_port; if ( !rtems_is_name_valid( name ) ) a0017250: e2504000 subs r4, r0, #0 void *internal_start, void *external_start, uint32_t length, rtems_id *id ) { a0017254: e24dd00c sub sp, sp, #12 a0017258: e59d5020 ldr r5, [sp, #32] register Dual_ported_memory_Control *the_port; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a001725c: 03a00003 moveq r0, #3 rtems_id *id ) { register Dual_ported_memory_Control *the_port; if ( !rtems_is_name_valid( name ) ) a0017260: 0a000005 beq a001727c return RTEMS_INVALID_NAME; if ( !id ) a0017264: e3550000 cmp r5, #0 a0017268: 0a000002 beq a0017278 * id - port id * RTEMS_SUCCESSFUL - if successful * error code - if unsuccessful */ rtems_status_code rtems_port_create( a001726c: e1826001 orr r6, r2, r1 return RTEMS_INVALID_NAME; if ( !id ) return RTEMS_INVALID_ADDRESS; if ( !_Addresses_Is_aligned( internal_start ) || a0017270: e2166007 ands r6, r6, #7 a0017274: 0a000002 beq a0017284 !_Addresses_Is_aligned( external_start ) ) return RTEMS_INVALID_ADDRESS; a0017278: e3a00009 mov r0, #9 <== NOT EXECUTED ); *id = the_port->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a001727c: e28dd00c add sp, sp, #12 a0017280: e8bd80f0 pop {r4, r5, r6, r7, pc} rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a0017284: e59f0074 ldr r0, [pc, #116] ; a0017300 a0017288: e590c000 ldr ip, [r0] a001728c: e28cc001 add ip, ip, #1 a0017290: e580c000 str ip, [r0] */ RTEMS_INLINE_ROUTINE Dual_ported_memory_Control *_Dual_ported_memory_Allocate ( void ) { return (Dual_ported_memory_Control *) _Objects_Allocate( &_Dual_ported_memory_Information ); a0017294: e59f7068 ldr r7, [pc, #104] ; a0017304 a0017298: e58d1008 str r1, [sp, #8] a001729c: e58d2004 str r2, [sp, #4] a00172a0: e1a00007 mov r0, r7 a00172a4: e58d3000 str r3, [sp] a00172a8: eb00150c bl a001c6e0 <_Objects_Allocate> _Thread_Disable_dispatch(); /* to prevent deletion */ the_port = _Dual_ported_memory_Allocate(); if ( !the_port ) { a00172ac: e3500000 cmp r0, #0 a00172b0: e59d1008 ldr r1, [sp, #8] a00172b4: e59d2004 ldr r2, [sp, #4] a00172b8: e59d3000 ldr r3, [sp] a00172bc: 0a00000c beq a00172f4 Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a00172c0: e590c008 ldr ip, [r0, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00172c4: e597e01c ldr lr, [r7, #28] return RTEMS_TOO_MANY; } the_port->internal_base = internal_start; the_port->external_base = external_start; the_port->length = length - 1; a00172c8: e2433001 sub r3, r3, #1 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a00172cc: e1a0780c lsl r7, ip, #16 if ( !the_port ) { _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_port->internal_base = internal_start; a00172d0: e5801010 str r1, [r0, #16] the_port->external_base = external_start; a00172d4: e5802014 str r2, [r0, #20] the_port->length = length - 1; a00172d8: e5803018 str r3, [r0, #24] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00172dc: e78e0727 str r0, [lr, r7, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a00172e0: e580400c str r4, [r0, #12] &_Dual_ported_memory_Information, &the_port->Object, (Objects_Name) name ); *id = the_port->Object.id; a00172e4: e585c000 str ip, [r5] _Thread_Enable_dispatch(); a00172e8: eb00193f bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a00172ec: e1a00006 mov r0, r6 a00172f0: eaffffe1 b a001727c _Thread_Disable_dispatch(); /* to prevent deletion */ the_port = _Dual_ported_memory_Allocate(); if ( !the_port ) { _Thread_Enable_dispatch(); a00172f4: eb00193c bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; a00172f8: e3a00005 mov r0, #5 a00172fc: eaffffde b a001727c =============================================================================== a0017f30 : */ rtems_status_code rtems_rate_monotonic_cancel( rtems_id id ) { a0017f30: e92d4030 push {r4, r5, lr} a0017f34: e24dd004 sub sp, sp, #4 a0017f38: e1a01000 mov r1, r0 Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); a0017f3c: e1a0200d mov r2, sp a0017f40: e59f0050 ldr r0, [pc, #80] ; a0017f98 a0017f44: eb00132a bl a001cbf4 <_Objects_Get> Rate_monotonic_Control *the_period; Objects_Locations location; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0017f48: e59d4000 ldr r4, [sp] a0017f4c: e1a05000 mov r5, r0 a0017f50: e3540000 cmp r4, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0017f54: 13a00004 movne r0, #4 { Rate_monotonic_Control *the_period; Objects_Locations location; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0017f58: 1a000006 bne a0017f78 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { a0017f5c: e59f3038 ldr r3, [pc, #56] ; a0017f9c a0017f60: e5952040 ldr r2, [r5, #64] ; 0x40 a0017f64: e5933004 ldr r3, [r3, #4] a0017f68: e1520003 cmp r2, r3 a0017f6c: 0a000003 beq a0017f80 _Thread_Enable_dispatch(); a0017f70: eb00161d bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_NOT_OWNER_OF_RESOURCE; a0017f74: e3a00017 mov r0, #23 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0017f78: e28dd004 add sp, sp, #4 a0017f7c: e8bd8030 pop {r4, r5, pc} case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } (void) _Watchdog_Remove( &the_period->Timer ); a0017f80: e2850010 add r0, r5, #16 a0017f84: eb001afa bl a001eb74 <_Watchdog_Remove> the_period->state = RATE_MONOTONIC_INACTIVE; a0017f88: e5854038 str r4, [r5, #56] ; 0x38 _Thread_Enable_dispatch(); a0017f8c: eb001616 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0017f90: e1a00004 mov r0, r4 a0017f94: eafffff7 b a0017f78 =============================================================================== a000a8c4 : rtems_status_code rtems_rate_monotonic_create( rtems_name name, rtems_id *id ) { a000a8c4: e92d4070 push {r4, r5, r6, lr} Rate_monotonic_Control *the_period; if ( !rtems_is_name_valid( name ) ) a000a8c8: e2504000 subs r4, r0, #0 rtems_status_code rtems_rate_monotonic_create( rtems_name name, rtems_id *id ) { a000a8cc: e1a05001 mov r5, r1 Rate_monotonic_Control *the_period; if ( !rtems_is_name_valid( name ) ) a000a8d0: 0a00002b beq a000a984 return RTEMS_INVALID_NAME; if ( !id ) a000a8d4: e3510000 cmp r1, #0 a000a8d8: 0a00002e beq a000a998 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000a8dc: e59f30bc ldr r3, [pc, #188] ; a000a9a0 a000a8e0: e5932000 ldr r2, [r3] a000a8e4: e2822001 add r2, r2, #1 a000a8e8: e5832000 str r2, [r3] * the inactive chain of free period control blocks. */ RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Allocate( void ) { return (Rate_monotonic_Control *) _Objects_Allocate( &_Rate_monotonic_Information ); a000a8ec: e59f60b0 ldr r6, [pc, #176] ; a000a9a4 a000a8f0: e1a00006 mov r0, r6 a000a8f4: eb00080b bl a000c928 <_Objects_Allocate> _Thread_Disable_dispatch(); /* to prevent deletion */ the_period = _Rate_monotonic_Allocate(); if ( !the_period ) { a000a8f8: e3500000 cmp r0, #0 a000a8fc: 0a000022 beq a000a98c _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_period->owner = _Thread_Executing; a000a900: e59f30a0 ldr r3, [pc, #160] ; a000a9a8 Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a000a904: e5902008 ldr r2, [r0, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000a908: e596101c ldr r1, [r6, #28] a000a90c: e593e004 ldr lr, [r3, #4] the_period->state = RATE_MONOTONIC_INACTIVE; a000a910: e3a06000 mov r6, #0 _Watchdog_Initialize( &the_period->Timer, NULL, 0, NULL ); _Rate_monotonic_Reset_statistics( the_period ); a000a914: e3e03102 mvn r3, #-2147483648 ; 0x80000000 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a000a918: e1a0c802 lsl ip, r2, #16 if ( !the_period ) { _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_period->owner = _Thread_Executing; a000a91c: e580e040 str lr, [r0, #64] ; 0x40 the_period->state = RATE_MONOTONIC_INACTIVE; a000a920: e5806038 str r6, [r0, #56] ; 0x38 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000a924: e5806018 str r6, [r0, #24] the_watchdog->routine = routine; a000a928: e580602c str r6, [r0, #44] ; 0x2c the_watchdog->id = id; a000a92c: e5806030 str r6, [r0, #48] ; 0x30 the_watchdog->user_data = user_data; a000a930: e5806034 str r6, [r0, #52] ; 0x34 _Watchdog_Initialize( &the_period->Timer, NULL, 0, NULL ); _Rate_monotonic_Reset_statistics( the_period ); a000a934: e5806054 str r6, [r0, #84] ; 0x54 a000a938: e5806058 str r6, [r0, #88] ; 0x58 a000a93c: e5806064 str r6, [r0, #100] ; 0x64 a000a940: e5806068 str r6, [r0, #104] ; 0x68 a000a944: e580606c str r6, [r0, #108] ; 0x6c a000a948: e5806070 str r6, [r0, #112] ; 0x70 a000a94c: e580607c str r6, [r0, #124] ; 0x7c a000a950: e5806080 str r6, [r0, #128] ; 0x80 a000a954: e5806084 str r6, [r0, #132] ; 0x84 a000a958: e5806088 str r6, [r0, #136] ; 0x88 a000a95c: e580305c str r3, [r0, #92] ; 0x5c a000a960: e5803060 str r3, [r0, #96] ; 0x60 a000a964: e5803074 str r3, [r0, #116] ; 0x74 a000a968: e5803078 str r3, [r0, #120] ; 0x78 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000a96c: e781072c str r0, [r1, ip, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a000a970: e580400c str r4, [r0, #12] &_Rate_monotonic_Information, &the_period->Object, (Objects_Name) name ); *id = the_period->Object.id; a000a974: e5852000 str r2, [r5] _Thread_Enable_dispatch(); a000a978: eb000c5e bl a000daf8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000a97c: e1a00006 mov r0, r6 a000a980: e8bd8070 pop {r4, r5, r6, pc} ) { Rate_monotonic_Control *the_period; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a000a984: e3a00003 mov r0, #3 <== NOT EXECUTED a000a988: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED _Thread_Disable_dispatch(); /* to prevent deletion */ the_period = _Rate_monotonic_Allocate(); if ( !the_period ) { _Thread_Enable_dispatch(); a000a98c: eb000c59 bl a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_TOO_MANY; a000a990: e3a00005 mov r0, #5 <== NOT EXECUTED a000a994: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) return RTEMS_INVALID_ADDRESS; a000a998: e3a00009 mov r0, #9 <== NOT EXECUTED ); *id = the_period->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a000a99c: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED =============================================================================== a0010a10 : rtems_status_code rtems_rate_monotonic_get_statistics( rtems_id id, rtems_rate_monotonic_period_statistics *statistics ) { a0010a10: e92d4bf0 push {r4, r5, r6, r7, r8, r9, fp, lr} <== NOT EXECUTED Objects_Locations location; Rate_monotonic_Control *the_period; rtems_rate_monotonic_period_statistics *dst; Rate_monotonic_Statistics *src; if ( !statistics ) a0010a14: e2514000 subs r4, r1, #0 <== NOT EXECUTED rtems_status_code rtems_rate_monotonic_get_statistics( rtems_id id, rtems_rate_monotonic_period_statistics *statistics ) { a0010a18: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a0010a1c: e1a01000 mov r1, r0 <== NOT EXECUTED Rate_monotonic_Control *the_period; rtems_rate_monotonic_period_statistics *dst; Rate_monotonic_Statistics *src; if ( !statistics ) return RTEMS_INVALID_ADDRESS; a0010a20: 03a00009 moveq r0, #9 <== NOT EXECUTED Objects_Locations location; Rate_monotonic_Control *the_period; rtems_rate_monotonic_period_statistics *dst; Rate_monotonic_Statistics *src; if ( !statistics ) a0010a24: 0a000024 beq a0010abc <== NOT EXECUTED a0010a28: e59f0094 ldr r0, [pc, #148] ; a0010ac4 <== NOT EXECUTED a0010a2c: e1a0200d mov r2, sp <== NOT EXECUTED a0010a30: ebfff132 bl a000cf00 <_Objects_Get> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0010a34: e59d5000 ldr r5, [sp] <== NOT EXECUTED a0010a38: e3550000 cmp r5, #0 <== NOT EXECUTED #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0010a3c: 13a00004 movne r0, #4 <== NOT EXECUTED if ( !statistics ) return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0010a40: 1a00001d bne a0010abc <== NOT EXECUTED case OBJECTS_LOCAL: dst = statistics; src = &the_period->Statistics; dst->count = src->count; a0010a44: e590e054 ldr lr, [r0, #84] ; 0x54 <== NOT EXECUTED dst->missed_count = src->missed_count; a0010a48: e5901058 ldr r1, [r0, #88] ; 0x58 <== NOT EXECUTED #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time ); _Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time ); _Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time ); _Timestamp_To_timespec( &src->min_wall_time, &dst->min_wall_time ); a0010a4c: e2803074 add r3, r0, #116 ; 0x74 <== NOT EXECUTED a0010a50: e893000c ldm r3, {r2, r3} <== NOT EXECUTED dst = statistics; src = &the_period->Statistics; dst->count = src->count; dst->missed_count = src->missed_count; #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time ); a0010a54: e280905c add r9, r0, #92 ; 0x5c <== NOT EXECUTED a0010a58: e8990300 ldm r9, {r8, r9} <== NOT EXECUTED _Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time ); a0010a5c: e2807064 add r7, r0, #100 ; 0x64 <== NOT EXECUTED a0010a60: e89700c0 ldm r7, {r6, r7} <== NOT EXECUTED _Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time ); a0010a64: e280c06c add ip, r0, #108 ; 0x6c <== NOT EXECUTED a0010a68: e89c1800 ldm ip, {fp, ip} <== NOT EXECUTED _Timestamp_To_timespec( &src->min_wall_time, &dst->min_wall_time ); a0010a6c: e5842020 str r2, [r4, #32] <== NOT EXECUTED a0010a70: e5843024 str r3, [r4, #36] ; 0x24 <== NOT EXECUTED _Timestamp_To_timespec( &src->max_wall_time, &dst->max_wall_time ); a0010a74: e280307c add r3, r0, #124 ; 0x7c <== NOT EXECUTED a0010a78: e893000c ldm r3, {r2, r3} <== NOT EXECUTED a0010a7c: e5842028 str r2, [r4, #40] ; 0x28 <== NOT EXECUTED a0010a80: e584302c str r3, [r4, #44] ; 0x2c <== NOT EXECUTED _Timestamp_To_timespec( &src->total_wall_time, &dst->total_wall_time ); a0010a84: e2803084 add r3, r0, #132 ; 0x84 <== NOT EXECUTED a0010a88: e893000c ldm r3, {r2, r3} <== NOT EXECUTED switch ( location ) { case OBJECTS_LOCAL: dst = statistics; src = &the_period->Statistics; dst->count = src->count; a0010a8c: e584e000 str lr, [r4] <== NOT EXECUTED _Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time ); _Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time ); _Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time ); _Timestamp_To_timespec( &src->min_wall_time, &dst->min_wall_time ); _Timestamp_To_timespec( &src->max_wall_time, &dst->max_wall_time ); _Timestamp_To_timespec( &src->total_wall_time, &dst->total_wall_time ); a0010a90: e5842030 str r2, [r4, #48] ; 0x30 <== NOT EXECUTED a0010a94: e5843034 str r3, [r4, #52] ; 0x34 <== NOT EXECUTED case OBJECTS_LOCAL: dst = statistics; src = &the_period->Statistics; dst->count = src->count; dst->missed_count = src->missed_count; a0010a98: e5841004 str r1, [r4, #4] <== NOT EXECUTED #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time ); a0010a9c: e5848008 str r8, [r4, #8] <== NOT EXECUTED a0010aa0: e584900c str r9, [r4, #12] <== NOT EXECUTED _Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time ); a0010aa4: e5846010 str r6, [r4, #16] <== NOT EXECUTED a0010aa8: e5847014 str r7, [r4, #20] <== NOT EXECUTED _Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time ); a0010aac: e584b018 str fp, [r4, #24] <== NOT EXECUTED a0010ab0: e584c01c str ip, [r4, #28] <== NOT EXECUTED dst->min_wall_time = src->min_wall_time; dst->max_wall_time = src->max_wall_time; dst->total_wall_time = src->total_wall_time; #endif _Thread_Enable_dispatch(); a0010ab4: ebfff40f bl a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a0010ab8: e1a00005 mov r0, r5 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0010abc: e28dd004 add sp, sp, #4 <== NOT EXECUTED a0010ac0: e8bd8bf0 pop {r4, r5, r6, r7, r8, r9, fp, pc} <== NOT EXECUTED =============================================================================== a0010ac8 : rtems_status_code rtems_rate_monotonic_get_status( rtems_id id, rtems_rate_monotonic_period_status *status ) { a0010ac8: e92d4010 push {r4, lr} Objects_Locations location; Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) a0010acc: e2514000 subs r4, r1, #0 rtems_status_code rtems_rate_monotonic_get_status( rtems_id id, rtems_rate_monotonic_period_status *status ) { a0010ad0: e24dd014 sub sp, sp, #20 a0010ad4: e1a01000 mov r1, r0 Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) return RTEMS_INVALID_ADDRESS; a0010ad8: 03a00009 moveq r0, #9 Objects_Locations location; Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) a0010adc: 0a000013 beq a0010b30 a0010ae0: e28d2010 add r2, sp, #16 a0010ae4: e59f008c ldr r0, [pc, #140] ; a0010b78 a0010ae8: ebfff104 bl a000cf00 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0010aec: e59d2010 ldr r2, [sp, #16] a0010af0: e1a03000 mov r3, r0 a0010af4: e3520000 cmp r2, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0010af8: 13a00004 movne r0, #4 if ( !status ) return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a0010afc: 1a00000b bne a0010b30 case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; a0010b00: e5932040 ldr r2, [r3, #64] ; 0x40 status->state = the_period->state; a0010b04: e5933038 ldr r3, [r3, #56] ; 0x38 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; a0010b08: e5922008 ldr r2, [r2, #8] status->state = the_period->state; /* * If the period is inactive, there is no information. */ if ( status->state == RATE_MONOTONIC_INACTIVE ) { a0010b0c: e3530000 cmp r3, #0 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; status->state = the_period->state; a0010b10: e884000c stm r4, {r2, r3} /* * If the period is inactive, there is no information. */ if ( status->state == RATE_MONOTONIC_INACTIVE ) { a0010b14: 1a000007 bne a0010b38 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timespec_Set_to_zero( &status->since_last_period ); a0010b18: e5843008 str r3, [r4, #8] a0010b1c: e584300c str r3, [r4, #12] _Timespec_Set_to_zero( &status->executed_since_last_period ); a0010b20: e5843010 str r3, [r4, #16] a0010b24: e5843014 str r3, [r4, #20] status->since_last_period = since_last_period; status->executed_since_last_period = executed; #endif } _Thread_Enable_dispatch(); a0010b28: ebfff3f2 bl a000daf8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0010b2c: e3a00000 mov r0, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0010b30: e28dd014 add sp, sp, #20 a0010b34: e8bd8010 pop {r4, pc} } else { /* * Grab the current status. */ valid_status = a0010b38: e1a0100d mov r1, sp <== NOT EXECUTED a0010b3c: e28d2008 add r2, sp, #8 <== NOT EXECUTED a0010b40: ebffe7a5 bl a000a9dc <_Rate_monotonic_Get_status> <== NOT EXECUTED _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) { a0010b44: e3500000 cmp r0, #0 <== NOT EXECUTED a0010b48: 0a000007 beq a0010b6c <== NOT EXECUTED _Thread_Enable_dispatch(); return RTEMS_NOT_DEFINED; } #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( a0010b4c: e89d000c ldm sp, {r2, r3} <== NOT EXECUTED a0010b50: e5842008 str r2, [r4, #8] <== NOT EXECUTED a0010b54: e584300c str r3, [r4, #12] <== NOT EXECUTED &since_last_period, &status->since_last_period ); _Timestamp_To_timespec( a0010b58: e28d3008 add r3, sp, #8 <== NOT EXECUTED a0010b5c: e893000c ldm r3, {r2, r3} <== NOT EXECUTED a0010b60: e5842010 str r2, [r4, #16] <== NOT EXECUTED a0010b64: e5843014 str r3, [r4, #20] <== NOT EXECUTED a0010b68: eaffffee b a0010b28 <== NOT EXECUTED valid_status = _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) { _Thread_Enable_dispatch(); a0010b6c: ebfff3e1 bl a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_NOT_DEFINED; a0010b70: e3a0000b mov r0, #11 <== NOT EXECUTED a0010b74: eaffffed b a0010b30 <== NOT EXECUTED =============================================================================== a000ac08 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { a000ac08: e92d41f0 push {r4, r5, r6, r7, r8, lr} a000ac0c: e1a04000 mov r4, r0 a000ac10: e24dd008 sub sp, sp, #8 a000ac14: e1a05001 mov r5, r1 Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); a000ac18: e59f017c ldr r0, [pc, #380] ; a000ad9c a000ac1c: e1a01004 mov r1, r4 a000ac20: e28d2004 add r2, sp, #4 a000ac24: eb0008b5 bl a000cf00 <_Objects_Get> rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a000ac28: e59d3004 ldr r3, [sp, #4] a000ac2c: e1a06000 mov r6, r0 a000ac30: e3530000 cmp r3, #0 a000ac34: 1a000008 bne a000ac5c RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); a000ac38: e59f7160 ldr r7, [pc, #352] ; a000ada0 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { a000ac3c: e5902040 ldr r2, [r0, #64] ; 0x40 a000ac40: e5973004 ldr r3, [r7, #4] a000ac44: e1520003 cmp r2, r3 a000ac48: 0a000005 beq a000ac64 _Thread_Enable_dispatch(); a000ac4c: eb000ba9 bl a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_NOT_OWNER_OF_RESOURCE; a000ac50: e3a00017 mov r0, #23 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000ac54: e28dd008 add sp, sp, #8 a000ac58: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000ac5c: e3a00004 mov r0, #4 <== NOT EXECUTED a000ac60: eafffffb b a000ac54 <== NOT EXECUTED if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { a000ac64: e3550000 cmp r5, #0 a000ac68: 1a000008 bne a000ac90 switch ( the_period->state ) { a000ac6c: e5903038 ldr r3, [r0, #56] ; 0x38 a000ac70: e3530004 cmp r3, #4 a000ac74: 959f2128 ldrls r2, [pc, #296] ; a000ada4 a000ac78: 81a00005 movhi r0, r5 a000ac7c: 97920103 ldrls r0, [r2, r3, lsl #2] the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); a000ac80: e58d0000 str r0, [sp] a000ac84: eb000b9b bl a000daf8 <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; a000ac88: e59d0000 ldr r0, [sp] a000ac8c: eafffff0 b a000ac54 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000ac90: e10f8000 mrs r8, CPSR a000ac94: e3883080 orr r3, r8, #128 ; 0x80 a000ac98: e129f003 msr CPSR_fc, r3 _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { a000ac9c: e5903038 ldr r3, [r0, #56] ; 0x38 a000aca0: e3530000 cmp r3, #0 a000aca4: 0a00000e beq a000ace4 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { a000aca8: e3530002 cmp r3, #2 a000acac: 0a00001f beq a000ad30 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { a000acb0: e3530004 cmp r3, #4 <== NOT EXECUTED a000acb4: 1affffe8 bne a000ac5c <== NOT EXECUTED /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); a000acb8: ebffff97 bl a000ab1c <_Rate_monotonic_Update_statistics> <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000acbc: e129f008 msr CPSR_fc, r8 <== NOT EXECUTED _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; a000acc0: e3a03002 mov r3, #2 <== NOT EXECUTED ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000acc4: e59f00dc ldr r0, [pc, #220] ; a000ada8 <== NOT EXECUTED a000acc8: e2861010 add r1, r6, #16 <== NOT EXECUTED a000accc: e5863038 str r3, [r6, #56] ; 0x38 <== NOT EXECUTED the_period->next_length = length; a000acd0: e586503c str r5, [r6, #60] ; 0x3c <== NOT EXECUTED Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000acd4: e586501c str r5, [r6, #28] <== NOT EXECUTED _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000acd8: eb000f76 bl a000eab8 <_Watchdog_Insert> <== NOT EXECUTED _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; a000acdc: e3a00006 mov r0, #6 <== NOT EXECUTED a000ace0: eaffffe6 b a000ac80 <== NOT EXECUTED a000ace4: e129f008 msr CPSR_fc, r8 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); a000ace8: ebffff6b bl a000aa9c <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; a000acec: e3a03002 mov r3, #2 a000acf0: e5863038 str r3, [r6, #56] ; 0x38 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a000acf4: e59f30b0 ldr r3, [pc, #176] ; a000adac Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000acf8: e3a07000 mov r7, #0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000acfc: e59f00a4 ldr r0, [pc, #164] ; a000ada8 a000ad00: e2861010 add r1, r6, #16 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a000ad04: e586302c str r3, [r6, #44] ; 0x2c Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000ad08: e5867018 str r7, [r6, #24] the_watchdog->routine = routine; the_watchdog->id = id; a000ad0c: e5864030 str r4, [r6, #48] ; 0x30 the_watchdog->user_data = user_data; a000ad10: e5867034 str r7, [r6, #52] ; 0x34 _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; a000ad14: e586503c str r5, [r6, #60] ; 0x3c Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000ad18: e586501c str r5, [r6, #28] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000ad1c: eb000f65 bl a000eab8 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); a000ad20: e58d7000 str r7, [sp] a000ad24: eb000b73 bl a000daf8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000ad28: e59d0000 ldr r0, [sp] a000ad2c: eaffffc8 b a000ac54 if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); a000ad30: ebffff79 bl a000ab1c <_Rate_monotonic_Update_statistics> /* * This tells the _Rate_monotonic_Timeout that this task is * in the process of blocking on the period and that we * may be changing the length of the next period. */ the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; a000ad34: e3a03001 mov r3, #1 a000ad38: e5863038 str r3, [r6, #56] ; 0x38 the_period->next_length = length; a000ad3c: e586503c str r5, [r6, #60] ; 0x3c a000ad40: e129f008 msr CPSR_fc, r8 _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; a000ad44: e5973004 ldr r3, [r7, #4] a000ad48: e5962008 ldr r2, [r6, #8] _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); a000ad4c: e3a01901 mov r1, #16384 ; 0x4000 a000ad50: e1a00003 mov r0, r3 the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; the_period->next_length = length; _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; a000ad54: e5832020 str r2, [r3, #32] _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); a000ad58: eb000d8c bl a000e390 <_Thread_Set_state> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000ad5c: e10f2000 mrs r2, CPSR a000ad60: e3823080 orr r3, r2, #128 ; 0x80 a000ad64: e129f003 msr CPSR_fc, r3 * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; a000ad68: e3a01002 mov r1, #2 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; a000ad6c: e5963038 ldr r3, [r6, #56] ; 0x38 the_period->state = RATE_MONOTONIC_ACTIVE; a000ad70: e5861038 str r1, [r6, #56] ; 0x38 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000ad74: e129f002 msr CPSR_fc, r2 /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) a000ad78: e3530003 cmp r3, #3 a000ad7c: 0a000002 beq a000ad8c _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); a000ad80: eb000b5c bl a000daf8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000ad84: e3a00000 mov r0, #0 <== NOT EXECUTED a000ad88: eaffffb1 b a000ac54 <== NOT EXECUTED /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); a000ad8c: e5970004 ldr r0, [r7, #4] <== NOT EXECUTED a000ad90: e3a01901 mov r1, #16384 ; 0x4000 <== NOT EXECUTED a000ad94: eb000a75 bl a000d770 <_Thread_Clear_state> <== NOT EXECUTED a000ad98: eafffff8 b a000ad80 <== NOT EXECUTED =============================================================================== a000afc8 : } } void rtems_rate_monotonic_report_statistics( void ) { rtems_rate_monotonic_report_statistics_with_plugin( NULL, printk_plugin ); a000afc8: e59f1004 ldr r1, [pc, #4] ; a000afd4 <== NOT EXECUTED a000afcc: e3a00000 mov r0, #0 <== NOT EXECUTED a000afd0: eaffff76 b a000adb0 <== NOT EXECUTED =============================================================================== a000adb0 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { a000adb0: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} <== NOT EXECUTED rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) a000adb4: e2515000 subs r5, r1, #0 <== NOT EXECUTED */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { a000adb8: e24dd078 sub sp, sp, #120 ; 0x78 <== NOT EXECUTED a000adbc: e1a08000 mov r8, r0 <== NOT EXECUTED rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) a000adc0: 0a000040 beq a000aec8 <== NOT EXECUTED return; (*print)( context, "Period information by period\n" ); a000adc4: e59f11d0 ldr r1, [pc, #464] ; a000af9c <== NOT EXECUTED a000adc8: e12fff35 blx r5 <== NOT EXECUTED #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); a000adcc: e59f11cc ldr r1, [pc, #460] ; a000afa0 <== NOT EXECUTED a000add0: e1a00008 mov r0, r8 <== NOT EXECUTED a000add4: e12fff35 blx r5 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000add8: e59f61c4 ldr r6, [pc, #452] ; a000afa4 <== NOT EXECUTED return; (*print)( context, "Period information by period\n" ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); (*print)( context, "--- Wall times are in seconds ---\n" ); a000addc: e59f11c4 ldr r1, [pc, #452] ; a000afa8 <== NOT EXECUTED a000ade0: e1a00008 mov r0, r8 <== NOT EXECUTED a000ade4: e12fff35 blx r5 <== NOT EXECUTED Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " a000ade8: e59f11bc ldr r1, [pc, #444] ; a000afac <== NOT EXECUTED a000adec: e1a00008 mov r0, r8 <== NOT EXECUTED a000adf0: e12fff35 blx r5 <== NOT EXECUTED #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " a000adf4: e1a00008 mov r0, r8 <== NOT EXECUTED a000adf8: e59f11b0 ldr r1, [pc, #432] ; a000afb0 <== NOT EXECUTED a000adfc: e12fff35 blx r5 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000ae00: e5964008 ldr r4, [r6, #8] <== NOT EXECUTED a000ae04: e596300c ldr r3, [r6, #12] <== NOT EXECUTED a000ae08: e1540003 cmp r4, r3 <== NOT EXECUTED a000ae0c: 8a00002d bhi a000aec8 <== NOT EXECUTED a000ae10: e28d7018 add r7, sp, #24 <== NOT EXECUTED { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; a000ae14: e2870018 add r0, r7, #24 <== NOT EXECUTED { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; a000ae18: e2871030 add r1, r7, #48 ; 0x30 <== NOT EXECUTED struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, a000ae1c: e59fa190 ldr sl, [pc, #400] ; a000afb4 <== NOT EXECUTED continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); a000ae20: e28d9070 add r9, sp, #112 ; 0x70 <== NOT EXECUTED { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; a000ae24: e58d0010 str r0, [sp, #16] <== NOT EXECUTED _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); a000ae28: e28db068 add fp, sp, #104 ; 0x68 <== NOT EXECUTED { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; a000ae2c: e58d1014 str r1, [sp, #20] <== NOT EXECUTED a000ae30: ea000003 b a000ae44 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000ae34: e596300c ldr r3, [r6, #12] <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { a000ae38: e2844001 add r4, r4, #1 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000ae3c: e1530004 cmp r3, r4 <== NOT EXECUTED a000ae40: 3a000020 bcc a000aec8 <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); a000ae44: e1a00004 mov r0, r4 <== NOT EXECUTED a000ae48: e1a01007 mov r1, r7 <== NOT EXECUTED a000ae4c: eb0016ef bl a0010a10 <== NOT EXECUTED if ( status != RTEMS_SUCCESSFUL ) a000ae50: e3500000 cmp r0, #0 <== NOT EXECUTED a000ae54: 1afffff6 bne a000ae34 <== NOT EXECUTED #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); a000ae58: e28d1050 add r1, sp, #80 ; 0x50 <== NOT EXECUTED a000ae5c: e1a00004 mov r0, r4 <== NOT EXECUTED a000ae60: eb001718 bl a0010ac8 <== NOT EXECUTED #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); a000ae64: e1a02009 mov r2, r9 <== NOT EXECUTED a000ae68: e3a01005 mov r1, #5 <== NOT EXECUTED a000ae6c: e59d0050 ldr r0, [sp, #80] ; 0x50 <== NOT EXECUTED a000ae70: eb0000b9 bl a000b15c <== NOT EXECUTED /* * Print part of report line that is not dependent on granularity */ (*print)( context, a000ae74: e59d3018 ldr r3, [sp, #24] <== NOT EXECUTED a000ae78: e59f1138 ldr r1, [pc, #312] ; a000afb8 <== NOT EXECUTED a000ae7c: e1a02004 mov r2, r4 <== NOT EXECUTED a000ae80: e58d3000 str r3, [sp] <== NOT EXECUTED a000ae84: e59d301c ldr r3, [sp, #28] <== NOT EXECUTED a000ae88: e1a00008 mov r0, r8 <== NOT EXECUTED a000ae8c: e58d3004 str r3, [sp, #4] <== NOT EXECUTED a000ae90: e1a03009 mov r3, r9 <== NOT EXECUTED a000ae94: e12fff35 blx r5 <== NOT EXECUTED ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { a000ae98: e59d3018 ldr r3, [sp, #24] <== NOT EXECUTED struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); a000ae9c: e59d0010 ldr r0, [sp, #16] <== NOT EXECUTED a000aea0: e1a0200b mov r2, fp <== NOT EXECUTED ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { a000aea4: e3530000 cmp r3, #0 <== NOT EXECUTED (*print)( context, "\n" ); a000aea8: e59f110c ldr r1, [pc, #268] ; a000afbc <== NOT EXECUTED ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { a000aeac: 1a000007 bne a000aed0 <== NOT EXECUTED (*print)( context, "\n" ); a000aeb0: e1a00008 mov r0, r8 <== NOT EXECUTED a000aeb4: e12fff35 blx r5 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000aeb8: e596300c ldr r3, [r6, #12] <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { a000aebc: e2844001 add r4, r4, #1 <== NOT EXECUTED /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000aec0: e1530004 cmp r3, r4 <== NOT EXECUTED a000aec4: 2affffde bcs a000ae44 <== NOT EXECUTED the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } a000aec8: e28dd078 add sp, sp, #120 ; 0x78 <== NOT EXECUTED a000aecc: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); a000aed0: e1a01003 mov r1, r3 <== NOT EXECUTED a000aed4: eb000dfa bl a000e6c4 <_Timespec_Divide_by_integer> <== NOT EXECUTED (*print)( context, a000aed8: e59d2024 ldr r2, [sp, #36] ; 0x24 <== NOT EXECUTED a000aedc: e59d3028 ldr r3, [sp, #40] ; 0x28 <== NOT EXECUTED a000aee0: e59d102c ldr r1, [sp, #44] ; 0x2c <== NOT EXECUTED a000aee4: e58d3000 str r3, [sp] <== NOT EXECUTED a000aee8: e0c3c29a smull ip, r3, sl, r2 <== NOT EXECUTED a000aeec: e1a02fc2 asr r2, r2, #31 <== NOT EXECUTED a000aef0: e0623343 rsb r3, r2, r3, asr #6 <== NOT EXECUTED a000aef4: e59d2068 ldr r2, [sp, #104] ; 0x68 <== NOT EXECUTED a000aef8: e0c0c19a smull ip, r0, sl, r1 <== NOT EXECUTED a000aefc: e58d2008 str r2, [sp, #8] <== NOT EXECUTED a000af00: e59d206c ldr r2, [sp, #108] ; 0x6c <== NOT EXECUTED a000af04: e1a01fc1 asr r1, r1, #31 <== NOT EXECUTED a000af08: e0611340 rsb r1, r1, r0, asr #6 <== NOT EXECUTED a000af0c: e0c0c29a smull ip, r0, sl, r2 <== NOT EXECUTED a000af10: e1a02fc2 asr r2, r2, #31 <== NOT EXECUTED a000af14: e0622340 rsb r2, r2, r0, asr #6 <== NOT EXECUTED a000af18: e58d1004 str r1, [sp, #4] <== NOT EXECUTED a000af1c: e58d200c str r2, [sp, #12] <== NOT EXECUTED a000af20: e59f1098 ldr r1, [pc, #152] ; a000afc0 <== NOT EXECUTED a000af24: e59d2020 ldr r2, [sp, #32] <== NOT EXECUTED a000af28: e1a00008 mov r0, r8 <== NOT EXECUTED a000af2c: e12fff35 blx r5 <== NOT EXECUTED struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); a000af30: e59d1018 ldr r1, [sp, #24] <== NOT EXECUTED a000af34: e59d0014 ldr r0, [sp, #20] <== NOT EXECUTED a000af38: e1a0200b mov r2, fp <== NOT EXECUTED a000af3c: eb000de0 bl a000e6c4 <_Timespec_Divide_by_integer> <== NOT EXECUTED (*print)( context, a000af40: e59d2040 ldr r2, [sp, #64] ; 0x40 <== NOT EXECUTED a000af44: e59d303c ldr r3, [sp, #60] ; 0x3c <== NOT EXECUTED a000af48: e58d2000 str r2, [sp] <== NOT EXECUTED a000af4c: e59d2044 ldr r2, [sp, #68] ; 0x44 <== NOT EXECUTED a000af50: e0c0139a smull r1, r0, sl, r3 <== NOT EXECUTED a000af54: e0c1c29a smull ip, r1, sl, r2 <== NOT EXECUTED a000af58: e1a02fc2 asr r2, r2, #31 <== NOT EXECUTED a000af5c: e0622341 rsb r2, r2, r1, asr #6 <== NOT EXECUTED a000af60: e58d2004 str r2, [sp, #4] <== NOT EXECUTED a000af64: e59d2068 ldr r2, [sp, #104] ; 0x68 <== NOT EXECUTED a000af68: e1a03fc3 asr r3, r3, #31 <== NOT EXECUTED a000af6c: e0633340 rsb r3, r3, r0, asr #6 <== NOT EXECUTED a000af70: e58d2008 str r2, [sp, #8] <== NOT EXECUTED a000af74: e59d206c ldr r2, [sp, #108] ; 0x6c <== NOT EXECUTED a000af78: e59f1044 ldr r1, [pc, #68] ; a000afc4 <== NOT EXECUTED a000af7c: e0c0c29a smull ip, r0, sl, r2 <== NOT EXECUTED a000af80: e1a02fc2 asr r2, r2, #31 <== NOT EXECUTED a000af84: e0622340 rsb r2, r2, r0, asr #6 <== NOT EXECUTED a000af88: e58d200c str r2, [sp, #12] <== NOT EXECUTED a000af8c: e1a00008 mov r0, r8 <== NOT EXECUTED a000af90: e59d2038 ldr r2, [sp, #56] ; 0x38 <== NOT EXECUTED a000af94: e12fff35 blx r5 <== NOT EXECUTED a000af98: eaffffa5 b a000ae34 <== NOT EXECUTED =============================================================================== a000afd8 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a000afd8: e59f3040 ldr r3, [pc, #64] ; a000b020 <== NOT EXECUTED /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { a000afdc: e92d4030 push {r4, r5, lr} <== NOT EXECUTED a000afe0: e5932000 ldr r2, [r3] <== NOT EXECUTED a000afe4: e2822001 add r2, r2, #1 <== NOT EXECUTED a000afe8: e5832000 str r2, [r3] <== NOT EXECUTED /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000afec: e59f5030 ldr r5, [pc, #48] ; a000b024 <== NOT EXECUTED a000aff0: e5954008 ldr r4, [r5, #8] <== NOT EXECUTED a000aff4: e595300c ldr r3, [r5, #12] <== NOT EXECUTED a000aff8: e1540003 cmp r4, r3 <== NOT EXECUTED a000affc: 8a000005 bhi a000b018 <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); a000b000: e1a00004 mov r0, r4 <== NOT EXECUTED a000b004: eb000007 bl a000b028 <== NOT EXECUTED /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000b008: e595300c ldr r3, [r5, #12] <== NOT EXECUTED id <= _Rate_monotonic_Information.maximum_id ; id++ ) { a000b00c: e2844001 add r4, r4, #1 <== NOT EXECUTED /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; a000b010: e1530004 cmp r3, r4 <== NOT EXECUTED a000b014: 2afffff9 bcs a000b000 <== NOT EXECUTED /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); } a000b018: e8bd4030 pop {r4, r5, lr} <== NOT EXECUTED } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); a000b01c: ea000ab5 b a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED =============================================================================== a000b028 : */ rtems_status_code rtems_rate_monotonic_reset_statistics( rtems_id id ) { a000b028: e92d4010 push {r4, lr} <== NOT EXECUTED a000b02c: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a000b030: e1a01000 mov r1, r0 <== NOT EXECUTED a000b034: e1a0200d mov r2, sp <== NOT EXECUTED a000b038: e59f005c ldr r0, [pc, #92] ; a000b09c <== NOT EXECUTED a000b03c: eb0007af bl a000cf00 <_Objects_Get> <== NOT EXECUTED Objects_Locations location; Rate_monotonic_Control *the_period; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a000b040: e59d4000 ldr r4, [sp] <== NOT EXECUTED a000b044: e3540000 cmp r4, #0 <== NOT EXECUTED #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000b048: 13a00004 movne r0, #4 <== NOT EXECUTED { Objects_Locations location; Rate_monotonic_Control *the_period; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { a000b04c: 1a000010 bne a000b094 <== NOT EXECUTED case OBJECTS_LOCAL: _Rate_monotonic_Reset_statistics( the_period ); a000b050: e3e03102 mvn r3, #-2147483648 ; 0x80000000 <== NOT EXECUTED a000b054: e5804054 str r4, [r0, #84] ; 0x54 <== NOT EXECUTED a000b058: e5804058 str r4, [r0, #88] ; 0x58 <== NOT EXECUTED a000b05c: e5804064 str r4, [r0, #100] ; 0x64 <== NOT EXECUTED a000b060: e5804068 str r4, [r0, #104] ; 0x68 <== NOT EXECUTED a000b064: e580406c str r4, [r0, #108] ; 0x6c <== NOT EXECUTED a000b068: e5804070 str r4, [r0, #112] ; 0x70 <== NOT EXECUTED a000b06c: e580407c str r4, [r0, #124] ; 0x7c <== NOT EXECUTED a000b070: e5804080 str r4, [r0, #128] ; 0x80 <== NOT EXECUTED a000b074: e5804084 str r4, [r0, #132] ; 0x84 <== NOT EXECUTED a000b078: e5804088 str r4, [r0, #136] ; 0x88 <== NOT EXECUTED a000b07c: e580305c str r3, [r0, #92] ; 0x5c <== NOT EXECUTED a000b080: e5803060 str r3, [r0, #96] ; 0x60 <== NOT EXECUTED a000b084: e5803074 str r3, [r0, #116] ; 0x74 <== NOT EXECUTED a000b088: e5803078 str r3, [r0, #120] ; 0x78 <== NOT EXECUTED _Thread_Enable_dispatch(); a000b08c: eb000a99 bl a000daf8 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000b090: e1a00004 mov r0, r4 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000b094: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000b098: e8bd8010 pop {r4, pc} <== NOT EXECUTED =============================================================================== a0018718 : uintptr_t length, uintptr_t page_size, rtems_attribute attribute_set, rtems_id *id ) { a0018718: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} rtems_status_code return_status; Region_Control *the_region; if ( !rtems_is_name_valid( name ) ) a001871c: e2509000 subs r9, r0, #0 uintptr_t length, uintptr_t page_size, rtems_attribute attribute_set, rtems_id *id ) { a0018720: e24dd004 sub sp, sp, #4 a0018724: e1a05001 mov r5, r1 a0018728: e1a07002 mov r7, r2 a001872c: e1a06003 mov r6, r3 a0018730: e59db02c ldr fp, [sp, #44] ; 0x2c rtems_status_code return_status; Region_Control *the_region; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a0018734: 03a05003 moveq r5, #3 ) { rtems_status_code return_status; Region_Control *the_region; if ( !rtems_is_name_valid( name ) ) a0018738: 0a00001a beq a00187a8 return RTEMS_INVALID_NAME; if ( !starting_address ) a001873c: e3550000 cmp r5, #0 a0018740: 0a000035 beq a001881c return RTEMS_INVALID_ADDRESS; if ( !id ) a0018744: e35b0000 cmp fp, #0 a0018748: 0a000033 beq a001881c return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ a001874c: e59f80d0 ldr r8, [pc, #208] ; a0018824 * This function allocates a region control block from * the inactive chain of free region control blocks. */ RTEMS_INLINE_ROUTINE Region_Control *_Region_Allocate( void ) { return (Region_Control *) _Objects_Allocate( &_Region_Information ); a0018750: e59fa0d0 ldr sl, [pc, #208] ; a0018828 a0018754: e5980000 ldr r0, [r8] a0018758: eb0009a9 bl a001ae04 <_API_Mutex_Lock> a001875c: e1a0000a mov r0, sl a0018760: eb000fde bl a001c6e0 <_Objects_Allocate> the_region = _Region_Allocate(); if ( !the_region ) a0018764: e2504000 subs r4, r0, #0 return_status = RTEMS_TOO_MANY; a0018768: 03a05005 moveq r5, #5 _RTEMS_Lock_allocator(); /* to prevent deletion */ the_region = _Region_Allocate(); if ( !the_region ) a001876c: 0a00000b beq a00187a0 return_status = RTEMS_TOO_MANY; else { the_region->maximum_segment_size = _Heap_Initialize( a0018770: e2840068 add r0, r4, #104 ; 0x68 a0018774: e1a01005 mov r1, r5 a0018778: e1a02007 mov r2, r7 a001877c: e1a03006 mov r3, r6 a0018780: eb000eb1 bl a001c24c <_Heap_Initialize> &the_region->Memory, starting_address, length, page_size ); if ( !the_region->maximum_segment_size ) { a0018784: e3500000 cmp r0, #0 if ( !the_region ) return_status = RTEMS_TOO_MANY; else { the_region->maximum_segment_size = _Heap_Initialize( a0018788: e584005c str r0, [r4, #92] ; 0x5c &the_region->Memory, starting_address, length, page_size ); if ( !the_region->maximum_segment_size ) { a001878c: 1a000008 bne a00187b4 */ RTEMS_INLINE_ROUTINE void _Region_Free ( Region_Control *the_region ) { _Objects_Free( &_Region_Information, &the_region->Object ); a0018790: e1a0000a mov r0, sl <== NOT EXECUTED a0018794: e1a01004 mov r1, r4 <== NOT EXECUTED a0018798: eb0010ac bl a001ca50 <_Objects_Free> <== NOT EXECUTED _Region_Free( the_region ); return_status = RTEMS_INVALID_SIZE; a001879c: e3a05008 mov r5, #8 <== NOT EXECUTED *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; } } _RTEMS_Unlock_allocator(); a00187a0: e5980000 ldr r0, [r8] a00187a4: eb0009b2 bl a001ae74 <_API_Mutex_Unlock> return return_status; } a00187a8: e1a00005 mov r0, r5 a00187ac: e28dd004 add sp, sp, #4 a00187b0: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} the_region->length = length; the_region->page_size = page_size; the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; _Thread_queue_Initialize( a00187b4: e59d3028 ldr r3, [sp, #40] ; 0x28 the_region->starting_address = starting_address; the_region->length = length; the_region->page_size = page_size; the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; a00187b8: e3a0c000 mov ip, #0 return_status = RTEMS_INVALID_SIZE; } else { the_region->starting_address = starting_address; a00187bc: e5845050 str r5, [r4, #80] ; 0x50 the_region->length = length; the_region->page_size = page_size; the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; _Thread_queue_Initialize( a00187c0: e3130004 tst r3, #4 else { the_region->starting_address = starting_address; the_region->length = length; the_region->page_size = page_size; the_region->attribute_set = attribute_set; a00187c4: e5843060 str r3, [r4, #96] ; 0x60 the_region->number_of_used_blocks = 0; a00187c8: e584c064 str ip, [r4, #100] ; 0x64 } else { the_region->starting_address = starting_address; the_region->length = length; a00187cc: e5847054 str r7, [r4, #84] ; 0x54 the_region->page_size = page_size; a00187d0: e5846058 str r6, [r4, #88] ; 0x58 the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; _Thread_queue_Initialize( a00187d4: e2840010 add r0, r4, #16 a00187d8: 03a01000 moveq r1, #0 a00187dc: 13a01001 movne r1, #1 a00187e0: e3a02040 mov r2, #64 ; 0x40 a00187e4: e3a03006 mov r3, #6 a00187e8: e58dc000 str ip, [sp] a00187ec: eb0015d3 bl a001df40 <_Thread_queue_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a00187f0: e5943008 ldr r3, [r4, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a00187f4: e59a201c ldr r2, [sl, #28] &the_region->Object, (Objects_Name) name ); *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; a00187f8: e59dc000 ldr ip, [sp] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a00187fc: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0018800: e7824721 str r4, [r2, r1, lsr #14] } } _RTEMS_Unlock_allocator(); a0018804: e5980000 ldr r0, [r8] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a0018808: e584900c str r9, [r4, #12] &_Region_Information, &the_region->Object, (Objects_Name) name ); *id = the_region->Object.id; a001880c: e58b3000 str r3, [fp] return_status = RTEMS_SUCCESSFUL; a0018810: e1a0500c mov r5, ip } } _RTEMS_Unlock_allocator(); a0018814: eb000996 bl a001ae74 <_API_Mutex_Unlock> a0018818: eaffffe2 b a00187a8 if ( !starting_address ) return RTEMS_INVALID_ADDRESS; if ( !id ) return RTEMS_INVALID_ADDRESS; a001881c: e3a05009 mov r5, #9 <== NOT EXECUTED a0018820: eaffffe0 b a00187a8 <== NOT EXECUTED =============================================================================== a00188b0 : rtems_status_code rtems_region_extend( rtems_id id, void *starting_address, uintptr_t length ) { a00188b0: e92d41f0 push {r4, r5, r6, r7, r8, lr} <== NOT EXECUTED bool extend_ok; Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; if ( !starting_address ) a00188b4: e2518000 subs r8, r1, #0 <== NOT EXECUTED rtems_status_code rtems_region_extend( rtems_id id, void *starting_address, uintptr_t length ) { a00188b8: e1a05000 mov r5, r0 <== NOT EXECUTED a00188bc: e24dd008 sub sp, sp, #8 <== NOT EXECUTED a00188c0: e1a07002 mov r7, r2 <== NOT EXECUTED Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; if ( !starting_address ) return RTEMS_INVALID_ADDRESS; a00188c4: 03a05009 moveq r5, #9 <== NOT EXECUTED bool extend_ok; Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; if ( !starting_address ) a00188c8: 0a00000d beq a0018904 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ a00188cc: e59f407c ldr r4, [pc, #124] ; a0018950 <== NOT EXECUTED a00188d0: e5940000 ldr r0, [r4] <== NOT EXECUTED a00188d4: eb00094a bl a001ae04 <_API_Mutex_Lock> <== NOT EXECUTED Objects_Id id, Objects_Locations *location ) { return (Region_Control *) _Objects_Get_no_protection( &_Region_Information, id, location ); a00188d8: e1a01005 mov r1, r5 <== NOT EXECUTED a00188dc: e59f0070 ldr r0, [pc, #112] ; a0018954 <== NOT EXECUTED a00188e0: e1a0200d mov r2, sp <== NOT EXECUTED a00188e4: eb0010b2 bl a001cbb4 <_Objects_Get_no_protection> <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { a00188e8: e59d5000 ldr r5, [sp] <== NOT EXECUTED a00188ec: e1a06000 mov r6, r0 <== NOT EXECUTED a00188f0: e3550000 cmp r5, #0 <== NOT EXECUTED break; #endif case OBJECTS_ERROR: default: return_status = RTEMS_INVALID_ID; a00188f4: 13a05004 movne r5, #4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ the_region = _Region_Get( id, &location ); switch ( location ) { a00188f8: 0a000004 beq a0018910 <== NOT EXECUTED default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a00188fc: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018900: eb00095b bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; } a0018904: e1a00005 mov r0, r5 <== NOT EXECUTED a0018908: e28dd008 add sp, sp, #8 <== NOT EXECUTED a001890c: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: extend_ok = _Heap_Extend( a0018910: e2800068 add r0, r0, #104 ; 0x68 <== NOT EXECUTED a0018914: e1a01008 mov r1, r8 <== NOT EXECUTED a0018918: e1a02007 mov r2, r7 <== NOT EXECUTED a001891c: e28d3004 add r3, sp, #4 <== NOT EXECUTED a0018920: eb000c88 bl a001bb48 <_Heap_Extend> <== NOT EXECUTED starting_address, length, &amount_extended ); if ( extend_ok ) { a0018924: e3500000 cmp r0, #0 <== NOT EXECUTED the_region->length += amount_extended; the_region->maximum_segment_size += amount_extended; return_status = RTEMS_SUCCESSFUL; } else { return_status = RTEMS_INVALID_ADDRESS; a0018928: 03a05009 moveq r5, #9 <== NOT EXECUTED starting_address, length, &amount_extended ); if ( extend_ok ) { a001892c: 0afffff2 beq a00188fc <== NOT EXECUTED the_region->length += amount_extended; a0018930: e59d3004 ldr r3, [sp, #4] <== NOT EXECUTED a0018934: e5962054 ldr r2, [r6, #84] ; 0x54 <== NOT EXECUTED the_region->maximum_segment_size += amount_extended; a0018938: e596105c ldr r1, [r6, #92] ; 0x5c <== NOT EXECUTED length, &amount_extended ); if ( extend_ok ) { the_region->length += amount_extended; a001893c: e0822003 add r2, r2, r3 <== NOT EXECUTED the_region->maximum_segment_size += amount_extended; a0018940: e0813003 add r3, r1, r3 <== NOT EXECUTED length, &amount_extended ); if ( extend_ok ) { the_region->length += amount_extended; a0018944: e5862054 str r2, [r6, #84] ; 0x54 <== NOT EXECUTED the_region->maximum_segment_size += amount_extended; a0018948: e586305c str r3, [r6, #92] ; 0x5c <== NOT EXECUTED a001894c: eaffffea b a00188fc <== NOT EXECUTED =============================================================================== a0018958 : rtems_status_code rtems_region_get_free_information( rtems_id id, Heap_Information_block *the_info ) { a0018958: e92d4070 push {r4, r5, r6, lr} <== NOT EXECUTED Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) a001895c: e2515000 subs r5, r1, #0 <== NOT EXECUTED rtems_status_code rtems_region_get_free_information( rtems_id id, Heap_Information_block *the_info ) { a0018960: e1a06000 mov r6, r0 <== NOT EXECUTED a0018964: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) return RTEMS_INVALID_ADDRESS; a0018968: 03a06009 moveq r6, #9 <== NOT EXECUTED { Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) a001896c: 0a00000c beq a00189a4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); a0018970: e59f4054 ldr r4, [pc, #84] ; a00189cc <== NOT EXECUTED a0018974: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018978: eb000921 bl a001ae04 <_API_Mutex_Lock> <== NOT EXECUTED a001897c: e1a01006 mov r1, r6 <== NOT EXECUTED a0018980: e59f0048 ldr r0, [pc, #72] ; a00189d0 <== NOT EXECUTED a0018984: e1a0200d mov r2, sp <== NOT EXECUTED a0018988: eb001089 bl a001cbb4 <_Objects_Get_no_protection> <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { a001898c: e59d6000 ldr r6, [sp] <== NOT EXECUTED a0018990: e3560000 cmp r6, #0 <== NOT EXECUTED break; #endif case OBJECTS_ERROR: default: return_status = RTEMS_INVALID_ID; a0018994: 13a06004 movne r6, #4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); the_region = _Region_Get( id, &location ); switch ( location ) { a0018998: 0a000004 beq a00189b0 <== NOT EXECUTED default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a001899c: e5940000 ldr r0, [r4] <== NOT EXECUTED a00189a0: eb000933 bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; } a00189a4: e1a00006 mov r0, r6 <== NOT EXECUTED a00189a8: e28dd004 add sp, sp, #4 <== NOT EXECUTED a00189ac: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: the_info->Used.number = 0; a00189b0: e585600c str r6, [r5, #12] <== NOT EXECUTED the_info->Used.total = 0; a00189b4: e5856014 str r6, [r5, #20] <== NOT EXECUTED the_info->Used.largest = 0; a00189b8: e5856010 str r6, [r5, #16] <== NOT EXECUTED _Heap_Get_free_information( &the_region->Memory, &the_info->Free ); a00189bc: e2800068 add r0, r0, #104 ; 0x68 <== NOT EXECUTED a00189c0: e1a01005 mov r1, r5 <== NOT EXECUTED a00189c4: eb000d7c bl a001bfbc <_Heap_Get_free_information> <== NOT EXECUTED return_status = RTEMS_SUCCESSFUL; break; a00189c8: eafffff3 b a001899c <== NOT EXECUTED =============================================================================== a00189d4 : rtems_status_code rtems_region_get_information( rtems_id id, Heap_Information_block *the_info ) { a00189d4: e92d4070 push {r4, r5, r6, lr} <== NOT EXECUTED Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) a00189d8: e2515000 subs r5, r1, #0 <== NOT EXECUTED rtems_status_code rtems_region_get_information( rtems_id id, Heap_Information_block *the_info ) { a00189dc: e1a06000 mov r6, r0 <== NOT EXECUTED a00189e0: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) return RTEMS_INVALID_ADDRESS; a00189e4: 03a06009 moveq r6, #9 <== NOT EXECUTED { Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) a00189e8: 0a00000c beq a0018a20 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); a00189ec: e59f4048 ldr r4, [pc, #72] ; a0018a3c <== NOT EXECUTED a00189f0: e5940000 ldr r0, [r4] <== NOT EXECUTED a00189f4: eb000902 bl a001ae04 <_API_Mutex_Lock> <== NOT EXECUTED a00189f8: e1a01006 mov r1, r6 <== NOT EXECUTED a00189fc: e59f003c ldr r0, [pc, #60] ; a0018a40 <== NOT EXECUTED a0018a00: e1a0200d mov r2, sp <== NOT EXECUTED a0018a04: eb00106a bl a001cbb4 <_Objects_Get_no_protection> <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { a0018a08: e59d6000 ldr r6, [sp] <== NOT EXECUTED a0018a0c: e3560000 cmp r6, #0 <== NOT EXECUTED break; #endif case OBJECTS_ERROR: default: return_status = RTEMS_INVALID_ID; a0018a10: 13a06004 movne r6, #4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); the_region = _Region_Get( id, &location ); switch ( location ) { a0018a14: 0a000004 beq a0018a2c <== NOT EXECUTED default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a0018a18: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018a1c: eb000914 bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; } a0018a20: e1a00006 mov r0, r6 <== NOT EXECUTED a0018a24: e28dd004 add sp, sp, #4 <== NOT EXECUTED a0018a28: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: _Heap_Get_information( &the_region->Memory, the_info ); a0018a2c: e2800068 add r0, r0, #104 ; 0x68 <== NOT EXECUTED a0018a30: e1a01005 mov r1, r5 <== NOT EXECUTED a0018a34: eb000d7a bl a001c024 <_Heap_Get_information> <== NOT EXECUTED return_status = RTEMS_SUCCESSFUL; break; a0018a38: eafffff6 b a0018a18 <== NOT EXECUTED =============================================================================== a0018b88 : rtems_status_code rtems_region_get_segment_size( rtems_id id, void *segment, uintptr_t *size ) { a0018b88: e92d40f0 push {r4, r5, r6, r7, lr} Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; register Region_Control *the_region; if ( !segment ) a0018b8c: e2516000 subs r6, r1, #0 rtems_status_code rtems_region_get_segment_size( rtems_id id, void *segment, uintptr_t *size ) { a0018b90: e24dd004 sub sp, sp, #4 a0018b94: e1a07000 mov r7, r0 a0018b98: e1a05002 mov r5, r2 Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; register Region_Control *the_region; if ( !segment ) a0018b9c: 0a00001b beq a0018c10 return RTEMS_INVALID_ADDRESS; if ( !size ) a0018ba0: e3520000 cmp r2, #0 a0018ba4: 0a000019 beq a0018c10 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); a0018ba8: e59f4068 ldr r4, [pc, #104] ; a0018c18 a0018bac: e5940000 ldr r0, [r4] a0018bb0: eb000893 bl a001ae04 <_API_Mutex_Lock> a0018bb4: e59f0060 ldr r0, [pc, #96] ; a0018c1c a0018bb8: e1a01007 mov r1, r7 a0018bbc: e1a0200d mov r2, sp a0018bc0: eb000ffb bl a001cbb4 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { a0018bc4: e59d3000 ldr r3, [sp] a0018bc8: e3530000 cmp r3, #0 a0018bcc: 0a000007 beq a0018bf0 void *segment, uintptr_t *size ) { Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; a0018bd0: e3530001 cmp r3, #1 <== NOT EXECUTED a0018bd4: 03a05004 moveq r5, #4 <== NOT EXECUTED a0018bd8: 13a05000 movne r5, #0 <== NOT EXECUTED case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a0018bdc: e5940000 ldr r0, [r4] a0018be0: eb0008a3 bl a001ae74 <_API_Mutex_Unlock> return return_status; } a0018be4: e1a00005 mov r0, r5 a0018be8: e28dd004 add sp, sp, #4 a0018bec: e8bd80f0 pop {r4, r5, r6, r7, pc} the_region = _Region_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) ) a0018bf0: e1a02005 mov r2, r5 a0018bf4: e2800068 add r0, r0, #104 ; 0x68 a0018bf8: e1a01006 mov r1, r6 a0018bfc: eb000e7d bl a001c5f8 <_Heap_Size_of_alloc_area> void *segment, uintptr_t *size ) { Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; a0018c00: e3500000 cmp r0, #0 a0018c04: 03a05009 moveq r5, #9 a0018c08: 13a05000 movne r5, #0 a0018c0c: eafffff2 b a0018bdc if ( !segment ) return RTEMS_INVALID_ADDRESS; if ( !size ) return RTEMS_INVALID_ADDRESS; a0018c10: e3a05009 mov r5, #9 <== NOT EXECUTED a0018c14: eafffff2 b a0018be4 <== NOT EXECUTED =============================================================================== a0018c50 : rtems_id id, void *segment, uintptr_t size, uintptr_t *old_size ) { a0018c50: e92d41f0 push {r4, r5, r6, r7, r8, lr} <== NOT EXECUTED uintptr_t osize; rtems_status_code return_status; Heap_Resize_status status; register Region_Control *the_region; if ( !old_size ) a0018c54: e2535000 subs r5, r3, #0 <== NOT EXECUTED rtems_id id, void *segment, uintptr_t size, uintptr_t *old_size ) { a0018c58: e1a08000 mov r8, r0 <== NOT EXECUTED a0018c5c: e24dd010 sub sp, sp, #16 <== NOT EXECUTED a0018c60: e1a07001 mov r7, r1 <== NOT EXECUTED a0018c64: e1a06002 mov r6, r2 <== NOT EXECUTED rtems_status_code return_status; Heap_Resize_status status; register Region_Control *the_region; if ( !old_size ) return RTEMS_INVALID_ADDRESS; a0018c68: 03a00009 moveq r0, #9 <== NOT EXECUTED uintptr_t osize; rtems_status_code return_status; Heap_Resize_status status; register Region_Control *the_region; if ( !old_size ) a0018c6c: 0a00000d beq a0018ca8 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); a0018c70: e59f408c ldr r4, [pc, #140] ; a0018d04 <== NOT EXECUTED a0018c74: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018c78: eb000861 bl a001ae04 <_API_Mutex_Lock> <== NOT EXECUTED a0018c7c: e1a01008 mov r1, r8 <== NOT EXECUTED a0018c80: e59f0080 ldr r0, [pc, #128] ; a0018d08 <== NOT EXECUTED a0018c84: e28d2008 add r2, sp, #8 <== NOT EXECUTED a0018c88: eb000fc9 bl a001cbb4 <_Objects_Get_no_protection> <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { a0018c8c: e59d3008 ldr r3, [sp, #8] <== NOT EXECUTED a0018c90: e1a08000 mov r8, r0 <== NOT EXECUTED a0018c94: e3530000 cmp r3, #0 <== NOT EXECUTED a0018c98: 0a000004 beq a0018cb0 <== NOT EXECUTED default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a0018c9c: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018ca0: eb000873 bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; a0018ca4: e3a00004 mov r0, #4 <== NOT EXECUTED } a0018ca8: e28dd010 add sp, sp, #16 <== NOT EXECUTED a0018cac: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} <== NOT EXECUTED case OBJECTS_LOCAL: _Region_Debug_Walk( the_region, 7 ); status = _Heap_Resize_block( a0018cb0: e28d300c add r3, sp, #12 <== NOT EXECUTED a0018cb4: e58d3000 str r3, [sp] <== NOT EXECUTED a0018cb8: e1a02006 mov r2, r6 <== NOT EXECUTED a0018cbc: e28d3004 add r3, sp, #4 <== NOT EXECUTED a0018cc0: e2800068 add r0, r0, #104 ; 0x68 <== NOT EXECUTED a0018cc4: e1a01007 mov r1, r7 <== NOT EXECUTED a0018cc8: eb000dfa bl a001c4b8 <_Heap_Resize_block> <== NOT EXECUTED segment, (uint32_t) size, &osize, &avail_size ); *old_size = (uint32_t) osize; a0018ccc: e59d3004 ldr r3, [sp, #4] <== NOT EXECUTED _Region_Debug_Walk( the_region, 8 ); if ( status == HEAP_RESIZE_SUCCESSFUL ) a0018cd0: e2506000 subs r6, r0, #0 <== NOT EXECUTED segment, (uint32_t) size, &osize, &avail_size ); *old_size = (uint32_t) osize; a0018cd4: e5853000 str r3, [r5] <== NOT EXECUTED _Region_Debug_Walk( the_region, 8 ); if ( status == HEAP_RESIZE_SUCCESSFUL ) a0018cd8: 1a000003 bne a0018cec <== NOT EXECUTED _Region_Process_queue( the_region ); /* unlocks allocator */ a0018cdc: e1a00008 mov r0, r8 <== NOT EXECUTED a0018ce0: eb001f24 bl a0020978 <_Region_Process_queue> <== NOT EXECUTED else _RTEMS_Unlock_allocator(); if (status == HEAP_RESIZE_SUCCESSFUL) return RTEMS_SUCCESSFUL; a0018ce4: e1a00006 mov r0, r6 <== NOT EXECUTED a0018ce8: eaffffee b a0018ca8 <== NOT EXECUTED _Region_Debug_Walk( the_region, 8 ); if ( status == HEAP_RESIZE_SUCCESSFUL ) _Region_Process_queue( the_region ); /* unlocks allocator */ else _RTEMS_Unlock_allocator(); a0018cec: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018cf0: eb00085f bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED if (status == HEAP_RESIZE_SUCCESSFUL) return RTEMS_SUCCESSFUL; if (status == HEAP_RESIZE_UNSATISFIED) return RTEMS_UNSATISFIED; a0018cf4: e3560001 cmp r6, #1 <== NOT EXECUTED a0018cf8: 13a00009 movne r0, #9 <== NOT EXECUTED a0018cfc: 03a0000d moveq r0, #13 <== NOT EXECUTED a0018d00: eaffffe8 b a0018ca8 <== NOT EXECUTED =============================================================================== a0018d0c : rtems_status_code rtems_region_return_segment( rtems_id id, void *segment ) { a0018d0c: e92d40f0 push {r4, r5, r6, r7, lr} uint32_t size; #endif int status; register Region_Control *the_region; _RTEMS_Lock_allocator(); a0018d10: e59f4078 ldr r4, [pc, #120] ; a0018d90 rtems_status_code rtems_region_return_segment( rtems_id id, void *segment ) { a0018d14: e24dd004 sub sp, sp, #4 a0018d18: e1a06000 mov r6, r0 uint32_t size; #endif int status; register Region_Control *the_region; _RTEMS_Lock_allocator(); a0018d1c: e5940000 ldr r0, [r4] rtems_status_code rtems_region_return_segment( rtems_id id, void *segment ) { a0018d20: e1a05001 mov r5, r1 uint32_t size; #endif int status; register Region_Control *the_region; _RTEMS_Lock_allocator(); a0018d24: eb000836 bl a001ae04 <_API_Mutex_Lock> a0018d28: e1a01006 mov r1, r6 a0018d2c: e59f0060 ldr r0, [pc, #96] ; a0018d94 a0018d30: e1a0200d mov r2, sp a0018d34: eb000f9e bl a001cbb4 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { a0018d38: e59d6000 ldr r6, [sp] a0018d3c: e1a07000 mov r7, r0 a0018d40: e3560000 cmp r6, #0 break; #endif case OBJECTS_ERROR: default: return_status = RTEMS_INVALID_ID; a0018d44: 13a06004 movne r6, #4 register Region_Control *the_region; _RTEMS_Lock_allocator(); the_region = _Region_Get( id, &location ); switch ( location ) { a0018d48: 1a000005 bne a0018d64 RTEMS_INLINE_ROUTINE bool _Region_Free_segment ( Region_Control *the_region, void *the_segment ) { return _Heap_Free( &the_region->Memory, the_segment ); a0018d4c: e2800068 add r0, r0, #104 ; 0x68 a0018d50: e1a01005 mov r1, r5 a0018d54: eb000c28 bl a001bdfc <_Heap_Free> #endif status = _Region_Free_segment( the_region, segment ); _Region_Debug_Walk( the_region, 4 ); if ( !status ) a0018d58: e3500000 cmp r0, #0 return_status = RTEMS_INVALID_ADDRESS; a0018d5c: 03a06009 moveq r6, #9 #endif status = _Region_Free_segment( the_region, segment ); _Region_Debug_Walk( the_region, 4 ); if ( !status ) a0018d60: 1a000004 bne a0018d78 default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); a0018d64: e5940000 ldr r0, [r4] <== NOT EXECUTED a0018d68: eb000841 bl a001ae74 <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; } a0018d6c: e1a00006 mov r0, r6 a0018d70: e28dd004 add sp, sp, #4 a0018d74: e8bd80f0 pop {r4, r5, r6, r7, pc} _Region_Debug_Walk( the_region, 4 ); if ( !status ) return_status = RTEMS_INVALID_ADDRESS; else { the_region->number_of_used_blocks -= 1; a0018d78: e5973064 ldr r3, [r7, #100] ; 0x64 _Region_Process_queue(the_region); /* unlocks allocator */ a0018d7c: e1a00007 mov r0, r7 _Region_Debug_Walk( the_region, 4 ); if ( !status ) return_status = RTEMS_INVALID_ADDRESS; else { the_region->number_of_used_blocks -= 1; a0018d80: e2433001 sub r3, r3, #1 a0018d84: e5873064 str r3, [r7, #100] ; 0x64 _Region_Process_queue(the_region); /* unlocks allocator */ a0018d88: eb001efa bl a0020978 <_Region_Process_queue> return RTEMS_SUCCESSFUL; a0018d8c: eafffff6 b a0018d6c =============================================================================== a0009850 : uint32_t count, rtems_attribute attribute_set, rtems_task_priority priority_ceiling, rtems_id *id ) { a0009850: e92d41f0 push {r4, r5, r6, r7, r8, lr} register Semaphore_Control *the_semaphore; CORE_mutex_Attributes the_mutex_attr; CORE_semaphore_Attributes the_semaphore_attr; CORE_mutex_Status mutex_status; if ( !rtems_is_name_valid( name ) ) a0009854: e2505000 subs r5, r0, #0 uint32_t count, rtems_attribute attribute_set, rtems_task_priority priority_ceiling, rtems_id *id ) { a0009858: e24dd020 sub sp, sp, #32 a000985c: e1a04001 mov r4, r1 a0009860: e59d6038 ldr r6, [sp, #56] ; 0x38 CORE_mutex_Attributes the_mutex_attr; CORE_semaphore_Attributes the_semaphore_attr; CORE_mutex_Status mutex_status; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a0009864: 03a00003 moveq r0, #3 register Semaphore_Control *the_semaphore; CORE_mutex_Attributes the_mutex_attr; CORE_semaphore_Attributes the_semaphore_attr; CORE_mutex_Status mutex_status; if ( !rtems_is_name_valid( name ) ) a0009868: 0a000008 beq a0009890 return RTEMS_INVALID_NAME; if ( !id ) a000986c: e3560000 cmp r6, #0 return RTEMS_INVALID_ADDRESS; a0009870: 03a00009 moveq r0, #9 CORE_mutex_Status mutex_status; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) a0009874: 0a000005 beq a0009890 return RTEMS_NOT_DEFINED; } else #endif if ( _Attributes_Is_inherit_priority( attribute_set ) || a0009878: e21210c0 ands r1, r2, #192 ; 0xc0 a000987c: 0a000037 beq a0009960 */ RTEMS_INLINE_ROUTINE bool _Attributes_Is_binary_semaphore( rtems_attribute attribute_set ) { return ((attribute_set & RTEMS_SEMAPHORE_CLASS) == RTEMS_BINARY_SEMAPHORE); a0009880: e2028030 and r8, r2, #48 ; 0x30 _Attributes_Is_priority_ceiling( attribute_set ) ) { if ( ! (_Attributes_Is_binary_semaphore( attribute_set ) && a0009884: e3580010 cmp r8, #16 a0009888: 0a000002 beq a0009898 } if ( _Attributes_Is_inherit_priority( attribute_set ) && _Attributes_Is_priority_ceiling( attribute_set ) ) return RTEMS_NOT_DEFINED; a000988c: e3a0000b mov r0, #11 <== NOT EXECUTED 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a0009890: e28dd020 add sp, sp, #32 a0009894: e8bd81f0 pop {r4, r5, r6, r7, r8, pc} #endif if ( _Attributes_Is_inherit_priority( attribute_set ) || _Attributes_Is_priority_ceiling( attribute_set ) ) { if ( ! (_Attributes_Is_binary_semaphore( attribute_set ) && a0009898: e3120004 tst r2, #4 a000989c: 0afffffa beq a000988c _Attributes_Is_priority( attribute_set ) ) ) return RTEMS_NOT_DEFINED; } if ( _Attributes_Is_inherit_priority( attribute_set ) && a00098a0: e35100c0 cmp r1, #192 ; 0xc0 a00098a4: 0afffff8 beq a000988c _Attributes_Is_priority_ceiling( attribute_set ) ) return RTEMS_NOT_DEFINED; if ( !_Attributes_Is_counting_semaphore( attribute_set ) && ( count > 1 ) ) a00098a8: e3540001 cmp r4, #1 return RTEMS_INVALID_NUMBER; a00098ac: 83a0000a movhi r0, #10 if ( _Attributes_Is_inherit_priority( attribute_set ) && _Attributes_Is_priority_ceiling( attribute_set ) ) return RTEMS_NOT_DEFINED; if ( !_Attributes_Is_counting_semaphore( attribute_set ) && ( count > 1 ) ) a00098b0: 8afffff6 bhi a0009890 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; a00098b4: e59f1150 ldr r1, [pc, #336] ; a0009a0c a00098b8: e5910000 ldr r0, [r1] a00098bc: e2800001 add r0, r0, #1 a00098c0: e5810000 str r0, [r1] * This function allocates a semaphore control block from * the inactive chain of free semaphore control blocks. */ RTEMS_INLINE_ROUTINE Semaphore_Control *_Semaphore_Allocate( void ) { return (Semaphore_Control *) _Objects_Allocate( &_Semaphore_Information ); a00098c4: e59f0144 ldr r0, [pc, #324] ; a0009a10 a00098c8: e58d2004 str r2, [sp, #4] a00098cc: e58d3000 str r3, [sp] a00098d0: eb00054a bl a000ae00 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_semaphore = _Semaphore_Allocate(); if ( !the_semaphore ) { a00098d4: e2507000 subs r7, r0, #0 a00098d8: e59d2004 ldr r2, [sp, #4] a00098dc: e59d3000 ldr r3, [sp] a00098e0: 0a00002f beq a00099a4 the_semaphore->attribute_set = attribute_set; /* * Initialize it as a counting semaphore. */ if ( _Attributes_Is_counting_semaphore( attribute_set ) ) { a00098e4: e3580000 cmp r8, #0 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_semaphore->attribute_set = attribute_set; a00098e8: e5872010 str r2, [r7, #16] /* * Initialize it as a counting semaphore. */ if ( _Attributes_Is_counting_semaphore( attribute_set ) ) { a00098ec: 0a00001e beq a000996c } else { /* * It is either simple binary semaphore or a more powerful mutex * style binary semaphore. This is the mutex style. */ if ( _Attributes_Is_priority( attribute_set ) ) a00098f0: e2121004 ands r1, r2, #4 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY; a00098f4: 13a01001 movne r1, #1 a00098f8: 158d1010 strne r1, [sp, #16] else the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_FIFO; a00098fc: 058d1010 streq r1, [sp, #16] if ( _Attributes_Is_binary_semaphore( attribute_set ) ) { a0009900: e3580010 cmp r8, #16 a0009904: 0a000029 beq a00099b0 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING; the_mutex_attr.only_owner_release = true; } } } else /* must be simple binary semaphore */ { the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_BLOCKS; a0009908: e3a03002 mov r3, #2 a000990c: e58d3008 str r3, [sp, #8] the_mutex_attr.only_owner_release = false; a0009910: e3a03000 mov r3, #0 a0009914: e5cd300c strb r3, [sp, #12] } mutex_status = _CORE_mutex_Initialize( a0009918: e3540001 cmp r4, #1 a000991c: 13a02000 movne r2, #0 a0009920: 03a02001 moveq r2, #1 a0009924: e2870014 add r0, r7, #20 a0009928: e28d1008 add r1, sp, #8 a000992c: eb0002e1 bl a000a4b8 <_CORE_mutex_Initialize> &the_semaphore->Core_control.mutex, &the_mutex_attr, (count == 1) ? CORE_MUTEX_UNLOCKED : CORE_MUTEX_LOCKED ); if ( mutex_status == CORE_MUTEX_STATUS_CEILING_VIOLATED ) { a0009930: e3500006 cmp r0, #6 a0009934: 0a00002e beq a00099f4 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0009938: e59f20d0 ldr r2, [pc, #208] ; a0009a10 Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a000993c: e5973008 ldr r3, [r7, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0009940: e592201c ldr r2, [r2, #28] Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a0009944: e1a01803 lsl r1, r3, #16 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a0009948: e7827721 str r7, [r2, r1, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a000994c: e587500c str r5, [r7, #12] &_Semaphore_Information, &the_semaphore->Object, (Objects_Name) name ); *id = the_semaphore->Object.id; a0009950: e5863000 str r3, [r6] the_semaphore->Object.id, name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); a0009954: eb00095c bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0009958: e3a00000 mov r0, #0 a000995c: eaffffcb b a0009890 if ( _Attributes_Is_inherit_priority( attribute_set ) && _Attributes_Is_priority_ceiling( attribute_set ) ) return RTEMS_NOT_DEFINED; if ( !_Attributes_Is_counting_semaphore( attribute_set ) && ( count > 1 ) ) a0009960: e2128030 ands r8, r2, #48 ; 0x30 a0009964: 1affffcf bne a00098a8 a0009968: eaffffd1 b a00098b4 /* * This effectively disables limit checking. */ the_semaphore_attr.maximum_count = 0xFFFFFFFF; if ( _Attributes_Is_priority( attribute_set ) ) a000996c: e3120004 tst r2, #4 */ if ( _Attributes_Is_counting_semaphore( attribute_set ) ) { /* * This effectively disables limit checking. */ the_semaphore_attr.maximum_count = 0xFFFFFFFF; a0009970: e3e03000 mvn r3, #0 a0009974: e58d3018 str r3, [sp, #24] if ( _Attributes_Is_priority( attribute_set ) ) the_semaphore_attr.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY; a0009978: 13a03001 movne r3, #1 a000997c: 158d301c strne r3, [sp, #28] * The following are just to make Purify happy. */ the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; the_mutex_attr.priority_ceiling = PRIORITY_MINIMUM; _CORE_semaphore_Initialize( a0009980: e2870014 add r0, r7, #20 the_semaphore_attr.discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; /* * The following are just to make Purify happy. */ the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; a0009984: e3a03000 mov r3, #0 the_mutex_attr.priority_ceiling = PRIORITY_MINIMUM; _CORE_semaphore_Initialize( a0009988: e28d1018 add r1, sp, #24 a000998c: e1a02004 mov r2, r4 the_semaphore_attr.maximum_count = 0xFFFFFFFF; if ( _Attributes_Is_priority( attribute_set ) ) the_semaphore_attr.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY; else the_semaphore_attr.discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; a0009990: 058d801c streq r8, [sp, #28] /* * The following are just to make Purify happy. */ the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; a0009994: e58d3008 str r3, [sp, #8] the_mutex_attr.priority_ceiling = PRIORITY_MINIMUM; a0009998: e58d3014 str r3, [sp, #20] _CORE_semaphore_Initialize( a000999c: eb000394 bl a000a7f4 <_CORE_semaphore_Initialize> a00099a0: eaffffe4 b a0009938 _Thread_Disable_dispatch(); /* prevents deletion */ the_semaphore = _Semaphore_Allocate(); if ( !the_semaphore ) { _Thread_Enable_dispatch(); a00099a4: eb000948 bl a000becc <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; a00099a8: e3a00005 mov r0, #5 a00099ac: eaffffb7 b a0009890 if ( _Attributes_Is_binary_semaphore( attribute_set ) ) { the_mutex_attr.priority_ceiling = priority_ceiling; the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; the_mutex_attr.only_owner_release = false; if ( the_mutex_attr.discipline == CORE_MUTEX_DISCIPLINES_PRIORITY ) { a00099b0: e59d0010 ldr r0, [sp, #16] else the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_FIFO; if ( _Attributes_Is_binary_semaphore( attribute_set ) ) { the_mutex_attr.priority_ceiling = priority_ceiling; the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; a00099b4: e3a01000 mov r1, #0 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY; else the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_FIFO; if ( _Attributes_Is_binary_semaphore( attribute_set ) ) { the_mutex_attr.priority_ceiling = priority_ceiling; a00099b8: e58d3014 str r3, [sp, #20] the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; the_mutex_attr.only_owner_release = false; if ( the_mutex_attr.discipline == CORE_MUTEX_DISCIPLINES_PRIORITY ) { a00099bc: e3500001 cmp r0, #1 else the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_FIFO; if ( _Attributes_Is_binary_semaphore( attribute_set ) ) { the_mutex_attr.priority_ceiling = priority_ceiling; the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; a00099c0: e58d1008 str r1, [sp, #8] the_mutex_attr.only_owner_release = false; a00099c4: e5cd100c strb r1, [sp, #12] if ( the_mutex_attr.discipline == CORE_MUTEX_DISCIPLINES_PRIORITY ) { a00099c8: 1affffd2 bne a0009918 if ( _Attributes_Is_inherit_priority( attribute_set ) ) { a00099cc: e3120040 tst r2, #64 ; 0x40 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT; a00099d0: 13a03002 movne r3, #2 a00099d4: 158d3010 strne r3, [sp, #16] the_mutex_attr.only_owner_release = true; a00099d8: 15cd000c strbne r0, [sp, #12] the_mutex_attr.priority_ceiling = priority_ceiling; the_mutex_attr.lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; the_mutex_attr.only_owner_release = false; if ( the_mutex_attr.discipline == CORE_MUTEX_DISCIPLINES_PRIORITY ) { if ( _Attributes_Is_inherit_priority( attribute_set ) ) { a00099dc: 1affffcd bne a0009918 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT; the_mutex_attr.only_owner_release = true; } else if ( _Attributes_Is_priority_ceiling( attribute_set ) ) { a00099e0: e3120080 tst r2, #128 ; 0x80 the_mutex_attr.discipline = CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING; a00099e4: 13a03003 movne r3, #3 a00099e8: 158d3010 strne r3, [sp, #16] the_mutex_attr.only_owner_release = true; a00099ec: 15cd000c strbne r0, [sp, #12] a00099f0: eaffffc8 b a0009918 */ RTEMS_INLINE_ROUTINE void _Semaphore_Free ( Semaphore_Control *the_semaphore ) { _Objects_Free( &_Semaphore_Information, &the_semaphore->Object ); a00099f4: e59f0014 ldr r0, [pc, #20] ; a0009a10 a00099f8: e1a01007 mov r1, r7 a00099fc: eb0005db bl a000b170 <_Objects_Free> (count == 1) ? CORE_MUTEX_UNLOCKED : CORE_MUTEX_LOCKED ); if ( mutex_status == CORE_MUTEX_STATUS_CEILING_VIOLATED ) { _Semaphore_Free( the_semaphore ); _Thread_Enable_dispatch(); a0009a00: eb000931 bl a000becc <_Thread_Enable_dispatch> return RTEMS_INVALID_PRIORITY; a0009a04: e3a00013 mov r0, #19 a0009a08: eaffffa0 b a0009890 =============================================================================== a0009a14 : #endif rtems_status_code rtems_semaphore_delete( rtems_id id ) { a0009a14: e92d4010 push {r4, lr} a0009a18: e24dd004 sub sp, sp, #4 a0009a1c: e1a01000 mov r1, r0 Objects_Id id, Objects_Locations *location ) { return (Semaphore_Control *) _Objects_Get( &_Semaphore_Information, id, location ); a0009a20: e1a0200d mov r2, sp a0009a24: e59f0088 ldr r0, [pc, #136] ; a0009ab4 a0009a28: eb000629 bl a000b2d4 <_Objects_Get> register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { a0009a2c: e59d3000 ldr r3, [sp] a0009a30: e1a04000 mov r4, r0 a0009a34: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0009a38: 13a00004 movne r0, #4 { register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { a0009a3c: 1a000009 bne a0009a68 */ RTEMS_INLINE_ROUTINE bool _Attributes_Is_counting_semaphore( rtems_attribute attribute_set ) { return ((attribute_set & RTEMS_SEMAPHORE_CLASS) == RTEMS_COUNTING_SEMAPHORE); a0009a40: e5941010 ldr r1, [r4, #16] case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { a0009a44: e2111030 ands r1, r1, #48 ; 0x30 a0009a48: 0a000015 beq a0009aa4 if ( _CORE_mutex_Is_locked( &the_semaphore->Core_control.mutex ) && a0009a4c: e5943064 ldr r3, [r4, #100] ; 0x64 a0009a50: e3530000 cmp r3, #0 a0009a54: 1a000005 bne a0009a70 a0009a58: e3510020 cmp r1, #32 a0009a5c: 0a000003 beq a0009a70 !_Attributes_Is_simple_binary_semaphore( the_semaphore->attribute_set ) ) { _Thread_Enable_dispatch(); a0009a60: eb000919 bl a000becc <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_RESOURCE_IN_USE; a0009a64: e3a0000c mov r0, #12 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0009a68: e28dd004 add sp, sp, #4 a0009a6c: e8bd8010 pop {r4, pc} !_Attributes_Is_simple_binary_semaphore( the_semaphore->attribute_set ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } _CORE_mutex_Flush( a0009a70: e2840014 add r0, r4, #20 a0009a74: e3a01000 mov r1, #0 a0009a78: e3a02004 mov r2, #4 a0009a7c: eb00028c bl a000a4b4 <_CORE_mutex_Flush> SEMAPHORE_MP_OBJECT_WAS_DELETED, CORE_SEMAPHORE_WAS_DELETED ); } _Objects_Close( &_Semaphore_Information, &the_semaphore->Object ); a0009a80: e1a01004 mov r1, r4 a0009a84: e59f0028 ldr r0, [pc, #40] ; a0009ab4 a0009a88: eb000501 bl a000ae94 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Semaphore_Free ( Semaphore_Control *the_semaphore ) { _Objects_Free( &_Semaphore_Information, &the_semaphore->Object ); a0009a8c: e59f0020 ldr r0, [pc, #32] ; a0009ab4 a0009a90: e1a01004 mov r1, r4 a0009a94: eb0005b5 bl a000b170 <_Objects_Free> 0, /* Not used */ 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); a0009a98: eb00090b bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0009a9c: e3a00000 mov r0, #0 a0009aa0: eafffff0 b a0009a68 &the_semaphore->Core_control.mutex, SEMAPHORE_MP_OBJECT_WAS_DELETED, CORE_MUTEX_WAS_DELETED ); } else { _CORE_semaphore_Flush( a0009aa4: e2840014 add r0, r4, #20 a0009aa8: e3a02002 mov r2, #2 a0009aac: eb00034f bl a000a7f0 <_CORE_semaphore_Flush> a0009ab0: eafffff2 b a0009a80 =============================================================================== a0012acc : #endif rtems_status_code rtems_semaphore_flush( rtems_id id ) { a0012acc: e52de004 push {lr} ; (str lr, [sp, #-4]!) a0012ad0: e24dd004 sub sp, sp, #4 a0012ad4: e1a01000 mov r1, r0 a0012ad8: e1a0200d mov r2, sp a0012adc: e59f004c ldr r0, [pc, #76] ; a0012b30 a0012ae0: ebffe6ad bl a000c59c <_Objects_Get> register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { a0012ae4: e59d3000 ldr r3, [sp] a0012ae8: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0012aec: 13a00004 movne r0, #4 { register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { a0012af0: 1a000007 bne a0012b14 */ RTEMS_INLINE_ROUTINE bool _Attributes_Is_counting_semaphore( rtems_attribute attribute_set ) { return ((attribute_set & RTEMS_SEMAPHORE_CLASS) == RTEMS_COUNTING_SEMAPHORE); a0012af4: e5901010 ldr r1, [r0, #16] case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { a0012af8: e2111030 ands r1, r1, #48 ; 0x30 a0012afc: 1a000006 bne a0012b1c &the_semaphore->Core_control.mutex, SEND_OBJECT_WAS_DELETED, CORE_MUTEX_STATUS_UNSATISFIED_NOWAIT ); } else { _CORE_semaphore_Flush( a0012b00: e2800014 add r0, r0, #20 <== NOT EXECUTED a0012b04: e3a02001 mov r2, #1 <== NOT EXECUTED a0012b08: ebffe40a bl a000bb38 <_CORE_semaphore_Flush> <== NOT EXECUTED &the_semaphore->Core_control.semaphore, SEND_OBJECT_WAS_DELETED, CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT ); } _Thread_Enable_dispatch(); a0012b0c: ebffe9a6 bl a000d1ac <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0012b10: e3a00000 mov r0, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0012b14: e28dd004 add sp, sp, #4 a0012b18: e8bd8000 pop {pc} the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { _CORE_mutex_Flush( a0012b1c: e2800014 add r0, r0, #20 a0012b20: e1a01003 mov r1, r3 a0012b24: e3a02001 mov r2, #1 a0012b28: ebffe333 bl a000b7fc <_CORE_mutex_Flush> a0012b2c: eafffff6 b a0012b0c =============================================================================== a0009ab8 : rtems_status_code rtems_semaphore_obtain( rtems_id id, rtems_option option_set, rtems_interval timeout ) { a0009ab8: e92d40f0 push {r4, r5, r6, r7, lr} a0009abc: e1a04000 mov r4, r0 a0009ac0: e24dd00c sub sp, sp, #12 Objects_Locations *location, ISR_Level *level ) { return (Semaphore_Control *) _Objects_Get_isr_disable( &_Semaphore_Information, id, location, level ); a0009ac4: e28d3004 add r3, sp, #4 a0009ac8: e1a05001 mov r5, r1 a0009acc: e1a06002 mov r6, r2 a0009ad0: e59f00f4 ldr r0, [pc, #244] ; a0009bcc a0009ad4: e1a01004 mov r1, r4 a0009ad8: e28d2008 add r2, sp, #8 a0009adc: eb0005e0 bl a000b264 <_Objects_Get_isr_disable> register Semaphore_Control *the_semaphore; Objects_Locations location; ISR_Level level; the_semaphore = _Semaphore_Get_interrupt_disable( id, &location, &level ); switch ( location ) { a0009ae0: e59d3008 ldr r3, [sp, #8] a0009ae4: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0009ae8: 13a00004 movne r0, #4 register Semaphore_Control *the_semaphore; Objects_Locations location; ISR_Level level; the_semaphore = _Semaphore_Get_interrupt_disable( id, &location, &level ); switch ( location ) { a0009aec: 1a00000e bne a0009b2c a0009af0: e5903010 ldr r3, [r0, #16] case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { a0009af4: e2133030 ands r3, r3, #48 ; 0x30 a0009af8: 0a00000d beq a0009b34 _CORE_mutex_Seize( a0009afc: e59d3004 ldr r3, [sp, #4] */ RTEMS_INLINE_ROUTINE bool _Options_Is_no_wait ( rtems_option option_set ) { return (option_set & RTEMS_NO_WAIT) ? true : false; a0009b00: e2052001 and r2, r5, #1 a0009b04: e2800014 add r0, r0, #20 a0009b08: e58d3000 str r3, [sp] a0009b0c: e2222001 eor r2, r2, #1 a0009b10: e1a03006 mov r3, r6 a0009b14: e1a01004 mov r1, r4 a0009b18: eb0002b0 bl a000a5e0 <_CORE_mutex_Seize> ((_Options_Is_no_wait( option_set )) ? false : true), timeout, level ); return _Semaphore_Translate_core_mutex_return_code( _Thread_Executing->Wait.return_code ); a0009b1c: e59f30ac ldr r3, [pc, #172] ; a0009bd0 a0009b20: e5933004 ldr r3, [r3, #4] id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, level ); return _Semaphore_Translate_core_mutex_return_code( a0009b24: e5930034 ldr r0, [r3, #52] ; 0x34 a0009b28: eb00004c bl a0009c60 <_Semaphore_Translate_core_mutex_return_code> break; } return RTEMS_INVALID_ID; } a0009b2c: e28dd00c add sp, sp, #12 a0009b30: e8bd80f0 pop {r4, r5, r6, r7, pc} { Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; a0009b34: e59f7094 ldr r7, [pc, #148] ; a0009bd0 executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { a0009b38: e590105c ldr r1, [r0, #92] ; 0x5c { Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; a0009b3c: e5972004 ldr r2, [r7, #4] executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { a0009b40: e3510000 cmp r1, #0 Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; a0009b44: e5823034 str r3, [r2, #52] ; 0x34 if ( the_semaphore->count != 0 ) { a0009b48: 1a000009 bne a0009b74 the_semaphore->count -= 1; _ISR_Enable( *level_p ); return; } if ( !wait ) { a0009b4c: e3150001 tst r5, #1 a0009b50: 0a00000c beq a0009b88 a0009b54: e59d3004 ldr r3, [sp, #4] <== NOT EXECUTED a0009b58: e129f003 msr CPSR_fc, r3 <== NOT EXECUTED _ISR_Enable( *level_p ); executing->Wait.return_code = CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT; a0009b5c: e3a03001 mov r3, #1 <== NOT EXECUTED a0009b60: e5823034 str r3, [r2, #52] ; 0x34 <== NOT EXECUTED ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( _Thread_Executing->Wait.return_code ); a0009b64: e5973004 ldr r3, [r7, #4] id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( a0009b68: e5930034 ldr r0, [r3, #52] ; 0x34 a0009b6c: eb00003f bl a0009c70 <_Semaphore_Translate_core_semaphore_return_code> a0009b70: eaffffed b a0009b2c /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { the_semaphore->count -= 1; a0009b74: e2411001 sub r1, r1, #1 a0009b78: e580105c str r1, [r0, #92] ; 0x5c a0009b7c: e59d3004 ldr r3, [sp, #4] a0009b80: e129f003 msr CPSR_fc, r3 a0009b84: eafffff6 b a0009b64 a0009b88: e59f3044 ldr r3, [pc, #68] ; a0009bd4 a0009b8c: e5931000 ldr r1, [r3] a0009b90: e2811001 add r1, r1, #1 a0009b94: e5831000 str r1, [r3] 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; a0009b98: e3a01001 mov r1, #1 return; } _Thread_Disable_dispatch(); _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; a0009b9c: e2803014 add r3, r0, #20 a0009ba0: e5801044 str r1, [r0, #68] ; 0x44 a0009ba4: e5823044 str r3, [r2, #68] ; 0x44 executing->Wait.id = id; a0009ba8: e5824020 str r4, [r2, #32] a0009bac: e59d2004 ldr r2, [sp, #4] a0009bb0: e129f002 msr CPSR_fc, r2 _ISR_Enable( *level_p ); _Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout ); a0009bb4: e59f201c ldr r2, [pc, #28] ; a0009bd8 a0009bb8: e1a00003 mov r0, r3 a0009bbc: e1a01006 mov r1, r6 a0009bc0: eb0009e8 bl a000c368 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); a0009bc4: eb0008c0 bl a000becc <_Thread_Enable_dispatch> a0009bc8: eaffffe5 b a0009b64 =============================================================================== a0019268 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { a0019268: e92d4010 push {r4, lr} register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) a001926c: e2514000 subs r4, r1, #0 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { a0019270: e24dd004 sub sp, sp, #4 Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; a0019274: 03a0000a moveq r0, #10 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) a0019278: 1a000001 bne a0019284 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a001927c: e28dd004 add sp, sp, #4 a0019280: e8bd8010 pop {r4, pc} ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); a0019284: e1a0100d mov r1, sp a0019288: eb001160 bl a001d810 <_Thread_Get> switch ( location ) { a001928c: e59d3000 ldr r3, [sp] a0019290: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0019294: 13a00004 movne r0, #4 if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); switch ( location ) { a0019298: 1afffff7 bne a001927c case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; a001929c: e59030f4 ldr r3, [r0, #244] ; 0xf4 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { a00192a0: e593200c ldr r2, [r3, #12] a00192a4: e3520000 cmp r2, #0 a00192a8: 0a00001c beq a0019320 if ( asr->is_enabled ) { a00192ac: e5d32008 ldrb r2, [r3, #8] a00192b0: e3520000 cmp r2, #0 a00192b4: 0a00000f beq a00192f8 static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a00192b8: e10f2000 mrs r2, CPSR a00192bc: e3821080 orr r1, r2, #128 ; 0x80 a00192c0: e129f001 msr CPSR_fc, r1 ) { ISR_Level _level; _ISR_Disable( _level ); *signal_set |= signals; a00192c4: e5931014 ldr r1, [r3, #20] a00192c8: e1814004 orr r4, r1, r4 a00192cc: e5834014 str r4, [r3, #20] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a00192d0: e129f002 msr CPSR_fc, r2 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) a00192d4: e59f3050 ldr r3, [pc, #80] ; a001932c a00192d8: e5932000 ldr r2, [r3] a00192dc: e3520000 cmp r2, #0 a00192e0: 0a00000b beq a0019314 a00192e4: e5932004 ldr r2, [r3, #4] a00192e8: e1500002 cmp r0, r2 _Thread_Dispatch_necessary = true; a00192ec: 03a02001 moveq r2, #1 a00192f0: 05c32010 strbeq r2, [r3, #16] a00192f4: ea000006 b a0019314 <== NOT EXECUTED static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a00192f8: e10f2000 mrs r2, CPSR <== NOT EXECUTED a00192fc: e3821080 orr r1, r2, #128 ; 0x80 <== NOT EXECUTED a0019300: e129f001 msr CPSR_fc, r1 <== NOT EXECUTED a0019304: e5931018 ldr r1, [r3, #24] <== NOT EXECUTED a0019308: e1814004 orr r4, r1, r4 <== NOT EXECUTED a001930c: e5834018 str r4, [r3, #24] <== NOT EXECUTED static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0019310: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); a0019314: eb001134 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0019318: e3a00000 mov r0, #0 a001931c: eaffffd6 b a001927c } _Thread_Enable_dispatch(); a0019320: eb001131 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_NOT_DEFINED; a0019324: e3a0000b mov r0, #11 <== NOT EXECUTED a0019328: eaffffd3 b a001927c <== NOT EXECUTED =============================================================================== a0009dc0 : */ rtems_status_code rtems_task_delete( rtems_id id ) { a0009dc0: e92d4070 push {r4, r5, r6, lr} register Thread_Control *the_thread; Objects_Locations location; Objects_Information *the_information; _RTEMS_Lock_allocator(); a0009dc4: e59f4070 ldr r4, [pc, #112] ; a0009e3c */ rtems_status_code rtems_task_delete( rtems_id id ) { a0009dc8: e24dd004 sub sp, sp, #4 a0009dcc: e1a05000 mov r5, r0 register Thread_Control *the_thread; Objects_Locations location; Objects_Information *the_information; _RTEMS_Lock_allocator(); a0009dd0: e5940000 ldr r0, [r4] a0009dd4: eb00016d bl a000a390 <_API_Mutex_Lock> the_thread = _Thread_Get( id, &location ); a0009dd8: e1a00005 mov r0, r5 a0009ddc: e1a0100d mov r1, sp a0009de0: eb000842 bl a000bef0 <_Thread_Get> switch ( location ) { a0009de4: e59d5000 ldr r5, [sp] Objects_Locations location; Objects_Information *the_information; _RTEMS_Lock_allocator(); the_thread = _Thread_Get( id, &location ); a0009de8: e1a06000 mov r6, r0 switch ( location ) { a0009dec: e3550000 cmp r5, #0 a0009df0: 1a00000d bne a0009e2c case OBJECTS_LOCAL: the_information = _Objects_Get_information_id( the_thread->Object.id ); a0009df4: e5900008 ldr r0, [r0, #8] a0009df8: eb0004fa bl a000b1e8 <_Objects_Get_information_id> 0 /* Not used */ ); } #endif _Thread_Close( the_information, the_thread ); a0009dfc: e1a01006 mov r1, r6 a0009e00: eb000764 bl a000bb98 <_Thread_Close> a0009e04: e5960008 ldr r0, [r6, #8] a0009e08: eb0004f6 bl a000b1e8 <_Objects_Get_information_id> a0009e0c: e1a01006 mov r1, r6 a0009e10: eb0004d6 bl a000b170 <_Objects_Free> _RTEMS_tasks_Free( the_thread ); _RTEMS_Unlock_allocator(); a0009e14: e5940000 ldr r0, [r4] a0009e18: eb000178 bl a000a400 <_API_Mutex_Unlock> _Thread_Enable_dispatch(); a0009e1c: eb00082a bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0009e20: e1a00005 mov r0, r5 break; } _RTEMS_Unlock_allocator(); return RTEMS_INVALID_ID; } a0009e24: e28dd004 add sp, sp, #4 a0009e28: e8bd8070 pop {r4, r5, r6, pc} case OBJECTS_ERROR: break; } _RTEMS_Unlock_allocator(); a0009e2c: e5940000 ldr r0, [r4] <== NOT EXECUTED a0009e30: eb000172 bl a000a400 <_API_Mutex_Unlock> <== NOT EXECUTED return RTEMS_INVALID_ID; a0009e34: e3a00004 mov r0, #4 <== NOT EXECUTED a0009e38: eafffff9 b a0009e24 <== NOT EXECUTED =============================================================================== a000bf40 : rtems_status_code rtems_task_get_note( rtems_id id, uint32_t notepad, uint32_t *note ) { a000bf40: e92d4030 push {r4, r5, lr} a000bf44: e1a04001 mov r4, r1 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000bf48: e59f10a4 ldr r1, [pc, #164] ; a000bff4 rtems_status_code rtems_task_get_note( rtems_id id, uint32_t notepad, uint32_t *note ) { a000bf4c: e1a03000 mov r3, r0 a000bf50: e24dd008 sub sp, sp, #8 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000bf54: e5d11004 ldrb r1, [r1, #4] a000bf58: e3510000 cmp r1, #0 return RTEMS_NOT_CONFIGURED; a000bf5c: 03a00016 moveq r0, #22 { register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000bf60: 0a000019 beq a000bfcc return RTEMS_NOT_CONFIGURED; if ( !note ) a000bf64: e3520000 cmp r2, #0 return RTEMS_INVALID_ADDRESS; a000bf68: 03a00009 moveq r0, #9 RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) return RTEMS_NOT_CONFIGURED; if ( !note ) a000bf6c: 0a000016 beq a000bfcc /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) a000bf70: e354000f cmp r4, #15 return RTEMS_INVALID_NUMBER; a000bf74: 83a0000a movhi r0, #10 /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) a000bf78: 8a000013 bhi a000bfcc /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000bf7c: e3530000 cmp r3, #0 a000bf80: 0a000013 beq a000bfd4 _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { a000bf84: e59f106c ldr r1, [pc, #108] ; a000bff8 a000bf88: e5911004 ldr r1, [r1, #4] /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000bf8c: e591c008 ldr ip, [r1, #8] a000bf90: e153000c cmp r3, ip a000bf94: 0a000010 beq a000bfdc api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; return RTEMS_SUCCESSFUL; } the_thread = _Thread_Get( id, &location ); a000bf98: e28d1004 add r1, sp, #4 a000bf9c: e58d2000 str r2, [sp] a000bfa0: eb000905 bl a000e3bc <_Thread_Get> switch ( location ) { a000bfa4: e89d0024 ldm sp, {r2, r5} a000bfa8: e3550000 cmp r5, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000bfac: 13a00004 movne r0, #4 *note = api->Notepads[ notepad ]; return RTEMS_SUCCESSFUL; } the_thread = _Thread_Get( id, &location ); switch ( location ) { a000bfb0: 1a000005 bne a000bfcc case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; a000bfb4: e59030f4 ldr r3, [r0, #244] ; 0xf4 a000bfb8: e2844008 add r4, r4, #8 a000bfbc: e7933104 ldr r3, [r3, r4, lsl #2] a000bfc0: e5823000 str r3, [r2] _Thread_Enable_dispatch(); a000bfc4: eb0008f3 bl a000e398 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000bfc8: e1a00005 mov r0, r5 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000bfcc: e28dd008 add sp, sp, #8 a000bfd0: e8bd8030 pop {r4, r5, pc} /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000bfd4: e59f301c ldr r3, [pc, #28] ; a000bff8 <== NOT EXECUTED a000bfd8: e5931004 ldr r1, [r3, #4] <== NOT EXECUTED _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; a000bfdc: e59130f4 ldr r3, [r1, #244] ; 0xf4 <== NOT EXECUTED a000bfe0: e2844008 add r4, r4, #8 <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000bfe4: e3a00000 mov r0, #0 <== NOT EXECUTED */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; a000bfe8: e7933104 ldr r3, [r3, r4, lsl #2] <== NOT EXECUTED a000bfec: e5823000 str r3, [r2] <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000bff0: eafffff5 b a000bfcc <== NOT EXECUTED =============================================================================== a0009e40 : rtems_id *id ) { Objects_Name_or_id_lookup_errors status; if ( !id ) a0009e40: e2523000 subs r3, r2, #0 rtems_status_code rtems_task_ident( rtems_name name, uint32_t node, rtems_id *id ) { a0009e44: e52de004 push {lr} ; (str lr, [sp, #-4]!) a0009e48: e1a0c000 mov ip, r0 a0009e4c: e1a02001 mov r2, r1 Objects_Name_or_id_lookup_errors status; if ( !id ) a0009e50: 0a00000c beq a0009e88 return RTEMS_INVALID_ADDRESS; if ( name == OBJECTS_ID_OF_SELF ) { a0009e54: e3500000 cmp r0, #0 a0009e58: 1a000004 bne a0009e70 *id = _Thread_Executing->Object.id; a0009e5c: e59f202c ldr r2, [pc, #44] ; a0009e90 a0009e60: e5922004 ldr r2, [r2, #4] a0009e64: e5922008 ldr r2, [r2, #8] a0009e68: e5832000 str r2, [r3] return RTEMS_SUCCESSFUL; a0009e6c: e49df004 pop {pc} ; (ldr pc, [sp], #4) } status = _Objects_Name_to_id_u32( &_RTEMS_tasks_Information, name, node, id ); a0009e70: e59f001c ldr r0, [pc, #28] ; a0009e94 a0009e74: e1a0100c mov r1, ip a0009e78: eb00056e bl a000b438 <_Objects_Name_to_id_u32> return _Status_Object_name_errors_to_status[ status ]; a0009e7c: e59f3014 ldr r3, [pc, #20] ; a0009e98 a0009e80: e7930100 ldr r0, [r3, r0, lsl #2] a0009e84: e49df004 pop {pc} ; (ldr pc, [sp], #4) ) { Objects_Name_or_id_lookup_errors status; if ( !id ) return RTEMS_INVALID_ADDRESS; a0009e88: e3a00009 mov r0, #9 <== NOT EXECUTED } status = _Objects_Name_to_id_u32( &_RTEMS_tasks_Information, name, node, id ); return _Status_Object_name_errors_to_status[ status ]; } a0009e8c: e49df004 pop {pc} ; (ldr pc, [sp], #4) <== NOT EXECUTED =============================================================================== a0019694 : */ rtems_status_code rtems_task_is_suspended( rtems_id id ) { a0019694: e92d4010 push {r4, lr} a0019698: e24dd004 sub sp, sp, #4 register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a001969c: e1a0100d mov r1, sp a00196a0: eb00105a bl a001d810 <_Thread_Get> switch ( location ) { a00196a4: e59d3000 ldr r3, [sp] a00196a8: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a00196ac: 13a00004 movne r0, #4 { register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); switch ( location ) { a00196b0: 1a000004 bne a00196c8 */ RTEMS_INLINE_ROUTINE bool _States_Is_suspended ( States_Control the_states ) { return (the_states & STATES_SUSPENDED); a00196b4: e5904010 ldr r4, [r0, #16] case OBJECTS_LOCAL: if ( !_States_Is_suspended( the_thread->current_state ) ) { a00196b8: e2144002 ands r4, r4, #2 a00196bc: 0a000003 beq a00196d0 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a00196c0: eb001049 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_ALREADY_SUSPENDED; a00196c4: e3a0000f mov r0, #15 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a00196c8: e28dd004 add sp, sp, #4 a00196cc: e8bd8010 pop {r4, pc} the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_States_Is_suspended( the_thread->current_state ) ) { _Thread_Enable_dispatch(); a00196d0: eb001045 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a00196d4: e1a00004 mov r0, r4 <== NOT EXECUTED a00196d8: eafffffa b a00196c8 <== NOT EXECUTED =============================================================================== a0010d20 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { a0010d20: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) a0010d24: e2525000 subs r5, r2, #0 rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { a0010d28: e1a04000 mov r4, r0 a0010d2c: e1a06001 mov r6, r1 ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) a0010d30: 0a000053 beq a0010e84 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; a0010d34: e59f9158 ldr r9, [pc, #344] ; a0010e94 a0010d38: e5997004 ldr r7, [r9, #4] api = executing->API_Extensions[ THREAD_API_RTEMS ]; a0010d3c: e59780f4 ldr r8, [r7, #244] ; 0xf4 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; a0010d40: e5d7a074 ldrb sl, [r7, #116] ; 0x74 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) a0010d44: e597307c ldr r3, [r7, #124] ; 0x7c old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; a0010d48: e5d8b008 ldrb fp, [r8, #8] executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; a0010d4c: e35a0000 cmp sl, #0 a0010d50: 03a0ac01 moveq sl, #256 ; 0x100 a0010d54: 13a0a000 movne sl, #0 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) a0010d58: e3530000 cmp r3, #0 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; a0010d5c: 138aac02 orrne sl, sl, #512 ; 0x200 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; a0010d60: e35b0000 cmp fp, #0 a0010d64: 03a0bb01 moveq fp, #1024 ; 0x400 a0010d68: 13a0b000 movne fp, #0 old_mode |= _ISR_Get_level(); a0010d6c: ebfff1d0 bl a000d4b4 <_CPU_ISR_Get_level> if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; a0010d70: e18bb000 orr fp, fp, r0 old_mode |= _ISR_Get_level(); a0010d74: e18ba00a orr sl, fp, sl *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) a0010d78: e3160c01 tst r6, #256 ; 0x100 old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; old_mode |= _ISR_Get_level(); *previous_mode_set = old_mode; a0010d7c: e585a000 str sl, [r5] /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) a0010d80: 0a000003 beq a0010d94 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; a0010d84: e3140c01 tst r4, #256 ; 0x100 a0010d88: 13a03000 movne r3, #0 a0010d8c: 03a03001 moveq r3, #1 a0010d90: e5c73074 strb r3, [r7, #116] ; 0x74 if ( mask & RTEMS_TIMESLICE_MASK ) { a0010d94: e3160c02 tst r6, #512 ; 0x200 a0010d98: 1a00001c bne a0010e10 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) a0010d9c: e3160080 tst r6, #128 ; 0x80 a0010da0: 1a000023 bne a0010e34 * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { a0010da4: e2166b01 ands r6, r6, #1024 ; 0x400 a0010da8: 0a000012 beq a0010df8 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { a0010dac: e5d82008 ldrb r2, [r8, #8] * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( a0010db0: e3140b01 tst r4, #1024 ; 0x400 a0010db4: 13a03000 movne r3, #0 a0010db8: 03a03001 moveq r3, #1 is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { a0010dbc: e1520003 cmp r2, r3 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; a0010dc0: 03a06000 moveq r6, #0 if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { a0010dc4: 0a00000b beq a0010df8 asr->is_enabled = is_asr_enabled; a0010dc8: e5c83008 strb r3, [r8, #8] static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a0010dcc: e10f3000 mrs r3, CPSR a0010dd0: e3832080 orr r2, r3, #128 ; 0x80 a0010dd4: e129f002 msr CPSR_fc, r2 { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; a0010dd8: e5981018 ldr r1, [r8, #24] information->signals_pending = information->signals_posted; a0010ddc: e5982014 ldr r2, [r8, #20] information->signals_posted = _signals; a0010de0: e5881014 str r1, [r8, #20] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; a0010de4: e5882018 str r2, [r8, #24] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a0010de8: e129f003 msr CPSR_fc, r3 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { a0010dec: e5986014 ldr r6, [r8, #20] a0010df0: e3560000 cmp r6, #0 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; a0010df4: 13a06001 movne r6, #1 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { a0010df8: e59f3098 ldr r3, [pc, #152] ; a0010e98 a0010dfc: e5933000 ldr r3, [r3] a0010e00: e3530003 cmp r3, #3 a0010e04: 0a00000d beq a0010e40 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; a0010e08: e3a00000 mov r0, #0 <== NOT EXECUTED a0010e0c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED */ if ( mask & RTEMS_PREEMPT_MASK ) executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { a0010e10: e2143c02 ands r3, r4, #512 ; 0x200 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; a0010e14: 13a03001 movne r3, #1 a0010e18: 1587307c strne r3, [r7, #124] ; 0x7c executing->cpu_time_budget = _Thread_Ticks_per_timeslice; a0010e1c: 159f3078 ldrne r3, [pc, #120] ; a0010e9c } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; a0010e20: 0587307c streq r3, [r7, #124] ; 0x7c executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; a0010e24: 15933000 ldrne r3, [r3] a0010e28: 15873078 strne r3, [r7, #120] ; 0x78 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) a0010e2c: e3160080 tst r6, #128 ; 0x80 a0010e30: 0affffdb beq a0010da4 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); a0010e34: e2040080 and r0, r4, #128 ; 0x80 a0010e38: ebfff198 bl a000d4a0 <_CPU_ISR_Set_level> a0010e3c: eaffffd8 b a0010da4 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || a0010e40: e3560000 cmp r6, #0 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; a0010e44: e5993004 ldr r3, [r9, #4] if ( are_signals_pending || a0010e48: 1a000008 bne a0010e70 a0010e4c: e59f2040 ldr r2, [pc, #64] ; a0010e94 a0010e50: e5922008 ldr r2, [r2, #8] a0010e54: e1530002 cmp r3, r2 a0010e58: 0a00000b beq a0010e8c (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { a0010e5c: e5d33074 ldrb r3, [r3, #116] ; 0x74 a0010e60: e3530000 cmp r3, #0 a0010e64: 1a000001 bne a0010e70 if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; a0010e68: e1a00006 mov r0, r6 <== NOT EXECUTED } a0010e6c: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED _Thread_Dispatch_necessary = true; a0010e70: e3a03001 mov r3, #1 a0010e74: e5c93010 strb r3, [r9, #16] } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); a0010e78: ebffebbd bl a000bd74 <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; a0010e7c: e3a00000 mov r0, #0 a0010e80: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; a0010e84: e3a00009 mov r0, #9 <== NOT EXECUTED a0010e88: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} <== NOT EXECUTED if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; a0010e8c: e1a00006 mov r0, r6 a0010e90: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} =============================================================================== a000d2b8 : */ rtems_status_code rtems_task_resume( rtems_id id ) { a000d2b8: e92d4010 push {r4, lr} a000d2bc: e24dd004 sub sp, sp, #4 register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a000d2c0: e1a0100d mov r1, sp a000d2c4: eb00080a bl a000f2f4 <_Thread_Get> switch ( location ) { a000d2c8: e59d4000 ldr r4, [sp] ) { register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a000d2cc: e1a03000 mov r3, r0 switch ( location ) { a000d2d0: e3540000 cmp r4, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000d2d4: 13a00004 movne r0, #4 { register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); switch ( location ) { a000d2d8: 1a000004 bne a000d2f0 */ RTEMS_INLINE_ROUTINE bool _States_Is_suspended ( States_Control the_states ) { return (the_states & STATES_SUSPENDED); a000d2dc: e5933010 ldr r3, [r3, #16] case OBJECTS_LOCAL: if ( _States_Is_suspended( the_thread->current_state ) ) { a000d2e0: e3130002 tst r3, #2 a000d2e4: 1a000003 bne a000d2f8 _Thread_Resume( the_thread, true ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a000d2e8: eb0007f8 bl a000f2d0 <_Thread_Enable_dispatch> return RTEMS_INCORRECT_STATE; a000d2ec: e3a0000e mov r0, #14 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000d2f0: e28dd004 add sp, sp, #4 a000d2f4: e8bd8010 pop {r4, pc} the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( _States_Is_suspended( the_thread->current_state ) ) { _Thread_Resume( the_thread, true ); a000d2f8: e3a01001 mov r1, #1 a000d2fc: eb000a0f bl a000fb40 <_Thread_Resume> _Thread_Enable_dispatch(); a000d300: eb0007f2 bl a000f2d0 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000d304: e1a00004 mov r0, r4 a000d308: eafffff8 b a000d2f0 =============================================================================== a000c0f4 : rtems_status_code rtems_task_set_note( rtems_id id, uint32_t notepad, uint32_t note ) { a000c0f4: e92d4030 push {r4, r5, lr} a000c0f8: e1a04001 mov r4, r1 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000c0fc: e59f1090 ldr r1, [pc, #144] ; a000c194 rtems_status_code rtems_task_set_note( rtems_id id, uint32_t notepad, uint32_t note ) { a000c100: e1a03000 mov r3, r0 a000c104: e24dd008 sub sp, sp, #8 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000c108: e5d11004 ldrb r1, [r1, #4] a000c10c: e3510000 cmp r1, #0 return RTEMS_NOT_CONFIGURED; a000c110: 03a00016 moveq r0, #22 { register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) a000c114: 0a000015 beq a000c170 /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) a000c118: e354000f cmp r4, #15 return RTEMS_INVALID_NUMBER; a000c11c: 83a0000a movhi r0, #10 /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) a000c120: 8a000012 bhi a000c170 /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000c124: e3530000 cmp r3, #0 a000c128: 0a000012 beq a000c178 _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { a000c12c: e59f1064 ldr r1, [pc, #100] ; a000c198 a000c130: e5911004 ldr r1, [r1, #4] /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000c134: e591c008 ldr ip, [r1, #8] a000c138: e153000c cmp r3, ip a000c13c: 0a00000f beq a000c180 api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; return RTEMS_SUCCESSFUL; } the_thread = _Thread_Get( id, &location ); a000c140: e28d1004 add r1, sp, #4 a000c144: e58d2000 str r2, [sp] a000c148: eb00089b bl a000e3bc <_Thread_Get> switch ( location ) { a000c14c: e89d0024 ldm sp, {r2, r5} a000c150: e3550000 cmp r5, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000c154: 13a00004 movne r0, #4 api->Notepads[ notepad ] = note; return RTEMS_SUCCESSFUL; } the_thread = _Thread_Get( id, &location ); switch ( location ) { a000c158: 1a000004 bne a000c170 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; a000c15c: e59030f4 ldr r3, [r0, #244] ; 0xf4 a000c160: e2844008 add r4, r4, #8 a000c164: e7832104 str r2, [r3, r4, lsl #2] _Thread_Enable_dispatch(); a000c168: eb00088a bl a000e398 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000c16c: e1a00005 mov r0, r5 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000c170: e28dd008 add sp, sp, #8 a000c174: e8bd8030 pop {r4, r5, pc} /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || a000c178: e59f3018 ldr r3, [pc, #24] ; a000c198 <== NOT EXECUTED a000c17c: e5931004 ldr r1, [r3, #4] <== NOT EXECUTED _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; a000c180: e59130f4 ldr r3, [r1, #244] ; 0xf4 <== NOT EXECUTED a000c184: e2844008 add r4, r4, #8 <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000c188: e3a00000 mov r0, #0 <== NOT EXECUTED */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; a000c18c: e7832104 str r2, [r3, r4, lsl #2] <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000c190: eafffff6 b a000c170 <== NOT EXECUTED =============================================================================== a000e47c : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { a000e47c: e92d4030 push {r4, r5, lr} register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && a000e480: e2514000 subs r4, r1, #0 rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { a000e484: e24dd004 sub sp, sp, #4 a000e488: e1a05002 mov r5, r2 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && a000e48c: 0a000004 beq a000e4a4 RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); a000e490: e59f3078 ldr r3, [pc, #120] ; a000e510 a000e494: e5d33000 ldrb r3, [r3] */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && a000e498: e1540003 cmp r4, r3 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; a000e49c: 83a00013 movhi r0, #19 a000e4a0: 8a000018 bhi a000e508 if ( !old_priority ) a000e4a4: e3550000 cmp r5, #0 return RTEMS_INVALID_ADDRESS; a000e4a8: 03a00009 moveq r0, #9 if ( new_priority != RTEMS_CURRENT_PRIORITY && !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) a000e4ac: 0a000015 beq a000e508 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); a000e4b0: e1a0100d mov r1, sp a000e4b4: eb000886 bl a00106d4 <_Thread_Get> switch ( location ) { a000e4b8: e59d3000 ldr r3, [sp] a000e4bc: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000e4c0: 13a00004 movne r0, #4 if ( !old_priority ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); switch ( location ) { a000e4c4: 1a00000f bne a000e508 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; a000e4c8: e5903014 ldr r3, [r0, #20] if ( new_priority != RTEMS_CURRENT_PRIORITY ) { a000e4cc: e3540000 cmp r4, #0 the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; a000e4d0: e5853000 str r3, [r5] if ( new_priority != RTEMS_CURRENT_PRIORITY ) { a000e4d4: 0a000009 beq a000e500 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || a000e4d8: e590301c ldr r3, [r0, #28] case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; if ( new_priority != RTEMS_CURRENT_PRIORITY ) { the_thread->real_priority = new_priority; a000e4dc: e5804018 str r4, [r0, #24] if ( the_thread->resource_count == 0 || a000e4e0: e3530000 cmp r3, #0 a000e4e4: 0a000002 beq a000e4f4 a000e4e8: e5903014 ldr r3, [r0, #20] <== NOT EXECUTED a000e4ec: e1540003 cmp r4, r3 <== NOT EXECUTED a000e4f0: 2a000002 bcs a000e500 <== NOT EXECUTED the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); a000e4f4: e1a01004 mov r1, r4 a000e4f8: e3a02000 mov r2, #0 a000e4fc: eb00072b bl a00101b0 <_Thread_Change_priority> } _Thread_Enable_dispatch(); a000e500: eb00086a bl a00106b0 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000e504: e3a00000 mov r0, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000e508: e28dd004 add sp, sp, #4 a000e50c: e8bd8030 pop {r4, r5, pc} =============================================================================== a0009f2c : rtems_status_code rtems_task_start( rtems_id id, rtems_task_entry entry_point, rtems_task_argument argument ) { a0009f2c: e92d4070 push {r4, r5, r6, lr} register Thread_Control *the_thread; Objects_Locations location; if ( entry_point == NULL ) a0009f30: e2515000 subs r5, r1, #0 rtems_status_code rtems_task_start( rtems_id id, rtems_task_entry entry_point, rtems_task_argument argument ) { a0009f34: e24dd008 sub sp, sp, #8 a0009f38: e1a06002 mov r6, r2 register Thread_Control *the_thread; Objects_Locations location; if ( entry_point == NULL ) return RTEMS_INVALID_ADDRESS; a0009f3c: 03a00009 moveq r0, #9 ) { register Thread_Control *the_thread; Objects_Locations location; if ( entry_point == NULL ) a0009f40: 0a00000e beq a0009f80 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); a0009f44: e28d1004 add r1, sp, #4 a0009f48: eb0007e8 bl a000bef0 <_Thread_Get> switch ( location ) { a0009f4c: e59d4004 ldr r4, [sp, #4] a0009f50: e3540000 cmp r4, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0009f54: 13a00004 movne r0, #4 if ( entry_point == NULL ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); switch ( location ) { a0009f58: 1a000008 bne a0009f80 case OBJECTS_LOCAL: if ( _Thread_Start( a0009f5c: e1a01004 mov r1, r4 a0009f60: e1a02005 mov r2, r5 a0009f64: e1a03004 mov r3, r4 a0009f68: e58d6000 str r6, [sp] a0009f6c: eb000a6f bl a000c930 <_Thread_Start> a0009f70: e3500000 cmp r0, #0 a0009f74: 1a000003 bne a0009f88 the_thread, THREAD_START_NUMERIC, entry_point, NULL, argument ) ) { _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a0009f78: eb0007d3 bl a000becc <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_INCORRECT_STATE; a0009f7c: e3a0000e mov r0, #14 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0009f80: e28dd008 add sp, sp, #8 a0009f84: e8bd8070 pop {r4, r5, r6, pc} switch ( location ) { case OBJECTS_LOCAL: if ( _Thread_Start( the_thread, THREAD_START_NUMERIC, entry_point, NULL, argument ) ) { _Thread_Enable_dispatch(); a0009f88: eb0007cf bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0009f8c: e1a00004 mov r0, r4 a0009f90: eafffffa b a0009f80 =============================================================================== a000d56c : */ rtems_status_code rtems_task_suspend( rtems_id id ) { a000d56c: e92d4010 push {r4, lr} a000d570: e24dd004 sub sp, sp, #4 register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a000d574: e1a0100d mov r1, sp a000d578: eb0007d6 bl a000f4d8 <_Thread_Get> switch ( location ) { a000d57c: e59d3000 ldr r3, [sp] ) { register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); a000d580: e1a02000 mov r2, r0 switch ( location ) { a000d584: e3530000 cmp r3, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000d588: 13a00004 movne r0, #4 { register Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); switch ( location ) { a000d58c: 1a000004 bne a000d5a4 */ RTEMS_INLINE_ROUTINE bool _States_Is_suspended ( States_Control the_states ) { return (the_states & STATES_SUSPENDED); a000d590: e5924010 ldr r4, [r2, #16] case OBJECTS_LOCAL: if ( !_States_Is_suspended( the_thread->current_state ) ) { a000d594: e2144002 ands r4, r4, #2 a000d598: 0a000003 beq a000d5ac _Thread_Suspend( the_thread ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); a000d59c: eb0007c4 bl a000f4b4 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_ALREADY_SUSPENDED; a000d5a0: e3a0000f mov r0, #15 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000d5a4: e28dd004 add sp, sp, #4 a000d5a8: e8bd8010 pop {r4, pc} the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_States_Is_suspended( the_thread->current_state ) ) { _Thread_Suspend( the_thread ); a000d5ac: eb000a6c bl a000ff64 <_Thread_Suspend> _Thread_Enable_dispatch(); a000d5b0: eb0007bf bl a000f4b4 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000d5b4: e1a00004 mov r0, r4 a000d5b8: eafffff9 b a000d5a4 =============================================================================== a000ad5c : rtems_status_code rtems_task_variable_add( rtems_id tid, void **ptr, void (*dtor)(void *) ) { a000ad5c: e92d4070 push {r4, r5, r6, lr} Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *new; if ( !ptr ) a000ad60: e2514000 subs r4, r1, #0 rtems_status_code rtems_task_variable_add( rtems_id tid, void **ptr, void (*dtor)(void *) ) { a000ad64: e24dd004 sub sp, sp, #4 a000ad68: e1a05002 mov r5, r2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *new; if ( !ptr ) return RTEMS_INVALID_ADDRESS; a000ad6c: 03a00009 moveq r0, #9 { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *new; if ( !ptr ) a000ad70: 0a000016 beq a000add0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); a000ad74: e1a0100d mov r1, sp a000ad78: eb000833 bl a000ce4c <_Thread_Get> switch (location) { a000ad7c: e59d3000 ldr r3, [sp] rtems_task_variable_t *tvp, *new; if ( !ptr ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); a000ad80: e1a06000 mov r6, r0 switch (location) { a000ad84: e3530000 cmp r3, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000ad88: 13a00004 movne r0, #4 if ( !ptr ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); switch (location) { a000ad8c: 1a00000f bne a000add0 case OBJECTS_LOCAL: /* * Figure out if the variable is already in this task's list. */ tvp = the_thread->task_variables; a000ad90: e5963100 ldr r3, [r6, #256] ; 0x100 while (tvp) { a000ad94: e3530000 cmp r3, #0 a000ad98: 1a000011 bne a000ade4 /* * Now allocate memory for this task variable. */ new = (rtems_task_variable_t *) _Workspace_Allocate(sizeof(rtems_task_variable_t)); a000ad9c: e3a00014 mov r0, #20 a000ada0: eb000c9e bl a000e020 <_Workspace_Allocate> if (new == NULL) { a000ada4: e3500000 cmp r0, #0 a000ada8: 0a000014 beq a000ae00 _Thread_Enable_dispatch(); return RTEMS_NO_MEMORY; } new->gval = *ptr; a000adac: e5942000 ldr r2, [r4] new->ptr = ptr; new->dtor = dtor; new->next = (struct rtems_task_variable_tt *)the_thread->task_variables; a000adb0: e5963100 ldr r3, [r6, #256] ; 0x100 if (new == NULL) { _Thread_Enable_dispatch(); return RTEMS_NO_MEMORY; } new->gval = *ptr; new->ptr = ptr; a000adb4: e5804004 str r4, [r0, #4] _Workspace_Allocate(sizeof(rtems_task_variable_t)); if (new == NULL) { _Thread_Enable_dispatch(); return RTEMS_NO_MEMORY; } new->gval = *ptr; a000adb8: e5802008 str r2, [r0, #8] new->ptr = ptr; new->dtor = dtor; a000adbc: e5805010 str r5, [r0, #16] new->next = (struct rtems_task_variable_tt *)the_thread->task_variables; a000adc0: e5803000 str r3, [r0] the_thread->task_variables = new; a000adc4: e5860100 str r0, [r6, #256] ; 0x100 _Thread_Enable_dispatch(); a000adc8: eb000816 bl a000ce28 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000adcc: e3a00000 mov r0, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000add0: e28dd004 add sp, sp, #4 a000add4: e8bd8070 pop {r4, r5, r6, pc} if (tvp->ptr == ptr) { tvp->dtor = dtor; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; a000add8: e5933000 ldr r3, [r3] <== NOT EXECUTED case OBJECTS_LOCAL: /* * Figure out if the variable is already in this task's list. */ tvp = the_thread->task_variables; while (tvp) { a000addc: e3530000 cmp r3, #0 <== NOT EXECUTED a000ade0: 0affffed beq a000ad9c <== NOT EXECUTED if (tvp->ptr == ptr) { a000ade4: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED a000ade8: e1520004 cmp r2, r4 <== NOT EXECUTED a000adec: 1afffff9 bne a000add8 <== NOT EXECUTED tvp->dtor = dtor; a000adf0: e5835010 str r5, [r3, #16] <== NOT EXECUTED _Thread_Enable_dispatch(); a000adf4: eb00080b bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000adf8: e3a00000 mov r0, #0 <== NOT EXECUTED a000adfc: eafffff3 b a000add0 <== NOT EXECUTED * Now allocate memory for this task variable. */ new = (rtems_task_variable_t *) _Workspace_Allocate(sizeof(rtems_task_variable_t)); if (new == NULL) { _Thread_Enable_dispatch(); a000ae00: eb000808 bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_NO_MEMORY; a000ae04: e3a0001a mov r0, #26 <== NOT EXECUTED a000ae08: eafffff0 b a000add0 <== NOT EXECUTED =============================================================================== a000ae0c : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { a000ae0c: e92d4010 push {r4, lr} <== NOT EXECUTED Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) a000ae10: e2514000 subs r4, r1, #0 <== NOT EXECUTED rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { a000ae14: e24dd004 sub sp, sp, #4 <== NOT EXECUTED Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) return RTEMS_INVALID_ADDRESS; a000ae18: 03a00009 moveq r0, #9 <== NOT EXECUTED { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) a000ae1c: 0a000015 beq a000ae78 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); a000ae20: e1a0100d mov r1, sp <== NOT EXECUTED a000ae24: eb000808 bl a000ce4c <_Thread_Get> <== NOT EXECUTED switch (location) { a000ae28: e59d3000 ldr r3, [sp] <== NOT EXECUTED a000ae2c: e3530000 cmp r3, #0 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000ae30: 13a00004 movne r0, #4 <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); switch (location) { a000ae34: 1a00000f bne a000ae78 <== NOT EXECUTED case OBJECTS_LOCAL: tvp = the_thread->task_variables; a000ae38: e5903100 ldr r3, [r0, #256] ; 0x100 <== NOT EXECUTED while (tvp) { a000ae3c: e3530000 cmp r3, #0 <== NOT EXECUTED a000ae40: 0a00000a beq a000ae70 <== NOT EXECUTED if (tvp->ptr == ptr) { a000ae44: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED a000ae48: e1520004 cmp r2, r4 <== NOT EXECUTED a000ae4c: 1a000004 bne a000ae64 <== NOT EXECUTED a000ae50: ea000010 b a000ae98 <== NOT EXECUTED a000ae54: e5912004 ldr r2, [r1, #4] <== NOT EXECUTED a000ae58: e1520004 cmp r2, r4 <== NOT EXECUTED a000ae5c: 0a000007 beq a000ae80 <== NOT EXECUTED a000ae60: e1a03001 mov r3, r1 <== NOT EXECUTED _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; a000ae64: e5931000 ldr r1, [r3] <== NOT EXECUTED the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { a000ae68: e3510000 cmp r1, #0 <== NOT EXECUTED a000ae6c: 1afffff8 bne a000ae54 <== NOT EXECUTED return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); a000ae70: eb0007ec bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; a000ae74: e3a00009 mov r0, #9 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000ae78: e28dd004 add sp, sp, #4 <== NOT EXECUTED a000ae7c: e8bd8010 pop {r4, pc} <== NOT EXECUTED case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; a000ae80: e5912000 ldr r2, [r1] <== NOT EXECUTED a000ae84: e5832000 str r2, [r3] <== NOT EXECUTED else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); a000ae88: eb000028 bl a000af30 <_RTEMS_Tasks_Invoke_task_variable_dtor><== NOT EXECUTED _Thread_Enable_dispatch(); a000ae8c: eb0007e5 bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000ae90: e3a00000 mov r0, #0 <== NOT EXECUTED a000ae94: eafffff7 b a000ae78 <== NOT EXECUTED while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; a000ae98: e5932000 ldr r2, [r3] <== NOT EXECUTED a000ae9c: e1a01003 mov r1, r3 <== NOT EXECUTED a000aea0: e5802100 str r2, [r0, #256] ; 0x100 <== NOT EXECUTED a000aea4: eafffff7 b a000ae88 <== NOT EXECUTED =============================================================================== a000aea8 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { a000aea8: e92d4030 push {r4, r5, lr} Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) a000aeac: e2514000 subs r4, r1, #0 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { a000aeb0: e24dd004 sub sp, sp, #4 a000aeb4: e1a05002 mov r5, r2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) a000aeb8: 0a000017 beq a000af1c return RTEMS_INVALID_ADDRESS; if ( !result ) a000aebc: e3520000 cmp r2, #0 a000aec0: 0a000015 beq a000af1c return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); a000aec4: e1a0100d mov r1, sp a000aec8: eb0007df bl a000ce4c <_Thread_Get> switch (location) { a000aecc: e59d3000 ldr r3, [sp] a000aed0: e3530000 cmp r3, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000aed4: 13a00004 movne r0, #4 if ( !result ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); switch (location) { a000aed8: 1a00000d bne a000af14 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; a000aedc: e5903100 ldr r3, [r0, #256] ; 0x100 <== NOT EXECUTED while (tvp) { a000aee0: e3530000 cmp r3, #0 <== NOT EXECUTED a000aee4: 1a000003 bne a000aef8 <== NOT EXECUTED a000aee8: ea00000d b a000af24 <== NOT EXECUTED */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; a000aeec: e5933000 ldr r3, [r3] <== NOT EXECUTED case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; while (tvp) { a000aef0: e3530000 cmp r3, #0 <== NOT EXECUTED a000aef4: 0a00000a beq a000af24 <== NOT EXECUTED if (tvp->ptr == ptr) { a000aef8: e5932004 ldr r2, [r3, #4] <== NOT EXECUTED a000aefc: e1520004 cmp r2, r4 <== NOT EXECUTED a000af00: 1afffff9 bne a000aeec <== NOT EXECUTED /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; a000af04: e593300c ldr r3, [r3, #12] <== NOT EXECUTED a000af08: e5853000 str r3, [r5] <== NOT EXECUTED _Thread_Enable_dispatch(); a000af0c: eb0007c5 bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000af10: e3a00000 mov r0, #0 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000af14: e28dd004 add sp, sp, #4 a000af18: e8bd8030 pop {r4, r5, pc} if ( !ptr ) return RTEMS_INVALID_ADDRESS; if ( !result ) return RTEMS_INVALID_ADDRESS; a000af1c: e3a00009 mov r0, #9 a000af20: eafffffb b a000af14 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); a000af24: eb0007bf bl a000ce28 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; a000af28: e3a00009 mov r0, #9 <== NOT EXECUTED a000af2c: eafffff8 b a000af14 <== NOT EXECUTED =============================================================================== a0009f94 : a0009f94: e59f307c ldr r3, [pc, #124] ; a000a018 */ rtems_status_code rtems_task_wake_after( rtems_interval ticks ) { a0009f98: e92d4030 push {r4, r5, lr} a0009f9c: e5932000 ldr r2, [r3] a0009fa0: e1a04000 mov r4, r0 a0009fa4: e2822001 add r2, r2, #1 a0009fa8: e5832000 str r2, [r3] _Thread_Disable_dispatch(); if ( ticks == 0 ) { a0009fac: e3500000 cmp r0, #0 a0009fb0: 0a000012 beq a000a000 _Scheduler_Yield(); } else { _Thread_Set_state( _Thread_Executing, STATES_DELAYING ); a0009fb4: e59f5060 ldr r5, [pc, #96] ; a000a01c a0009fb8: e3a01008 mov r1, #8 a0009fbc: e5950004 ldr r0, [r5, #4] a0009fc0: eb0009e7 bl a000c764 <_Thread_Set_state> _Watchdog_Initialize( &_Thread_Executing->Timer, a0009fc4: e5951004 ldr r1, [r5, #4] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a0009fc8: e59f0050 ldr r0, [pc, #80] ; a000a020 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a0009fcc: e3a03000 mov r3, #0 _Thread_Disable_dispatch(); if ( ticks == 0 ) { _Scheduler_Yield(); } else { _Thread_Set_state( _Thread_Executing, STATES_DELAYING ); _Watchdog_Initialize( a0009fd0: e5912008 ldr r2, [r1, #8] a0009fd4: e5813050 str r3, [r1, #80] ; 0x50 the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; a0009fd8: e581306c str r3, [r1, #108] ; 0x6c void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; a0009fdc: e5812068 str r2, [r1, #104] ; 0x68 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a0009fe0: e5810064 str r0, [r1, #100] ; 0x64 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a0009fe4: e5814054 str r4, [r1, #84] ; 0x54 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a0009fe8: e59f0034 ldr r0, [pc, #52] ; a000a024 a0009fec: e2811048 add r1, r1, #72 ; 0x48 a0009ff0: eb000b57 bl a000cd54 <_Watchdog_Insert> _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_ticks( &_Thread_Executing->Timer, ticks ); } _Thread_Enable_dispatch(); a0009ff4: eb0007b4 bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; } a0009ff8: e3a00000 mov r0, #0 <== NOT EXECUTED a0009ffc: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); a000a000: e59f0020 ldr r0, [pc, #32] ; a000a028 a000a004: e5903008 ldr r3, [r0, #8] a000a008: e12fff33 blx r3 _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_ticks( &_Thread_Executing->Timer, ticks ); } _Thread_Enable_dispatch(); a000a00c: eb0007ae bl a000becc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; } a000a010: e3a00000 mov r0, #0 a000a014: e8bd8030 pop {r4, r5, pc} =============================================================================== a000b08c : rtems_time_of_day *time_buffer ) { Watchdog_Interval seconds; if ( !_TOD_Is_set ) a000b08c: e59f30c8 ldr r3, [pc, #200] ; a000b15c */ rtems_status_code rtems_task_wake_when( rtems_time_of_day *time_buffer ) { a000b090: e92d40f0 push {r4, r5, r6, r7, lr} Watchdog_Interval seconds; if ( !_TOD_Is_set ) a000b094: e5d33000 ldrb r3, [r3] */ rtems_status_code rtems_task_wake_when( rtems_time_of_day *time_buffer ) { a000b098: e1a05000 mov r5, r0 Watchdog_Interval seconds; if ( !_TOD_Is_set ) a000b09c: e3530000 cmp r3, #0 a000b0a0: 0a000011 beq a000b0ec return RTEMS_NOT_DEFINED; if ( !time_buffer ) a000b0a4: e3500000 cmp r0, #0 a000b0a8: 0a000029 beq a000b154 return RTEMS_INVALID_ADDRESS; time_buffer->ticks = 0; a000b0ac: e3a04000 mov r4, #0 a000b0b0: e5804018 str r4, [r0, #24] if ( !_TOD_Validate( time_buffer ) ) a000b0b4: ebfffcfb bl a000a4a8 <_TOD_Validate> a000b0b8: e1500004 cmp r0, r4 a000b0bc: 1a000001 bne a000b0c8 return RTEMS_INVALID_CLOCK; a000b0c0: e3a00014 mov r0, #20 <== NOT EXECUTED a000b0c4: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED seconds = _TOD_To_seconds( time_buffer ); a000b0c8: e1a00005 mov r0, r5 a000b0cc: ebfffcce bl a000a40c <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) a000b0d0: e59f6088 ldr r6, [pc, #136] ; a000b160 time_buffer->ticks = 0; if ( !_TOD_Validate( time_buffer ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( time_buffer ); a000b0d4: e1a05000 mov r5, r0 if ( seconds <= _TOD_Seconds_since_epoch() ) a000b0d8: e5963000 ldr r3, [r6] a000b0dc: e1500003 cmp r0, r3 a000b0e0: 8a000003 bhi a000b0f4 return RTEMS_INVALID_CLOCK; a000b0e4: e3a00014 mov r0, #20 <== NOT EXECUTED &_Thread_Executing->Timer, seconds - _TOD_Seconds_since_epoch() ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a000b0e8: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED ) { Watchdog_Interval seconds; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; a000b0ec: e3a0000b mov r0, #11 <== NOT EXECUTED a000b0f0: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED a000b0f4: e59f3068 ldr r3, [pc, #104] ; a000b164 a000b0f8: e5932000 ldr r2, [r3] a000b0fc: e2822001 add r2, r2, #1 a000b100: e5832000 str r2, [r3] if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; _Thread_Disable_dispatch(); _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_TIME ); a000b104: e59f705c ldr r7, [pc, #92] ; a000b168 a000b108: e3a01010 mov r1, #16 a000b10c: e5970004 ldr r0, [r7, #4] a000b110: eb0009f2 bl a000d8e0 <_Thread_Set_state> _Watchdog_Initialize( &_Thread_Executing->Timer, a000b114: e5971004 ldr r1, [r7, #4] _Thread_Delay_ended, _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_seconds( a000b118: e5962000 ldr r2, [r6] ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Seconds_chain, the_watchdog ); a000b11c: e59f0048 ldr r0, [pc, #72] ; a000b16c if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; _Thread_Disable_dispatch(); _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_TIME ); _Watchdog_Initialize( a000b120: e5913008 ldr r3, [r1, #8] &_Thread_Executing->Timer, _Thread_Delay_ended, _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_seconds( a000b124: e0625005 rsb r5, r2, r5 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; a000b128: e59f2040 ldr r2, [pc, #64] ; a000b170 the_watchdog->id = id; a000b12c: e5813068 str r3, [r1, #104] ; 0x68 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000b130: e5814050 str r4, [r1, #80] ; 0x50 the_watchdog->routine = routine; a000b134: e5812064 str r2, [r1, #100] ; 0x64 the_watchdog->id = id; the_watchdog->user_data = user_data; a000b138: e581406c str r4, [r1, #108] ; 0x6c Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000b13c: e5815054 str r5, [r1, #84] ; 0x54 _Watchdog_Insert( &_Watchdog_Seconds_chain, the_watchdog ); a000b140: e2811048 add r1, r1, #72 ; 0x48 a000b144: eb000b92 bl a000df94 <_Watchdog_Insert> &_Thread_Executing->Timer, seconds - _TOD_Seconds_since_epoch() ); _Thread_Enable_dispatch(); a000b148: eb0007be bl a000d048 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000b14c: e1a00004 mov r0, r4 a000b150: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !time_buffer ) return RTEMS_INVALID_ADDRESS; a000b154: e3a00009 mov r0, #9 <== NOT EXECUTED a000b158: e8bd80f0 pop {r4, r5, r6, r7, pc} <== NOT EXECUTED =============================================================================== a000a490 : rtems_status_code rtems_timer_create( rtems_name name, rtems_id *id ) { a000a490: e92d4070 push {r4, r5, r6, lr} Timer_Control *the_timer; if ( !rtems_is_name_valid( name ) ) a000a494: e2504000 subs r4, r0, #0 rtems_status_code rtems_timer_create( rtems_name name, rtems_id *id ) { a000a498: e1a05001 mov r5, r1 Timer_Control *the_timer; if ( !rtems_is_name_valid( name ) ) a000a49c: 0a00001a beq a000a50c return RTEMS_INVALID_NAME; if ( !id ) a000a4a0: e3510000 cmp r1, #0 a000a4a4: 0a00001d beq a000a520 a000a4a8: e59f3078 ldr r3, [pc, #120] ; a000a528 a000a4ac: e5932000 ldr r2, [r3] a000a4b0: e2822001 add r2, r2, #1 a000a4b4: e5832000 str r2, [r3] * This function allocates a timer control block from * the inactive chain of free timer control blocks. */ RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Allocate( void ) { return (Timer_Control *) _Objects_Allocate( &_Timer_Information ); a000a4b8: e59f606c ldr r6, [pc, #108] ; a000a52c a000a4bc: e1a00006 mov r0, r6 a000a4c0: eb0003cf bl a000b404 <_Objects_Allocate> _Thread_Disable_dispatch(); /* to prevent deletion */ the_timer = _Timer_Allocate(); if ( !the_timer ) { a000a4c4: e3500000 cmp r0, #0 a000a4c8: 0a000011 beq a000a514 Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), a000a4cc: e5903008 ldr r3, [r0, #8] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000a4d0: e596201c ldr r2, [r6, #28] _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_timer->the_class = TIMER_DORMANT; a000a4d4: e3a0c004 mov ip, #4 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000a4d8: e3a06000 mov r6, #0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( a000a4dc: e1a01803 lsl r1, r3, #16 a000a4e0: e580c038 str ip, [r0, #56] ; 0x38 a000a4e4: e5806018 str r6, [r0, #24] the_watchdog->routine = routine; a000a4e8: e580602c str r6, [r0, #44] ; 0x2c the_watchdog->id = id; a000a4ec: e5806030 str r6, [r0, #48] ; 0x30 the_watchdog->user_data = user_data; a000a4f0: e5806034 str r6, [r0, #52] ; 0x34 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; a000a4f4: e7820721 str r0, [r2, r1, lsr #14] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; a000a4f8: e580400c str r4, [r0, #12] &_Timer_Information, &the_timer->Object, (Objects_Name) name ); *id = the_timer->Object.id; a000a4fc: e5853000 str r3, [r5] _Thread_Enable_dispatch(); a000a500: eb0007d0 bl a000c448 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000a504: e1a00006 mov r0, r6 a000a508: e8bd8070 pop {r4, r5, r6, pc} ) { Timer_Control *the_timer; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; a000a50c: e3a00003 mov r0, #3 <== NOT EXECUTED a000a510: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED _Thread_Disable_dispatch(); /* to prevent deletion */ the_timer = _Timer_Allocate(); if ( !the_timer ) { _Thread_Enable_dispatch(); a000a514: eb0007cb bl a000c448 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_TOO_MANY; a000a518: e3a00005 mov r0, #5 <== NOT EXECUTED a000a51c: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) return RTEMS_INVALID_ADDRESS; a000a520: e3a00009 mov r0, #9 <== NOT EXECUTED ); *id = the_timer->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } a000a524: e8bd8070 pop {r4, r5, r6, pc} <== NOT EXECUTED =============================================================================== a000a530 : rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { a000a530: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} Timer_Control *the_timer; Objects_Locations location; ISR_Level level; if ( ticks == 0 ) a000a534: e2516000 subs r6, r1, #0 rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { a000a538: e1a05000 mov r5, r0 a000a53c: e24dd004 sub sp, sp, #4 a000a540: e1a04002 mov r4, r2 a000a544: e1a07003 mov r7, r3 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; if ( ticks == 0 ) return RTEMS_INVALID_NUMBER; a000a548: 03a0000a moveq r0, #10 { Timer_Control *the_timer; Objects_Locations location; ISR_Level level; if ( ticks == 0 ) a000a54c: 0a000020 beq a000a5d4 return RTEMS_INVALID_NUMBER; if ( !routine ) a000a550: e3520000 cmp r2, #0 return RTEMS_INVALID_ADDRESS; a000a554: 03a00009 moveq r0, #9 ISR_Level level; if ( ticks == 0 ) return RTEMS_INVALID_NUMBER; if ( !routine ) a000a558: 0a00001d beq a000a5d4 Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); a000a55c: e59f0088 ldr r0, [pc, #136] ; a000a5ec a000a560: e1a01005 mov r1, r5 a000a564: e1a0200d mov r2, sp a000a568: eb0004da bl a000b8d8 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_timer = _Timer_Get( id, &location ); switch ( location ) { a000a56c: e59d3000 ldr r3, [sp] a000a570: e1a08000 mov r8, r0 a000a574: e3530000 cmp r3, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a000a578: 13a00004 movne r0, #4 if ( !routine ) return RTEMS_INVALID_ADDRESS; the_timer = _Timer_Get( id, &location ); switch ( location ) { a000a57c: 1a000014 bne a000a5d4 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); a000a580: e288a010 add sl, r8, #16 a000a584: e1a0000a mov r0, sl a000a588: eb000bbf bl a000d48c <_Watchdog_Remove> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a000a58c: e10f2000 mrs r2, CPSR a000a590: e3823080 orr r3, r2, #128 ; 0x80 a000a594: e129f003 msr CPSR_fc, r3 /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { a000a598: e5983018 ldr r3, [r8, #24] a000a59c: e3530000 cmp r3, #0 a000a5a0: 1a00000d bne a000a5dc /* * OK. Now we now the timer was not rescheduled by an interrupt * so we can atomically initialize it as in use. */ the_timer->the_class = TIMER_INTERVAL; a000a5a4: e5883038 str r3, [r8, #56] ; 0x38 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a000a5a8: e5883018 str r3, [r8, #24] the_watchdog->routine = routine; a000a5ac: e588402c str r4, [r8, #44] ; 0x2c the_watchdog->id = id; a000a5b0: e5885030 str r5, [r8, #48] ; 0x30 the_watchdog->user_data = user_data; a000a5b4: e5887034 str r7, [r8, #52] ; 0x34 static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a000a5b8: e129f002 msr CPSR_fc, r2 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000a5bc: e59f002c ldr r0, [pc, #44] ; a000a5f0 a000a5c0: e1a0100a mov r1, sl Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a000a5c4: e588601c str r6, [r8, #28] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); a000a5c8: eb000b40 bl a000d2d0 <_Watchdog_Insert> _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _ISR_Enable( level ); _Watchdog_Insert_ticks( &the_timer->Ticker, ticks ); _Thread_Enable_dispatch(); a000a5cc: eb00079d bl a000c448 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a000a5d0: e3a00000 mov r0, #0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a000a5d4: e28dd004 add sp, sp, #4 a000a5d8: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} a000a5dc: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); _Thread_Enable_dispatch(); a000a5e0: eb000798 bl a000c448 <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a000a5e4: e3a00000 mov r0, #0 <== NOT EXECUTED a000a5e8: eafffff9 b a000a5d4 <== NOT EXECUTED =============================================================================== a0019e90 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a0019e90: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} a0019e94: e1a06001 mov r6, r1 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; if ( !_TOD_Is_set ) a0019e98: e59f10d0 ldr r1, [pc, #208] ; a0019f70 rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a0019e9c: e1a05000 mov r5, r0 a0019ea0: e24dd004 sub sp, sp, #4 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; if ( !_TOD_Is_set ) a0019ea4: e5d11000 ldrb r1, [r1] rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a0019ea8: e1a04002 mov r4, r2 a0019eac: e1a07003 mov r7, r3 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; if ( !_TOD_Is_set ) a0019eb0: e3510000 cmp r1, #0 return RTEMS_NOT_DEFINED; a0019eb4: 03a0000b moveq r0, #11 { Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; if ( !_TOD_Is_set ) a0019eb8: 1a000001 bne a0019ec4 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0019ebc: e28dd004 add sp, sp, #4 a0019ec0: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} rtems_interval seconds; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !_TOD_Validate( wall_time ) ) a0019ec4: e1a00006 mov r0, r6 a0019ec8: ebfff4ac bl a0017180 <_TOD_Validate> a0019ecc: e3500000 cmp r0, #0 a0019ed0: 0a000009 beq a0019efc return RTEMS_INVALID_CLOCK; if ( !routine ) a0019ed4: e3540000 cmp r4, #0 return RTEMS_INVALID_ADDRESS; a0019ed8: 03a00009 moveq r0, #9 return RTEMS_NOT_DEFINED; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; if ( !routine ) a0019edc: 0afffff6 beq a0019ebc return RTEMS_INVALID_ADDRESS; seconds = _TOD_To_seconds( wall_time ); a0019ee0: e1a00006 mov r0, r6 a0019ee4: ebfff47e bl a00170e4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) a0019ee8: e59f8084 ldr r8, [pc, #132] ; a0019f74 return RTEMS_INVALID_CLOCK; if ( !routine ) return RTEMS_INVALID_ADDRESS; seconds = _TOD_To_seconds( wall_time ); a0019eec: e1a06000 mov r6, r0 if ( seconds <= _TOD_Seconds_since_epoch() ) a0019ef0: e5983000 ldr r3, [r8] a0019ef4: e1500003 cmp r0, r3 a0019ef8: 8a000001 bhi a0019f04 return RTEMS_INVALID_CLOCK; a0019efc: e3a00014 mov r0, #20 <== NOT EXECUTED a0019f00: eaffffed b a0019ebc <== NOT EXECUTED a0019f04: e59f006c ldr r0, [pc, #108] ; a0019f78 a0019f08: e1a01005 mov r1, r5 a0019f0c: e1a0200d mov r2, sp a0019f10: eb000b37 bl a001cbf4 <_Objects_Get> the_timer = _Timer_Get( id, &location ); switch ( location ) { a0019f14: e59da000 ldr sl, [sp] a0019f18: e1a09000 mov r9, r0 a0019f1c: e35a0000 cmp sl, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0019f20: 13a00004 movne r0, #4 seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { a0019f24: 1affffe4 bne a0019ebc case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); a0019f28: e289b010 add fp, r9, #16 a0019f2c: e1a0000b mov r0, fp a0019f30: eb00130f bl a001eb74 <_Watchdog_Remove> the_timer->the_class = TIMER_TIME_OF_DAY; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _Watchdog_Insert_seconds( a0019f34: e5983000 ldr r3, [r8] the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY; a0019f38: e3a02002 mov r2, #2 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Seconds_chain, the_watchdog ); a0019f3c: e59f0038 ldr r0, [pc, #56] ; a0019f7c _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _Watchdog_Insert_seconds( a0019f40: e0636006 rsb r6, r3, r6 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY; a0019f44: e5892038 str r2, [r9, #56] ; 0x38 a0019f48: e1a0100b mov r1, fp Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a0019f4c: e589a018 str sl, [r9, #24] the_watchdog->routine = routine; a0019f50: e589402c str r4, [r9, #44] ; 0x2c the_watchdog->id = id; a0019f54: e5895030 str r5, [r9, #48] ; 0x30 the_watchdog->user_data = user_data; a0019f58: e5897034 str r7, [r9, #52] ; 0x34 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; a0019f5c: e589601c str r6, [r9, #28] _Watchdog_Insert( &_Watchdog_Seconds_chain, the_watchdog ); a0019f60: eb001294 bl a001e9b8 <_Watchdog_Insert> _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _Watchdog_Insert_seconds( &the_timer->Ticker, seconds - _TOD_Seconds_since_epoch() ); _Thread_Enable_dispatch(); a0019f64: eb000e20 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a0019f68: e1a0000a mov r0, sl a0019f6c: eaffffd2 b a0019ebc =============================================================================== a0019f80 : rtems_status_code rtems_timer_get_information( rtems_id id, rtems_timer_information *the_info ) { a0019f80: e92d4030 push {r4, r5, lr} <== NOT EXECUTED Timer_Control *the_timer; Objects_Locations location; if ( !the_info ) a0019f84: e2514000 subs r4, r1, #0 <== NOT EXECUTED rtems_status_code rtems_timer_get_information( rtems_id id, rtems_timer_information *the_info ) { a0019f88: e24dd004 sub sp, sp, #4 <== NOT EXECUTED a0019f8c: e1a01000 mov r1, r0 <== NOT EXECUTED Timer_Control *the_timer; Objects_Locations location; if ( !the_info ) return RTEMS_INVALID_ADDRESS; a0019f90: 03a00009 moveq r0, #9 <== NOT EXECUTED ) { Timer_Control *the_timer; Objects_Locations location; if ( !the_info ) a0019f94: 0a00000e beq a0019fd4 <== NOT EXECUTED a0019f98: e59f003c ldr r0, [pc, #60] ; a0019fdc <== NOT EXECUTED a0019f9c: e1a0200d mov r2, sp <== NOT EXECUTED a0019fa0: eb000b13 bl a001cbf4 <_Objects_Get> <== NOT EXECUTED return RTEMS_INVALID_ADDRESS; the_timer = _Timer_Get( id, &location ); switch ( location ) { a0019fa4: e59d5000 ldr r5, [sp] <== NOT EXECUTED a0019fa8: e3550000 cmp r5, #0 <== NOT EXECUTED #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a0019fac: 13a00004 movne r0, #4 <== NOT EXECUTED if ( !the_info ) return RTEMS_INVALID_ADDRESS; the_timer = _Timer_Get( id, &location ); switch ( location ) { a0019fb0: 1a000007 bne a0019fd4 <== NOT EXECUTED case OBJECTS_LOCAL: the_info->the_class = the_timer->the_class; a0019fb4: e590c038 ldr ip, [r0, #56] ; 0x38 <== NOT EXECUTED the_info->initial = the_timer->Ticker.initial; a0019fb8: e590101c ldr r1, [r0, #28] <== NOT EXECUTED the_info->start_time = the_timer->Ticker.start_time; a0019fbc: e5902024 ldr r2, [r0, #36] ; 0x24 <== NOT EXECUTED the_info->stop_time = the_timer->Ticker.stop_time; a0019fc0: e5903028 ldr r3, [r0, #40] ; 0x28 <== NOT EXECUTED the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: the_info->the_class = the_timer->the_class; a0019fc4: e584c000 str ip, [r4] <== NOT EXECUTED the_info->initial = the_timer->Ticker.initial; a0019fc8: e984000e stmib r4, {r1, r2, r3} <== NOT EXECUTED the_info->start_time = the_timer->Ticker.start_time; the_info->stop_time = the_timer->Ticker.stop_time; _Thread_Enable_dispatch(); a0019fcc: eb000e06 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a0019fd0: e1a00005 mov r0, r5 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a0019fd4: e28dd004 add sp, sp, #4 <== NOT EXECUTED a0019fd8: e8bd8030 pop {r4, r5, pc} <== NOT EXECUTED =============================================================================== a001a010 : */ rtems_status_code rtems_timer_reset( rtems_id id ) { a001a010: e92d4070 push {r4, r5, r6, lr} a001a014: e24dd004 sub sp, sp, #4 a001a018: e1a01000 mov r1, r0 a001a01c: e1a0200d mov r2, sp a001a020: e59f0088 ldr r0, [pc, #136] ; a001a0b0 a001a024: eb000af2 bl a001cbf4 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a028: e59d4000 ldr r4, [sp] a001a02c: e1a06000 mov r6, r0 a001a030: e3540000 cmp r4, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a001a034: 13a05004 movne r5, #4 Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a038: 1a000006 bne a001a058 case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { a001a03c: e5905038 ldr r5, [r0, #56] ; 0x38 a001a040: e3550000 cmp r5, #0 a001a044: 0a000006 beq a001a064 _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { a001a048: e3550001 cmp r5, #1 <== NOT EXECUTED /* * Must be dormant or time of day timer (e.g. TIMER_DORMANT, * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; a001a04c: 13a0500b movne r5, #11 <== NOT EXECUTED case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { a001a050: 0a00000b beq a001a084 <== NOT EXECUTED * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; } _Thread_Enable_dispatch(); a001a054: eb000de4 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a001a058: e1a00005 mov r0, r5 a001a05c: e28dd004 add sp, sp, #4 a001a060: e8bd8070 pop {r4, r5, r6, pc} the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); a001a064: e2806010 add r6, r0, #16 a001a068: e1a00006 mov r0, r6 a001a06c: eb0012c0 bl a001eb74 <_Watchdog_Remove> _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); a001a070: e59f003c ldr r0, [pc, #60] ; a001a0b4 a001a074: e1a01006 mov r1, r6 a001a078: eb00124e bl a001e9b8 <_Watchdog_Insert> * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; } _Thread_Enable_dispatch(); a001a07c: eb000dda bl a001d7ec <_Thread_Enable_dispatch> a001a080: eafffff4 b a001a058 case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { Timer_server_Control *timer_server = _Timer_server; a001a084: e59f302c ldr r3, [pc, #44] ; a001a0b8 <== NOT EXECUTED if ( !timer_server ) { _Thread_Enable_dispatch(); return RTEMS_INCORRECT_STATE; } #endif _Watchdog_Remove( &the_timer->Ticker ); a001a088: e2800010 add r0, r0, #16 <== NOT EXECUTED case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { Timer_server_Control *timer_server = _Timer_server; a001a08c: e5935000 ldr r5, [r3] <== NOT EXECUTED if ( !timer_server ) { _Thread_Enable_dispatch(); return RTEMS_INCORRECT_STATE; } #endif _Watchdog_Remove( &the_timer->Ticker ); a001a090: eb0012b7 bl a001eb74 <_Watchdog_Remove> <== NOT EXECUTED (*timer_server->schedule_operation)( timer_server, the_timer ); a001a094: e5953004 ldr r3, [r5, #4] <== NOT EXECUTED a001a098: e1a00005 mov r0, r5 <== NOT EXECUTED a001a09c: e1a01006 mov r1, r6 <== NOT EXECUTED a001a0a0: e12fff33 blx r3 <== NOT EXECUTED rtems_id id ) { Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; a001a0a4: e1a05004 mov r5, r4 <== NOT EXECUTED * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; } _Thread_Enable_dispatch(); a001a0a8: eb000dcf bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED a001a0ac: eaffffe9 b a001a058 <== NOT EXECUTED =============================================================================== a001a0bc : rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { a001a0bc: e92d45f0 push {r4, r5, r6, r7, r8, sl, lr} a001a0c0: e1a06001 mov r6, r1 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; a001a0c4: e59f10cc ldr r1, [pc, #204] ; a001a198 rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { a001a0c8: e1a07000 mov r7, r0 a001a0cc: e24dd004 sub sp, sp, #4 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; a001a0d0: e5914000 ldr r4, [r1] rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { a001a0d4: e1a05002 mov r5, r2 a001a0d8: e1a08003 mov r8, r3 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) a001a0dc: e3540000 cmp r4, #0 return RTEMS_INCORRECT_STATE; a001a0e0: 03a0000e moveq r0, #14 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) a001a0e4: 0a000005 beq a001a100 return RTEMS_INCORRECT_STATE; if ( !routine ) a001a0e8: e3520000 cmp r2, #0 return RTEMS_INVALID_ADDRESS; a001a0ec: 03a00009 moveq r0, #9 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !routine ) a001a0f0: 0a000002 beq a001a100 return RTEMS_INVALID_ADDRESS; if ( ticks == 0 ) a001a0f4: e3560000 cmp r6, #0 return RTEMS_INVALID_NUMBER; a001a0f8: 03a0000a moveq r0, #10 return RTEMS_INCORRECT_STATE; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( ticks == 0 ) a001a0fc: 1a000001 bne a001a108 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a001a100: e28dd004 add sp, sp, #4 a001a104: e8bd85f0 pop {r4, r5, r6, r7, r8, sl, pc} a001a108: e59f008c ldr r0, [pc, #140] ; a001a19c a001a10c: e1a01007 mov r1, r7 a001a110: e1a0200d mov r2, sp a001a114: eb000ab6 bl a001cbf4 <_Objects_Get> if ( ticks == 0 ) return RTEMS_INVALID_NUMBER; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a118: e59d3000 ldr r3, [sp] a001a11c: e1a0a000 mov sl, r0 a001a120: e3530000 cmp r3, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a001a124: 13a00004 movne r0, #4 if ( ticks == 0 ) return RTEMS_INVALID_NUMBER; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a128: 1afffff4 bne a001a100 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); a001a12c: e28a0010 add r0, sl, #16 a001a130: eb00128f bl a001eb74 <_Watchdog_Remove> static inline uint32_t arm_interrupt_disable( void ) { uint32_t arm_switch_reg; uint32_t level; asm volatile ( a001a134: e10f2000 mrs r2, CPSR a001a138: e3823080 orr r3, r2, #128 ; 0x80 a001a13c: e129f003 msr CPSR_fc, r3 /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { a001a140: e59a3018 ldr r3, [sl, #24] a001a144: e3530000 cmp r3, #0 a001a148: 1a00000e bne a001a188 /* * OK. Now we now the timer was not rescheduled by an interrupt * so we can atomically initialize it as in use. */ the_timer->the_class = TIMER_INTERVAL_ON_TASK; a001a14c: e3a01001 mov r1, #1 a001a150: e58a1038 str r1, [sl, #56] ; 0x38 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a001a154: e58a3018 str r3, [sl, #24] the_watchdog->routine = routine; a001a158: e58a502c str r5, [sl, #44] ; 0x2c the_watchdog->id = id; a001a15c: e58a7030 str r7, [sl, #48] ; 0x30 the_watchdog->user_data = user_data; a001a160: e58a8034 str r8, [sl, #52] ; 0x34 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = ticks; a001a164: e58a601c str r6, [sl, #28] static inline void arm_interrupt_enable( uint32_t level ) { ARM_SWITCH_REGISTERS; asm volatile ( a001a168: e129f002 msr CPSR_fc, r2 _ISR_Enable( level ); (*timer_server->schedule_operation)( timer_server, the_timer ); a001a16c: e1a00004 mov r0, r4 a001a170: e5943004 ldr r3, [r4, #4] a001a174: e1a0100a mov r1, sl a001a178: e12fff33 blx r3 _Thread_Enable_dispatch(); a001a17c: eb000d9a bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a001a180: e3a00000 mov r0, #0 a001a184: eaffffdd b a001a100 a001a188: e129f002 msr CPSR_fc, r2 <== NOT EXECUTED * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); _Thread_Enable_dispatch(); a001a18c: eb000d96 bl a001d7ec <_Thread_Enable_dispatch> <== NOT EXECUTED return RTEMS_SUCCESSFUL; a001a190: e3a00000 mov r0, #0 <== NOT EXECUTED a001a194: eaffffd9 b a001a100 <== NOT EXECUTED =============================================================================== a001a1a0 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a001a1a0: e92d4ff0 push {r4, r5, r6, r7, r8, r9, sl, fp, lr} a001a1a4: e1a07001 mov r7, r1 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; a001a1a8: e59f10e0 ldr r1, [pc, #224] ; a001a290 rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a001a1ac: e1a06000 mov r6, r0 a001a1b0: e24dd004 sub sp, sp, #4 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; a001a1b4: e5914000 ldr r4, [r1] rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { a001a1b8: e1a05002 mov r5, r2 a001a1bc: e1a08003 mov r8, r3 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) a001a1c0: e3540000 cmp r4, #0 return RTEMS_INCORRECT_STATE; a001a1c4: 03a0000e moveq r0, #14 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) a001a1c8: 0a00000c beq a001a200 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) a001a1cc: e59f30c0 ldr r3, [pc, #192] ; a001a294 a001a1d0: e5d33000 ldrb r3, [r3] a001a1d4: e3530000 cmp r3, #0 return RTEMS_NOT_DEFINED; a001a1d8: 03a0000b moveq r0, #11 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) a001a1dc: 0a000007 beq a001a200 return RTEMS_NOT_DEFINED; if ( !routine ) a001a1e0: e3520000 cmp r2, #0 return RTEMS_INVALID_ADDRESS; a001a1e4: 03a00009 moveq r0, #9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) a001a1e8: 0a000004 beq a001a200 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) a001a1ec: e1a00007 mov r0, r7 a001a1f0: ebfff3e2 bl a0017180 <_TOD_Validate> a001a1f4: e3500000 cmp r0, #0 a001a1f8: 1a000002 bne a001a208 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; a001a1fc: e3a00014 mov r0, #20 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } a001a200: e28dd004 add sp, sp, #4 a001a204: e8bd8ff0 pop {r4, r5, r6, r7, r8, r9, sl, fp, pc} return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); a001a208: e1a00007 mov r0, r7 a001a20c: ebfff3b4 bl a00170e4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) a001a210: e59fa080 ldr sl, [pc, #128] ; a001a298 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); a001a214: e1a07000 mov r7, r0 if ( seconds <= _TOD_Seconds_since_epoch() ) a001a218: e59a3000 ldr r3, [sl] a001a21c: e1500003 cmp r0, r3 a001a220: 9afffff5 bls a001a1fc a001a224: e59f0070 ldr r0, [pc, #112] ; a001a29c a001a228: e1a01006 mov r1, r6 a001a22c: e1a0200d mov r2, sp a001a230: eb000a6f bl a001cbf4 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a234: e59d9000 ldr r9, [sp] a001a238: e1a0b000 mov fp, r0 a001a23c: e3590000 cmp r9, #0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; a001a240: 13a00004 movne r0, #4 seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { a001a244: 1affffed bne a001a200 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); a001a248: e28b0010 add r0, fp, #16 a001a24c: eb001248 bl a001eb74 <_Watchdog_Remove> the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); a001a250: e59a3000 ldr r3, [sl] the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; a001a254: e3a02003 mov r2, #3 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); a001a258: e1a00004 mov r0, r4 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); a001a25c: e0637007 rsb r7, r3, r7 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; a001a260: e58b2038 str r2, [fp, #56] ; 0x38 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); a001a264: e5943004 ldr r3, [r4, #4] a001a268: e1a0100b mov r1, fp Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; a001a26c: e58b9018 str r9, [fp, #24] the_watchdog->routine = routine; a001a270: e58b502c str r5, [fp, #44] ; 0x2c the_watchdog->id = id; a001a274: e58b6030 str r6, [fp, #48] ; 0x30 the_watchdog->user_data = user_data; a001a278: e58b8034 str r8, [fp, #52] ; 0x34 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); a001a27c: e58b701c str r7, [fp, #28] (*timer_server->schedule_operation)( timer_server, the_timer ); a001a280: e12fff33 blx r3 _Thread_Enable_dispatch(); a001a284: eb000d58 bl a001d7ec <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; a001a288: e1a00009 mov r0, r9 a001a28c: eaffffdb b a001a200